ofcons.c revision 1.3 1 1.3 christos /* $NetBSD: ofcons.c,v 1.3 1996/10/13 01:38:11 christos Exp $ */
2 1.1 ws
3 1.1 ws /*
4 1.1 ws * Copyright (C) 1995, 1996 Wolfgang Solfrank.
5 1.1 ws * Copyright (C) 1995, 1996 TooLs GmbH.
6 1.1 ws * All rights reserved.
7 1.1 ws *
8 1.1 ws * Redistribution and use in source and binary forms, with or without
9 1.1 ws * modification, are permitted provided that the following conditions
10 1.1 ws * are met:
11 1.1 ws * 1. Redistributions of source code must retain the above copyright
12 1.1 ws * notice, this list of conditions and the following disclaimer.
13 1.1 ws * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 ws * notice, this list of conditions and the following disclaimer in the
15 1.1 ws * documentation and/or other materials provided with the distribution.
16 1.1 ws * 3. All advertising materials mentioning features or use of this software
17 1.1 ws * must display the following acknowledgement:
18 1.1 ws * This product includes software developed by TooLs GmbH.
19 1.1 ws * 4. The name of TooLs GmbH may not be used to endorse or promote products
20 1.1 ws * derived from this software without specific prior written permission.
21 1.1 ws *
22 1.1 ws * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
23 1.1 ws * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
24 1.1 ws * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
25 1.1 ws * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26 1.1 ws * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
27 1.1 ws * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
28 1.1 ws * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
29 1.1 ws * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
30 1.1 ws * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
31 1.1 ws * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32 1.1 ws */
33 1.1 ws
34 1.1 ws #include <sys/param.h>
35 1.1 ws #include <sys/conf.h>
36 1.1 ws #include <sys/device.h>
37 1.1 ws #include <sys/proc.h>
38 1.1 ws #include <sys/systm.h>
39 1.1 ws #include <sys/tty.h>
40 1.1 ws
41 1.1 ws #include <dev/cons.h>
42 1.1 ws
43 1.1 ws #include <dev/ofw/openfirm.h>
44 1.1 ws
45 1.1 ws struct ofc_softc {
46 1.1 ws struct device of_dev;
47 1.1 ws struct tty *of_tty;
48 1.1 ws int of_flags;
49 1.1 ws };
50 1.1 ws /* flags: */
51 1.1 ws #define OFPOLL 1
52 1.1 ws
53 1.1 ws #define OFBURSTLEN 128 /* max number of bytes to write in one chunk */
54 1.1 ws
55 1.1 ws static int stdin, stdout;
56 1.1 ws
57 1.1 ws static int ofcmatch __P((struct device *, void *, void *));
58 1.1 ws static void ofcattach __P((struct device *, struct device *, void *));
59 1.1 ws
60 1.1 ws struct cfattach ofcons_ca = {
61 1.1 ws sizeof(struct ofc_softc), ofcmatch, ofcattach
62 1.1 ws };
63 1.1 ws
64 1.1 ws struct cfdriver ofcons_cd = {
65 1.1 ws NULL, "ofcons", DV_TTY
66 1.1 ws };
67 1.1 ws
68 1.1 ws static int ofcprobe __P((void));
69 1.1 ws
70 1.1 ws static int
71 1.1 ws ofcmatch(parent, match, aux)
72 1.1 ws struct device *parent;
73 1.1 ws void *match, *aux;
74 1.1 ws {
75 1.1 ws struct ofprobe *ofp = aux;
76 1.1 ws
77 1.1 ws if (!ofcprobe())
78 1.1 ws return 0;
79 1.1 ws return OF_instance_to_package(stdin) == ofp->phandle
80 1.1 ws || OF_instance_to_package(stdout) == ofp->phandle;
81 1.1 ws }
82 1.1 ws
83 1.1 ws static void
84 1.1 ws ofcattach(parent, self, aux)
85 1.1 ws struct device *parent, *self;
86 1.1 ws void *aux;
87 1.1 ws {
88 1.3 christos printf("\n");
89 1.1 ws }
90 1.1 ws
91 1.1 ws static void ofcstart __P((struct tty *));
92 1.1 ws static int ofcparam __P((struct tty *, struct termios *));
93 1.1 ws static void ofcpoll __P((void *));
94 1.1 ws
95 1.1 ws int
96 1.1 ws ofcopen(dev, flag, mode, p)
97 1.1 ws dev_t dev;
98 1.1 ws int flag, mode;
99 1.1 ws struct proc *p;
100 1.1 ws {
101 1.1 ws struct ofc_softc *sc;
102 1.1 ws int unit = minor(dev);
103 1.1 ws struct tty *tp;
104 1.1 ws
105 1.1 ws if (unit >= ofcons_cd.cd_ndevs)
106 1.1 ws return ENXIO;
107 1.1 ws sc = ofcons_cd.cd_devs[unit];
108 1.1 ws if (!sc)
109 1.1 ws return ENXIO;
110 1.1 ws if (!(tp = sc->of_tty))
111 1.1 ws sc->of_tty = tp = ttymalloc();
112 1.1 ws tp->t_oproc = ofcstart;
113 1.1 ws tp->t_param = ofcparam;
114 1.1 ws tp->t_dev = dev;
115 1.1 ws if (!(tp->t_state & TS_ISOPEN)) {
116 1.1 ws tp->t_state |= TS_WOPEN;
117 1.1 ws ttychars(tp);
118 1.1 ws tp->t_iflag = TTYDEF_IFLAG;
119 1.1 ws tp->t_oflag = TTYDEF_OFLAG;
120 1.1 ws tp->t_cflag = TTYDEF_CFLAG;
121 1.1 ws tp->t_lflag = TTYDEF_LFLAG;
122 1.1 ws tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
123 1.1 ws ofcparam(tp, &tp->t_termios);
124 1.1 ws ttsetwater(tp);
125 1.1 ws } else if ((tp->t_state&TS_XCLUDE) && suser(p->p_ucred, &p->p_acflag))
126 1.1 ws return EBUSY;
127 1.1 ws tp->t_state |= TS_CARR_ON;
128 1.1 ws
129 1.1 ws if (!(sc->of_flags & OFPOLL)) {
130 1.1 ws sc->of_flags |= OFPOLL;
131 1.1 ws timeout(ofcpoll, sc, 1);
132 1.1 ws }
133 1.1 ws
134 1.1 ws return (*linesw[tp->t_line].l_open)(dev, tp);
135 1.1 ws }
136 1.1 ws
137 1.1 ws int
138 1.1 ws ofcclose(dev, flag, mode, p)
139 1.1 ws dev_t dev;
140 1.1 ws int flag, mode;
141 1.1 ws struct proc *p;
142 1.1 ws {
143 1.1 ws struct ofc_softc *sc = ofcons_cd.cd_devs[minor(dev)];
144 1.1 ws struct tty *tp = sc->of_tty;
145 1.1 ws
146 1.1 ws untimeout(ofcpoll, sc);
147 1.1 ws sc->of_flags &= ~OFPOLL;
148 1.1 ws (*linesw[tp->t_line].l_close)(tp, flag);
149 1.1 ws ttyclose(tp);
150 1.1 ws return 0;
151 1.1 ws }
152 1.1 ws
153 1.1 ws int
154 1.1 ws ofcread(dev, uio, flag)
155 1.1 ws dev_t dev;
156 1.1 ws struct uio *uio;
157 1.1 ws int flag;
158 1.1 ws {
159 1.1 ws struct ofc_softc *sc = ofcons_cd.cd_devs[minor(dev)];
160 1.1 ws struct tty *tp = sc->of_tty;
161 1.1 ws
162 1.1 ws return (*linesw[tp->t_line].l_read)(tp, uio, flag);
163 1.1 ws }
164 1.1 ws
165 1.1 ws int
166 1.1 ws ofcwrite(dev, uio, flag)
167 1.1 ws dev_t dev;
168 1.1 ws struct uio *uio;
169 1.1 ws int flag;
170 1.1 ws {
171 1.1 ws struct ofc_softc *sc = ofcons_cd.cd_devs[minor(dev)];
172 1.1 ws struct tty *tp = sc->of_tty;
173 1.1 ws
174 1.1 ws return (*linesw[tp->t_line].l_write)(tp, uio, flag);
175 1.1 ws }
176 1.1 ws
177 1.1 ws int
178 1.1 ws ofcioctl(dev, cmd, data, flag, p)
179 1.1 ws dev_t dev;
180 1.1 ws u_long cmd;
181 1.1 ws caddr_t data;
182 1.1 ws int flag;
183 1.1 ws struct proc *p;
184 1.1 ws {
185 1.1 ws struct ofc_softc *sc = ofcons_cd.cd_devs[minor(dev)];
186 1.1 ws struct tty *tp = sc->of_tty;
187 1.1 ws int error;
188 1.1 ws
189 1.1 ws if ((error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag, p)) >= 0)
190 1.1 ws return error;
191 1.1 ws if ((error = ttioctl(tp, cmd, data, flag, p)) >= 0)
192 1.1 ws return error;
193 1.1 ws return ENOTTY;
194 1.1 ws }
195 1.1 ws
196 1.1 ws struct tty *
197 1.1 ws ofctty(dev)
198 1.1 ws dev_t dev;
199 1.1 ws {
200 1.1 ws struct ofc_softc *sc = ofcons_cd.cd_devs[minor(dev)];
201 1.1 ws
202 1.1 ws return sc->of_tty;
203 1.1 ws }
204 1.1 ws
205 1.1 ws void
206 1.1 ws ofcstop(tp, flag)
207 1.1 ws struct tty *tp;
208 1.1 ws int flag;
209 1.1 ws {
210 1.1 ws }
211 1.1 ws
212 1.1 ws static void
213 1.1 ws ofcstart(tp)
214 1.1 ws struct tty *tp;
215 1.1 ws {
216 1.1 ws struct clist *cl;
217 1.1 ws int s, len;
218 1.1 ws u_char buf[OFBURSTLEN];
219 1.1 ws
220 1.1 ws s = spltty();
221 1.1 ws if (tp->t_state & (TS_TIMEOUT | TS_BUSY | TS_TTSTOP)) {
222 1.1 ws splx(s);
223 1.1 ws return;
224 1.1 ws }
225 1.1 ws tp->t_state |= TS_BUSY;
226 1.1 ws splx(s);
227 1.1 ws cl = &tp->t_outq;
228 1.1 ws len = q_to_b(cl, buf, OFBURSTLEN);
229 1.1 ws OF_write(stdout, buf, len);
230 1.1 ws s = spltty();
231 1.1 ws tp->t_state &= ~TS_BUSY;
232 1.1 ws if (cl->c_cc) {
233 1.1 ws tp->t_state |= TS_TIMEOUT;
234 1.1 ws timeout(ttrstrt, (void *)tp, 1);
235 1.1 ws }
236 1.1 ws if (cl->c_cc <= tp->t_lowat) {
237 1.1 ws if (tp->t_state & TS_ASLEEP) {
238 1.1 ws tp->t_state &= ~TS_ASLEEP;
239 1.1 ws wakeup(cl);
240 1.1 ws }
241 1.1 ws selwakeup(&tp->t_wsel);
242 1.1 ws }
243 1.1 ws splx(s);
244 1.1 ws }
245 1.1 ws
246 1.1 ws static int
247 1.1 ws ofcparam(tp, t)
248 1.1 ws struct tty *tp;
249 1.1 ws struct termios *t;
250 1.1 ws {
251 1.1 ws tp->t_ispeed = t->c_ispeed;
252 1.1 ws tp->t_ospeed = t->c_ospeed;
253 1.1 ws tp->t_cflag = t->c_cflag;
254 1.1 ws return 0;
255 1.1 ws }
256 1.1 ws
257 1.1 ws static void
258 1.1 ws ofcpoll(aux)
259 1.1 ws void *aux;
260 1.1 ws {
261 1.1 ws struct ofc_softc *sc = aux;
262 1.1 ws struct tty *tp = sc->of_tty;
263 1.1 ws char ch;
264 1.1 ws
265 1.1 ws while (OF_read(stdin, &ch, 1) > 0) {
266 1.1 ws if (tp && (tp->t_state & TS_ISOPEN))
267 1.1 ws (*linesw[tp->t_line].l_rint)(ch, tp);
268 1.1 ws }
269 1.1 ws timeout(ofcpoll, sc, 1);
270 1.1 ws }
271 1.1 ws
272 1.1 ws static int
273 1.1 ws ofcprobe()
274 1.1 ws {
275 1.1 ws int chosen;
276 1.1 ws
277 1.1 ws if (stdin)
278 1.1 ws return 1;
279 1.1 ws if ((chosen = OF_finddevice("/chosen")) == -1)
280 1.1 ws return 0;
281 1.1 ws if (OF_getprop(chosen, "stdin", &stdin, sizeof stdin) != sizeof stdin
282 1.1 ws || OF_getprop(chosen, "stdout", &stdout, sizeof stdout) != sizeof stdout)
283 1.1 ws return 0;
284 1.1 ws return 1;
285 1.1 ws }
286 1.1 ws
287 1.1 ws void
288 1.1 ws ofccnprobe(cd)
289 1.1 ws struct consdev *cd;
290 1.1 ws {
291 1.1 ws int maj;
292 1.1 ws
293 1.1 ws if (!ofcprobe())
294 1.1 ws return;
295 1.1 ws
296 1.1 ws for (maj = 0; maj < nchrdev; maj++)
297 1.1 ws if (cdevsw[maj].d_open == ofcopen)
298 1.1 ws break;
299 1.1 ws cd->cn_dev = makedev(maj, 0);
300 1.1 ws cd->cn_pri = CN_INTERNAL;
301 1.1 ws }
302 1.1 ws
303 1.1 ws void
304 1.1 ws ofccninit(cd)
305 1.1 ws struct consdev *cd;
306 1.1 ws {
307 1.1 ws }
308 1.1 ws
309 1.1 ws int
310 1.1 ws ofccngetc(dev)
311 1.1 ws dev_t dev;
312 1.1 ws {
313 1.1 ws unsigned char ch;
314 1.1 ws int l;
315 1.1 ws
316 1.1 ws while ((l = OF_read(stdin, &ch, 1)) != 1)
317 1.1 ws if (l != -2)
318 1.1 ws return -1;
319 1.1 ws return ch;
320 1.1 ws }
321 1.1 ws
322 1.1 ws void
323 1.1 ws ofccnputc(dev, c)
324 1.1 ws dev_t dev;
325 1.1 ws int c;
326 1.1 ws {
327 1.1 ws char ch = c;
328 1.1 ws
329 1.1 ws OF_write(stdout, &ch, 1);
330 1.1 ws }
331 1.1 ws
332 1.1 ws void
333 1.1 ws ofccnpollc(dev, on)
334 1.1 ws dev_t dev;
335 1.1 ws int on;
336 1.1 ws {
337 1.1 ws struct ofc_softc *sc = ofcons_cd.cd_devs[minor(dev)];
338 1.1 ws
339 1.1 ws if (!sc)
340 1.1 ws return;
341 1.1 ws if (on) {
342 1.1 ws if (sc->of_flags & OFPOLL)
343 1.1 ws untimeout(ofcpoll, sc);
344 1.1 ws sc->of_flags &= ~OFPOLL;
345 1.1 ws } else {
346 1.1 ws if (!(sc->of_flags & OFPOLL)) {
347 1.1 ws sc->of_flags |= OFPOLL;
348 1.1 ws timeout(ofcpoll, sc, 1);
349 1.1 ws }
350 1.1 ws }
351 1.1 ws }
352