gcc is rather over-aggressive about optimising out static data structures
[people/asdlkf/gpxe.git] / src / core / serial.c
1 /*
2  * The serial port interface routines implement a simple polled i/o
3  * interface to a standard serial port.  Due to the space restrictions
4  * for the boot blocks, no BIOS support is used (since BIOS requires
5  * expensive real/protected mode switches), instead the rudimentary
6  * BIOS support is duplicated here.
7  *
8  * The base address and speed for the i/o port are passed from the
9  * Makefile in the COMCONSOLE and CONSPEED preprocessor macros.  The
10  * line control parameters are currently hard-coded to 8 bits, no
11  * parity, 1 stop bit (8N1).  This can be changed in init_serial().
12  */
13
14 #include "stddef.h"
15 #include "console.h"
16 #include "init.h"
17 #include "io.h"
18 #include "timer.h"
19 #include "config/serial.h"
20
21 /* Set default values if none specified */
22
23 #ifndef COMCONSOLE
24 #define COMCONSOLE      0x3f8
25 #endif
26
27 #ifndef COMSPEED
28 #define COMSPEED        9600
29 #endif
30
31 #ifndef COMDATA
32 #define COMDATA         8
33 #endif
34
35 #ifndef COMPARITY
36 #define COMPARITY       0
37 #endif
38
39 #ifndef COMSTOP
40 #define COMSTOP         1
41 #endif
42
43 #undef UART_BASE
44 #define UART_BASE ( COMCONSOLE )
45
46 #undef UART_BAUD
47 #define UART_BAUD ( COMSPEED )
48
49 #if ((115200%UART_BAUD) != 0)
50 #error Bad ttys0 baud rate
51 #endif
52
53 #define COMBRD (115200/UART_BAUD)
54
55 /* Line Control Settings */
56 #define UART_LCS ( ( ( (COMDATA) - 5 )  << 0 ) | \
57                    ( ( (COMPARITY) )    << 3 ) | \
58                    ( ( (COMSTOP) - 1 )  << 2 ) )
59
60 /* Data */
61 #define UART_RBR 0x00
62 #define UART_TBR 0x00
63
64 /* Control */
65 #define UART_IER 0x01
66 #define UART_IIR 0x02
67 #define UART_FCR 0x02
68 #define UART_LCR 0x03
69 #define UART_MCR 0x04
70 #define UART_DLL 0x00
71 #define UART_DLM 0x01
72
73 /* Status */
74 #define UART_LSR 0x05
75 #define  UART_LSR_TEMPT 0x40    /* Transmitter empty */
76 #define  UART_LSR_THRE  0x20    /* Transmit-hold-register empty */
77 #define  UART_LSR_BI    0x10    /* Break interrupt indicator */
78 #define  UART_LSR_FE    0x08    /* Frame error indicator */
79 #define  UART_LSR_PE    0x04    /* Parity error indicator */
80 #define  UART_LSR_OE    0x02    /* Overrun error indicator */
81 #define  UART_LSR_DR    0x01    /* Receiver data ready */
82
83 #define UART_MSR 0x06
84 #define UART_SCR 0x07
85
86 #if defined(UART_MEM)
87 #define uart_readb(addr) readb((addr))
88 #define uart_writeb(val,addr) writeb((val),(addr))
89 #else
90 #define uart_readb(addr) inb((addr))
91 #define uart_writeb(val,addr) outb((val),(addr))
92 #endif
93
94 struct console_driver serial_console;
95
96 /*
97  * void serial_putc(int ch);
98  *      Write character `ch' to port UART_BASE.
99  */
100 static void serial_putc ( int ch ) {
101         int i;
102         int status;
103         i = 1000; /* timeout */
104         while(--i > 0) {
105                 status = uart_readb(UART_BASE + UART_LSR);
106                 if (status & UART_LSR_THRE) { 
107                         /* TX buffer emtpy */
108                         uart_writeb(ch, UART_BASE + UART_TBR);
109                         break;
110                 }
111                 mdelay(2);
112         }
113 }
114
115 /*
116  * int serial_getc(void);
117  *      Read a character from port UART_BASE.
118  */
119 static int serial_getc ( void ) {
120         int status;
121         int ch;
122         do {
123                 status = uart_readb(UART_BASE + UART_LSR);
124         } while((status & 1) == 0);
125         ch = uart_readb(UART_BASE + UART_RBR);  /* fetch (first) character */
126         ch &= 0x7f;                             /* remove any parity bits we get */
127         if (ch == 0x7f) {                       /* Make DEL... look like BS */
128                 ch = 0x08;
129         }
130         return ch;
131 }
132
133 /*
134  * int serial_ischar(void);
135  *       If there is a character in the input buffer of port UART_BASE,
136  *       return nonzero; otherwise return 0.
137  */
138 static int serial_ischar ( void ) {
139         int status;
140         status = uart_readb(UART_BASE + UART_LSR);      /* line status reg; */
141         return status & 1;              /* rx char available */
142 }
143
144 /*
145  * int serial_init(void);
146  *      Initialize port UART_BASE to speed COMSPEED, line settings 8N1.
147  */
148 static void serial_init ( void ) {
149         int status;
150         int divisor, lcs;
151
152         divisor = COMBRD;
153         lcs = UART_LCS;
154
155
156 #ifdef COMPRESERVE
157         lcs = uart_readb(UART_BASE + UART_LCR) & 0x7f;
158         uart_writeb(0x80 | lcs, UART_BASE + UART_LCR);
159         divisor = (uart_readb(UART_BASE + UART_DLM) << 8) | uart_readb(UART_BASE + UART_DLL);
160         uart_writeb(lcs, UART_BASE + UART_LCR);
161 #endif
162
163         /* Set Baud Rate Divisor to COMSPEED, and test to see if the
164          * serial port appears to be present.
165          */
166         uart_writeb(0x80 | lcs, UART_BASE + UART_LCR);
167         uart_writeb(0xaa, UART_BASE + UART_DLL);
168         if (uart_readb(UART_BASE + UART_DLL) != 0xaa) 
169                 goto out;
170         uart_writeb(0x55, UART_BASE + UART_DLL);
171         if (uart_readb(UART_BASE + UART_DLL) != 0x55)
172                 goto out;
173         uart_writeb(divisor & 0xff, UART_BASE + UART_DLL);
174         if (uart_readb(UART_BASE + UART_DLL) != (divisor & 0xff))
175                 goto out;
176         uart_writeb(0xaa, UART_BASE + UART_DLM);
177         if (uart_readb(UART_BASE + UART_DLM) != 0xaa) 
178                 goto out;
179         uart_writeb(0x55, UART_BASE + UART_DLM);
180         if (uart_readb(UART_BASE + UART_DLM) != 0x55)
181                 goto out;
182         uart_writeb((divisor >> 8) & 0xff, UART_BASE + UART_DLM);
183         if (uart_readb(UART_BASE + UART_DLM) != ((divisor >> 8) & 0xff))
184                 goto out;
185         uart_writeb(lcs, UART_BASE + UART_LCR);
186         
187         /* disable interrupts */
188         uart_writeb(0x0, UART_BASE + UART_IER);
189
190         /* disable fifo's */
191         uart_writeb(0x00, UART_BASE + UART_FCR);
192
193         /* Set clear to send, so flow control works... */
194         uart_writeb((1<<1), UART_BASE + UART_MCR);
195
196
197         /* Flush the input buffer. */
198         do {
199                 /* rx buffer reg
200                  * throw away (unconditionally the first time)
201                  */
202                 uart_readb(UART_BASE + UART_RBR);
203                 /* line status reg */
204                 status = uart_readb(UART_BASE + UART_LSR);
205         } while(status & UART_LSR_DR);
206         serial_console.disabled = 0;
207  out:
208         return;
209 }
210
211 /*
212  * void serial_fini(void);
213  *      Cleanup our use of the serial port, in particular flush the
214  *      output buffer so we don't accidentially loose characters.
215  */
216 static void serial_fini ( void ) {
217         int i, status;
218         if (serial_console.disabled) {
219                 /* no serial interface */
220                 return;
221         }
222         /* Flush the output buffer to avoid dropping characters,
223          * if we are reinitializing the serial port.
224          */
225         i = 10000; /* timeout */
226         do {
227                 status = uart_readb(UART_BASE + UART_LSR);
228         } while((--i > 0) && !(status & UART_LSR_TEMPT));
229         /* Don't mark it as disabled; it's still usable */
230 }
231
232 struct console_driver serial_console __console_driver = {
233         .putchar = serial_putc,
234         .getchar = serial_getc,
235         .iskey = serial_ischar,
236         .disabled = 1,
237 };
238
239 INIT_FN ( INIT_CONSOLE, serial_init, NULL, serial_fini );
240