unixcons.c revision 1.1.2.2 1 1.1.2.2 skrll /* $NetBSD: unixcons.c,v 1.1.2.2 2009/03/03 18:29:50 skrll Exp $ */
2 1.1.2.2 skrll
3 1.1.2.2 skrll /*
4 1.1.2.2 skrll * Copyright (c) 2009 NONAKA Kimihiro <nonaka (at) netbsd.org>
5 1.1.2.2 skrll * All rights reserved.
6 1.1.2.2 skrll *
7 1.1.2.2 skrll * Redistribution and use in source and binary forms, with or without
8 1.1.2.2 skrll * modification, are permitted provided that the following conditions
9 1.1.2.2 skrll * are met:
10 1.1.2.2 skrll * 1. Redistributions of source code must retain the above copyright
11 1.1.2.2 skrll * notice, this list of conditions and the following disclaimer.
12 1.1.2.2 skrll * 2. Redistributions in binary form must reproduce the above copyright
13 1.1.2.2 skrll * notice, this list of conditions and the following disclaimer in the
14 1.1.2.2 skrll * documentation and/or other materials provided with the distribution.
15 1.1.2.2 skrll *
16 1.1.2.2 skrll * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1.2.2 skrll * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1.2.2 skrll * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1.2.2 skrll * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1.2.2 skrll * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 1.1.2.2 skrll * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 1.1.2.2 skrll * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 1.1.2.2 skrll * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 1.1.2.2 skrll * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 1.1.2.2 skrll * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 1.1.2.2 skrll */
27 1.1.2.2 skrll
28 1.1.2.2 skrll #include "boot.h"
29 1.1.2.2 skrll #include "bootinfo.h"
30 1.1.2.2 skrll #include "unixdev.h"
31 1.1.2.2 skrll
32 1.1.2.2 skrll #include "compat_linux.h"
33 1.1.2.2 skrll #include "termios.h"
34 1.1.2.2 skrll
35 1.1.2.2 skrll struct btinfo_console bi_cons;
36 1.1.2.2 skrll
37 1.1.2.2 skrll static int iodev = CONSDEV_GLASS;
38 1.1.2.2 skrll static int infd = 0;
39 1.1.2.2 skrll static int outfd = 1;
40 1.1.2.2 skrll
41 1.1.2.2 skrll static const char *comdevname[] = {
42 1.1.2.2 skrll "/dev/ttyS0",
43 1.1.2.2 skrll };
44 1.1.2.2 skrll
45 1.1.2.2 skrll static void common_putc(int fd, int c);
46 1.1.2.2 skrll static int common_getc(int fd, int timo);
47 1.1.2.2 skrll
48 1.1.2.2 skrll void
49 1.1.2.2 skrll consinit(int dev, int speed)
50 1.1.2.2 skrll {
51 1.1.2.2 skrll struct linux_termios termios;
52 1.1.2.2 skrll int fd;
53 1.1.2.2 skrll
54 1.1.2.2 skrll switch (dev) {
55 1.1.2.2 skrll case CONSDEV_COM0:
56 1.1.2.2 skrll iodev = dev;
57 1.1.2.2 skrll break;
58 1.1.2.2 skrll
59 1.1.2.2 skrll case CONSDEV_GLASS:
60 1.1.2.2 skrll default:
61 1.1.2.2 skrll glass_console:
62 1.1.2.2 skrll iodev = CONSDEV_GLASS;
63 1.1.2.2 skrll break;
64 1.1.2.2 skrll }
65 1.1.2.2 skrll
66 1.1.2.2 skrll if (infd >= 0 && infd == outfd) {
67 1.1.2.2 skrll uclose(infd);
68 1.1.2.2 skrll infd = 0;
69 1.1.2.2 skrll outfd = 1;
70 1.1.2.2 skrll }
71 1.1.2.2 skrll
72 1.1.2.2 skrll if (iodev == CONSDEV_GLASS) {
73 1.1.2.2 skrll infd = 0;
74 1.1.2.2 skrll outfd = 1;
75 1.1.2.2 skrll
76 1.1.2.2 skrll strlcpy(bi_cons.devname, "glass", sizeof(bi_cons.devname));
77 1.1.2.2 skrll bi_cons.addr = -1;
78 1.1.2.2 skrll bi_cons.speed = -1;
79 1.1.2.2 skrll } else {
80 1.1.2.2 skrll fd = uopen(comdevname[iodev - CONSDEV_COM0], LINUX_O_RDWR);
81 1.1.2.2 skrll if (fd < 0)
82 1.1.2.2 skrll goto glass_console;
83 1.1.2.2 skrll infd = outfd = fd;
84 1.1.2.2 skrll
85 1.1.2.2 skrll /* set speed */
86 1.1.2.2 skrll linux_tcgetattr(fd, &termios);
87 1.1.2.2 skrll if (linux_cfsetspeed(&termios, speed) < 0) {
88 1.1.2.2 skrll speed = 9600;
89 1.1.2.2 skrll if (linux_cfsetspeed(&termios, speed) < 0)
90 1.1.2.2 skrll goto glass_console;
91 1.1.2.2 skrll }
92 1.1.2.2 skrll if (linux_tcsetattr(fd, LINUX_TCSETS, &termios) < 0)
93 1.1.2.2 skrll goto glass_console;
94 1.1.2.2 skrll
95 1.1.2.2 skrll snprintf(bi_cons.devname, sizeof(bi_cons.devname), "com%d",
96 1.1.2.2 skrll iodev - CONSDEV_COM0);
97 1.1.2.2 skrll bi_cons.addr = -1;
98 1.1.2.2 skrll bi_cons.speed = speed;
99 1.1.2.2 skrll }
100 1.1.2.2 skrll BI_ADD(&bi_cons, BTINFO_CONSDEV, sizeof(bi_cons));
101 1.1.2.2 skrll }
102 1.1.2.2 skrll
103 1.1.2.2 skrll void
104 1.1.2.2 skrll putchar(int c)
105 1.1.2.2 skrll {
106 1.1.2.2 skrll
107 1.1.2.2 skrll common_putc(outfd, c);
108 1.1.2.2 skrll }
109 1.1.2.2 skrll
110 1.1.2.2 skrll int
111 1.1.2.2 skrll getchar(void)
112 1.1.2.2 skrll {
113 1.1.2.2 skrll
114 1.1.2.2 skrll return common_getc(infd, 1);
115 1.1.2.2 skrll }
116 1.1.2.2 skrll
117 1.1.2.2 skrll static void
118 1.1.2.2 skrll common_putc(int fd, int c)
119 1.1.2.2 skrll {
120 1.1.2.2 skrll
121 1.1.2.2 skrll (void)uwrite(fd, &c, 1);
122 1.1.2.2 skrll }
123 1.1.2.2 skrll
124 1.1.2.2 skrll static int
125 1.1.2.2 skrll common_getc(int fd, int timo)
126 1.1.2.2 skrll {
127 1.1.2.2 skrll struct linux_timeval tv;
128 1.1.2.2 skrll fd_set fdset;
129 1.1.2.2 skrll int nfds, n;
130 1.1.2.2 skrll char c;
131 1.1.2.2 skrll
132 1.1.2.2 skrll for (; timo < 0 || timo > 0; --timo) {
133 1.1.2.2 skrll tv.tv_sec = 1;
134 1.1.2.2 skrll tv.tv_usec = 0;
135 1.1.2.2 skrll FD_ZERO(&fdset);
136 1.1.2.2 skrll
137 1.1.2.2 skrll nfds = 1;
138 1.1.2.2 skrll FD_SET(fd, &fdset);
139 1.1.2.2 skrll
140 1.1.2.2 skrll n = uselect(nfds, &fdset, NULL, NULL, &tv);
141 1.1.2.2 skrll if (n > 0)
142 1.1.2.2 skrll break;
143 1.1.2.2 skrll }
144 1.1.2.2 skrll
145 1.1.2.2 skrll if (timo > 0) {
146 1.1.2.2 skrll for (fd = 0; fd < nfds; fd++) {
147 1.1.2.2 skrll if (FD_ISSET(fd, &fdset)) {
148 1.1.2.2 skrll return (uread(fd, &c, 1) < 1 ? -1 : c);
149 1.1.2.2 skrll }
150 1.1.2.2 skrll }
151 1.1.2.2 skrll }
152 1.1.2.2 skrll return -1;
153 1.1.2.2 skrll }
154 1.1.2.2 skrll
155 1.1.2.2 skrll int
156 1.1.2.2 skrll awaitkey(int timeout, int tell)
157 1.1.2.2 skrll {
158 1.1.2.2 skrll struct linux_termios orig_termios, raw_termios;
159 1.1.2.2 skrll int c = 0;
160 1.1.2.2 skrll int i;
161 1.1.2.2 skrll
162 1.1.2.2 skrll /* set raw mode */
163 1.1.2.2 skrll linux_tcgetattr(infd, &orig_termios);
164 1.1.2.2 skrll raw_termios = orig_termios;
165 1.1.2.2 skrll linux_cfmakeraw(&raw_termios);
166 1.1.2.2 skrll linux_tcsetattr(infd, LINUX_TCSETS, &raw_termios);
167 1.1.2.2 skrll
168 1.1.2.2 skrll for (i = timeout; i > 0; i--) {
169 1.1.2.2 skrll if (tell) {
170 1.1.2.2 skrll char numbuf[20];
171 1.1.2.2 skrll int len, j;
172 1.1.2.2 skrll
173 1.1.2.2 skrll sprintf(numbuf, "%d ", i);
174 1.1.2.2 skrll len = strlen(numbuf);
175 1.1.2.2 skrll for (j = 0; j < len; j++)
176 1.1.2.2 skrll numbuf[len + j] = '\b';
177 1.1.2.2 skrll numbuf[len + j] = '\0';
178 1.1.2.2 skrll printf(numbuf);
179 1.1.2.2 skrll }
180 1.1.2.2 skrll c = common_getc(infd, 1);
181 1.1.2.2 skrll if (c == 0)
182 1.1.2.2 skrll c = -1;
183 1.1.2.2 skrll if (c >= 0)
184 1.1.2.2 skrll break;
185 1.1.2.2 skrll }
186 1.1.2.2 skrll if (i == 0)
187 1.1.2.2 skrll c = '\0';
188 1.1.2.2 skrll
189 1.1.2.2 skrll /* set original mode */
190 1.1.2.2 skrll linux_tcsetattr(infd, LINUX_TCSETS, &orig_termios);
191 1.1.2.2 skrll
192 1.1.2.2 skrll if (tell)
193 1.1.2.2 skrll printf("0 \n");
194 1.1.2.2 skrll
195 1.1.2.2 skrll return c;
196 1.1.2.2 skrll }
197 1.1.2.2 skrll
198 1.1.2.2 skrll void dummycall2(void);
199 1.1.2.2 skrll void
200 1.1.2.2 skrll dummycall2(void)
201 1.1.2.2 skrll {
202 1.1.2.2 skrll
203 1.1.2.2 skrll (void)linux_termio_to_bsd_termios;
204 1.1.2.2 skrll (void)bsd_termios_to_linux_termio;
205 1.1.2.2 skrll (void)linux_termios_to_bsd_termios;
206 1.1.2.2 skrll (void)bsd_termios_to_linux_termios;
207 1.1.2.2 skrll }
208