initial commit
[freebsd-arm:freebsd-arm.git] / boot / i386 / libi386 / comconsole.c
1 /*-
2  * Copyright (c) 1998 Michael Smith (msmith@freebsd.org)
3  *
4  * Redistribution and use in source and binary forms, with or without
5  * modification, are permitted provided that the following conditions
6  * are met:
7  * 1. Redistributions of source code must retain the above copyright
8  *    notice, this list of conditions and the following disclaimer.
9  * 2. Redistributions in binary form must reproduce the above copyright
10  *    notice, this list of conditions and the following disclaimer in the
11  *    documentation and/or other materials provided with the distribution.
12  *
13  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
14  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
15  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
16  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
17  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
18  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
19  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
20  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
21  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
22  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
23  * SUCH DAMAGE.
24  */
25
26 #include <sys/cdefs.h>
27 __FBSDID("$FreeBSD$");
28
29 #include <stand.h>
30 #include <bootstrap.h>
31 #include <machine/cpufunc.h>
32 #include <dev/ic/ns16550.h>
33 #include "libi386.h"
34
35 #define COMC_FMT        0x3             /* 8N1 */
36 #define COMC_TXWAIT     0x40000         /* transmit timeout */
37 #define COMC_BPS(x)     (115200 / (x))  /* speed to DLAB divisor */
38 #define COMC_DIV2BPS(x) (115200 / (x))  /* DLAB divisor to speed */
39
40 #ifndef COMPORT
41 #define COMPORT         0x3f8
42 #endif
43 #ifndef COMSPEED
44 #define COMSPEED        9600
45 #endif
46
47 static void     comc_probe(struct console *cp);
48 static int      comc_init(int arg);
49 static void     comc_putchar(int c);
50 static int      comc_getchar(void);
51 static int      comc_getspeed(void);
52 static int      comc_ischar(void);
53 static int      comc_parsespeed(const char *string);
54 static void     comc_setup(int speed);
55 static int      comc_speed_set(struct env_var *ev, int flags,
56                     const void *value);
57
58 static int      comc_started;
59 static int      comc_curspeed;
60
61 struct console comconsole = {
62     "comconsole",
63     "serial port",
64     0,
65     comc_probe,
66     comc_init,
67     comc_putchar,
68     comc_getchar,
69     comc_ischar
70 };
71
72 static void
73 comc_probe(struct console *cp)
74 {
75     char speedbuf[16];
76     char *cons, *speedenv;
77     int speed;
78
79     /* XXX check the BIOS equipment list? */
80     cp->c_flags |= (C_PRESENTIN | C_PRESENTOUT);
81
82     if (comc_curspeed == 0) {
83         comc_curspeed = COMSPEED;
84         /*
85          * Assume that the speed was set by an earlier boot loader if
86          * comconsole is already the preferred console.
87          */
88         cons = getenv("console");
89         if ((cons != NULL && strcmp(cons, comconsole.c_name) == 0) ||
90             getenv("boot_multicons") != NULL) {
91                 comc_curspeed = comc_getspeed();
92         }
93         speedenv = getenv("comconsole_speed");
94         if (speedenv != NULL) {
95             speed = comc_parsespeed(speedenv);
96             if (speed > 0)
97                 comc_curspeed = speed;
98         }
99
100         sprintf(speedbuf, "%d", comc_curspeed);
101         unsetenv("comconsole_speed");
102         env_setenv("comconsole_speed", EV_VOLATILE, speedbuf, comc_speed_set,
103             env_nounset);
104     }
105 }
106
107 static int
108 comc_init(int arg)
109 {
110     if (comc_started && arg == 0)
111         return 0;
112     comc_started = 1;
113
114     comc_setup(comc_curspeed);
115
116     return(0);
117 }
118
119 static void
120 comc_putchar(int c)
121 {
122     int wait;
123
124     for (wait = COMC_TXWAIT; wait > 0; wait--)
125         if (inb(COMPORT + com_lsr) & LSR_TXRDY) {
126             outb(COMPORT + com_data, (u_char)c);
127             break;
128         }
129 }
130
131 static int
132 comc_getchar(void)
133 {
134     return(comc_ischar() ? inb(COMPORT + com_data) : -1);
135 }
136
137 static int
138 comc_ischar(void)
139 {
140     return(inb(COMPORT + com_lsr) & LSR_RXRDY);
141 }
142
143 static int
144 comc_speed_set(struct env_var *ev, int flags, const void *value)
145 {
146     int speed;
147
148     if (value == NULL || (speed = comc_parsespeed(value)) <= 0) {
149         printf("Invalid speed\n");
150         return (CMD_ERROR);
151     }
152
153     if (comc_started && comc_curspeed != speed)
154         comc_setup(speed);
155
156     env_setenv(ev->ev_name, flags | EV_NOHOOK, value, NULL, NULL);
157
158     return (CMD_OK);
159 }
160
161 static void
162 comc_setup(int speed)
163 {
164
165     comc_curspeed = speed;
166
167     outb(COMPORT + com_cfcr, CFCR_DLAB | COMC_FMT);
168     outb(COMPORT + com_dlbl, COMC_BPS(speed) & 0xff);
169     outb(COMPORT + com_dlbh, COMC_BPS(speed) >> 8);
170     outb(COMPORT + com_cfcr, COMC_FMT);
171     outb(COMPORT + com_mcr, MCR_RTS | MCR_DTR);
172
173     do
174         inb(COMPORT + com_data);
175     while (inb(COMPORT + com_lsr) & LSR_RXRDY);
176 }
177
178 static int
179 comc_parsespeed(const char *speedstr)
180 {
181     char *p;
182     int speed;
183
184     speed = strtol(speedstr, &p, 0);
185     if (p == speedstr || *p != '\0' || speed <= 0)
186         return (-1);
187
188     return (speed);
189 }
190
191 static int
192 comc_getspeed(void)
193 {
194         u_int   divisor;
195         u_char  dlbh;
196         u_char  dlbl;
197         u_char  cfcr;
198
199         cfcr = inb(COMPORT + com_cfcr);
200         outb(COMPORT + com_cfcr, CFCR_DLAB | cfcr);
201
202         dlbl = inb(COMPORT + com_dlbl);
203         dlbh = inb(COMPORT + com_dlbh);
204
205         outb(COMPORT + com_cfcr, cfcr);
206
207         divisor = dlbh << 8 | dlbl;
208
209         /* XXX there should be more sanity checking. */
210         if (divisor == 0)
211                 return (COMSPEED);
212         return (COMC_DIV2BPS(divisor));
213 }