1/*
2 * Copyright (c) 1982, 1986, 1989, 1993
3 * The Regents of the University of California. All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 * 3. All advertising materials mentioning features or use of this software
14 * must display the following acknowledgement:
15 * This product includes software developed by the University of
16 * California, Berkeley and its contributors.
17 * 4. Neither the name of the University nor the names of its contributors
18 * may be used to endorse or promote products derived from this software
19 * without specific prior written permission.
20 *
21 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
22 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31 * SUCH DAMAGE.
32 *
| 1/*
2 * Copyright (c) 1982, 1986, 1989, 1993
3 * The Regents of the University of California. All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 * 3. All advertising materials mentioning features or use of this software
14 * must display the following acknowledgement:
15 * This product includes software developed by the University of
16 * California, Berkeley and its contributors.
17 * 4. Neither the name of the University nor the names of its contributors
18 * may be used to endorse or promote products derived from this software
19 * without specific prior written permission.
20 *
21 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
22 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31 * SUCH DAMAGE.
32 *
|
42#include <sys/param.h>
43#include <sys/systm.h>
44#if defined(COMPAT_43) || defined(COMPAT_SUNOS)
45#include <sys/ioctl_compat.h>
46#endif
47#include <sys/proc.h>
48#include <sys/tty.h>
49#include <sys/conf.h>
50#include <sys/fcntl.h>
51#include <sys/poll.h>
52#include <sys/kernel.h>
53#include <sys/vnode.h>
54#include <sys/signalvar.h>
55#include <sys/malloc.h>
56
57MALLOC_DEFINE(M_NLMDM, "nullmodem", "nullmodem data structures");
58
59static void nmdmstart(struct tty *tp);
60static void nmdmstop(struct tty *tp, int rw);
61static void wakeup_other(struct tty *tp, int flag);
62static void nmdminit(int);
63static int nmdmshutdown(void);
64
65static d_open_t nmdmopen;
66static d_close_t nmdmclose;
67static d_read_t nmdmread;
68static d_write_t nmdmwrite;
69static d_ioctl_t nmdmioctl;
70
71#define CDEV_MAJOR 18
72static struct cdevsw nmdm_cdevsw = {
73 .d_open = nmdmopen,
74 .d_close = nmdmclose,
75 .d_read = nmdmread,
76 .d_write = nmdmwrite,
77 .d_ioctl = nmdmioctl,
78 .d_poll = ttypoll,
79 .d_name = "pts",
80 .d_maj = CDEV_MAJOR,
81 .d_flags = D_TTY,
82};
83
84#define BUFSIZ 100 /* Chunk size iomoved to/from user */
85#define NMDM_MAX_NUM 128 /* Artificially limit # devices. */
86#define PF_STOPPED 0x10 /* user told stopped */
87
88struct softpart {
89 struct tty nm_tty;
90 dev_t dev;
91 int modemsignals; /* bits defined in sys/ttycom.h */
92 int gotbreak;
93};
94
95struct nm_softc {
96 int pt_flags;
97 struct softpart part1, part2;
98 struct prison *pt_prison;
99};
100
101static void
102nmdm_crossover(struct nm_softc *pti,
103 struct softpart *ourpart,
104 struct softpart *otherpart);
105
106#define GETPARTS(tp, ourpart, otherpart) \
107do { \
108 struct nm_softc *pti = tp->t_dev->si_drv1; \
109 if (tp == &pti->part1.nm_tty) { \
110 ourpart = &pti->part1; \
111 otherpart = &pti->part2; \
112 } else { \
113 ourpart = &pti->part2; \
114 otherpart = &pti->part1; \
115 } \
116} while (0)
117
118/*
119 * This function creates and initializes a pair of ttys.
120 */
121static void
122nmdminit(n)
123 int n;
124{
125 dev_t dev1, dev2;
126 struct nm_softc *pt;
127
128 /* For now we only map the lower 8 bits of the minor */
129 if (n & ~0xff)
130 return;
131
132 pt = malloc(sizeof(*pt), M_NLMDM, M_WAITOK);
133 bzero(pt, sizeof(*pt));
134 pt->part1.dev = dev1 = make_dev(&nmdm_cdevsw, n+n,
135 0, 0, 0666, "nmdm%dA", n);
136 pt->part2.dev = dev2 = make_dev(&nmdm_cdevsw, n+n+1,
137 0, 0, 0666, "nmdm%dB", n);
138
139 dev1->si_drv1 = dev2->si_drv1 = pt;
140 dev1->si_tty = &pt->part1.nm_tty;
141 dev2->si_tty = &pt->part2.nm_tty;
142 ttyregister(&pt->part1.nm_tty);
143 ttyregister(&pt->part2.nm_tty);
144 pt->part1.nm_tty.t_oproc = nmdmstart;
145 pt->part2.nm_tty.t_oproc = nmdmstart;
146 pt->part1.nm_tty.t_stop = nmdmstop;
147 pt->part2.nm_tty.t_dev = dev1;
148 pt->part1.nm_tty.t_dev = dev2;
149 pt->part2.nm_tty.t_stop = nmdmstop;
150}
151
152/*
153 * Device opened from userland
154 */
155static int
156nmdmopen(dev_t dev, int flag, int devtype, struct thread *td)
157{
158 register struct tty *tp, *tp2;
159 int error;
160 int minr;
161 dev_t nextdev;
162 struct nm_softc *pti;
163 int is_b;
164 int pair;
165 struct softpart *ourpart, *otherpart;
166
167 /*
168 * XXX: Gross hack for DEVFS:
169 * If we openned this device, ensure we have the
170 * next one too, so people can open it.
171 */
172 minr = dev2unit(dev);
173 pair = minr >> 1;
174 is_b = minr & 1;
175
176 if (pair < (NMDM_MAX_NUM - 1)) {
177 nextdev = makedev(major(dev), minr + 2);
178 if (!nextdev->si_drv1) {
179 nmdminit(pair + 1);
180 }
181 } else { /* Limit ourselves to 128 of them for now */
182 if (pair > (NMDM_MAX_NUM - 1))
183 return (ENXIO);
184 }
185 if (!dev->si_drv1)
186 nmdminit(pair);
187
188 if (!dev->si_drv1)
189 return(ENXIO);
190
191 pti = dev->si_drv1;
192 if (is_b)
193 tp = &pti->part2.nm_tty;
194 else
195 tp = &pti->part1.nm_tty;
196 GETPARTS(tp, ourpart, otherpart);
197
198 tp2 = &otherpart->nm_tty;
199 ourpart->modemsignals |= TIOCM_LE;
200
201 if ((tp->t_state & TS_ISOPEN) == 0) {
202 ttychars(tp); /* Set up default chars */
203 tp->t_iflag = TTYDEF_IFLAG;
204 tp->t_oflag = TTYDEF_OFLAG;
205 tp->t_lflag = TTYDEF_LFLAG;
206 tp->t_cflag = TTYDEF_CFLAG;
207 tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
208 } else if (tp->t_state & TS_XCLUDE && suser(td)) {
209 return (EBUSY);
210 } else if (pti->pt_prison != td->td_ucred->cr_prison) {
211 return (EBUSY);
212 }
213
214 /*
215 * If the other side is open we have carrier
216 */
217 if (tp2->t_state & TS_ISOPEN) {
218 (void)(*linesw[tp->t_line].l_modem)(tp, 1);
219 }
220
221 /*
222 * And the other side gets carrier as we are now open.
223 */
224 (void)(*linesw[tp2->t_line].l_modem)(tp2, 1);
225
226 /* External processing makes no sense here */
227 tp->t_lflag &= ~EXTPROC;
228
229 /*
230 * Wait here if we don't have carrier.
231 */
232#if 0
233 while ((tp->t_state & TS_CARR_ON) == 0) {
234 if (flag & FNONBLOCK)
235 break;
236 error = ttysleep(tp, TSA_CARR_ON(tp), TTIPRI | PCATCH,
237 "nmdopn", 0);
238 if (error)
239 return (error);
240 }
241#endif
242
243 /*
244 * Give the line disciplin a chance to set this end up.
245 */
246 error = (*linesw[tp->t_line].l_open)(dev, tp);
247
248 /*
249 * Wake up the other side.
250 * Theoretically not needed.
251 */
252 ourpart->modemsignals |= TIOCM_DTR;
253 nmdm_crossover(pti, ourpart, otherpart);
254 if (error == 0)
255 wakeup_other(tp, FREAD|FWRITE); /* XXX */
256 return (error);
257}
258
259/*
260 * Device closed again
261 */
262static int
263nmdmclose(dev_t dev, int flag, int mode, struct thread *td)
264{
265 register struct tty *tp, *tp2;
266 int err;
267 struct softpart *ourpart, *otherpart;
268
269 /*
270 * let the other end know that the game is up
271 */
272 tp = dev->si_tty;
273 GETPARTS(tp, ourpart, otherpart);
274 tp2 = &otherpart->nm_tty;
275 (void)(*linesw[tp2->t_line].l_modem)(tp2, 0);
276
277 /*
278 * XXX MDMBUF makes no sense for nmdms but would inhibit the above
279 * l_modem(). CLOCAL makes sense but isn't supported. Special
280 * l_modem()s that ignore carrier drop make no sense for nmdms but
281 * may be in use because other parts of the line discipline make
282 * sense for nmdms. Recover by doing everything that a normal
283 * ttymodem() would have done except for sending a SIGHUP.
284 */
285 if (tp2->t_state & TS_ISOPEN) {
286 tp2->t_state &= ~(TS_CARR_ON | TS_CONNECTED);
287 tp2->t_state |= TS_ZOMBIE;
288 ttyflush(tp2, FREAD | FWRITE);
289 }
290
291 err = (*linesw[tp->t_line].l_close)(tp, flag);
292 ourpart->modemsignals &= ~TIOCM_DTR;
293 nmdm_crossover(dev->si_drv1, ourpart, otherpart);
294 nmdmstop(tp, FREAD|FWRITE);
295 (void) ttyclose(tp);
296 return (err);
297}
298
299/*
300 * handle read(2) request from userland
301 */
302static int
303nmdmread(dev_t dev, struct uio *uio, int flag)
304{
305 int error = 0;
306 struct tty *tp, *tp2;
307 struct softpart *ourpart, *otherpart;
308
309 tp = dev->si_tty;
310 GETPARTS(tp, ourpart, otherpart);
311 tp2 = &otherpart->nm_tty;
312
313#if 0
314 if (tp2->t_state & TS_ISOPEN) {
315 error = (*linesw[tp->t_line].l_read)(tp, uio, flag);
316 wakeup_other(tp, FWRITE);
317 } else {
318 if (flag & IO_NDELAY) {
319 return (EWOULDBLOCK);
320 }
321 error = tsleep(TSA_PTC_READ(tp),
322 TTIPRI | PCATCH, "nmdout", 0);
323 }
324 }
325#else
326 if ((error = (*linesw[tp->t_line].l_read)(tp, uio, flag)) == 0)
327 wakeup_other(tp, FWRITE);
328#endif
329 return (error);
330}
331
332/*
333 * Write to pseudo-tty.
334 * Wakeups of controlling tty will happen
335 * indirectly, when tty driver calls nmdmstart.
336 */
337static int
338nmdmwrite(dev_t dev, struct uio *uio, int flag)
339{
340 register u_char *cp = 0;
341 register int cc = 0;
342 u_char locbuf[BUFSIZ];
343 int cnt = 0;
344 int error = 0;
345 struct tty *tp1, *tp;
346 struct softpart *ourpart, *otherpart;
347
348 tp1 = dev->si_tty;
349 /*
350 * Get the other tty struct.
351 * basically we are writing into the INPUT side of the other device.
352 */
353 GETPARTS(tp1, ourpart, otherpart);
354 tp = &otherpart->nm_tty;
355
356again:
357 if ((tp->t_state & TS_ISOPEN) == 0)
358 return (EIO);
359 while (uio->uio_resid > 0 || cc > 0) {
360 /*
361 * Fill up the buffer if it's empty
362 */
363 if (cc == 0) {
364 cc = min(uio->uio_resid, BUFSIZ);
365 cp = locbuf;
366 error = uiomove((caddr_t)cp, cc, uio);
367 if (error)
368 return (error);
369 /* check again for safety */
370 if ((tp->t_state & TS_ISOPEN) == 0) {
371 /* adjust for data copied in but not written */
372 uio->uio_resid += cc;
373 return (EIO);
374 }
375 }
376 while (cc > 0) {
377 if (((tp->t_rawq.c_cc + tp->t_canq.c_cc) >= (TTYHOG-2))
378 && ((tp->t_canq.c_cc > 0) || !(tp->t_iflag&ICANON))) {
379 /*
380 * Come here to wait for space in outq,
381 * or space in rawq, or an empty canq.
382 */
383 wakeup(TSA_HUP_OR_INPUT(tp));
384 if ((tp->t_state & TS_CONNECTED) == 0) {
385 /*
386 * Data piled up because not connected.
387 * Adjust for data copied in but
388 * not written.
389 */
390 uio->uio_resid += cc;
391 return (EIO);
392 }
393 if (flag & IO_NDELAY) {
394 /*
395 * Don't wait if asked not to.
396 * Adjust for data copied in but
397 * not written.
398 */
399 uio->uio_resid += cc;
400 if (cnt == 0)
401 return (EWOULDBLOCK);
402 return (0);
403 }
404 error = tsleep(TSA_PTC_WRITE(tp),
405 TTOPRI | PCATCH, "nmdout", 0);
406 if (error) {
407 /*
408 * Tsleep returned (signal?).
409 * Go find out what the user wants.
410 * adjust for data copied in but
411 * not written
412 */
413 uio->uio_resid += cc;
414 return (error);
415 }
416 goto again;
417 }
418 (*linesw[tp->t_line].l_rint)(*cp++, tp);
419 cnt++;
420 cc--;
421 }
422 cc = 0;
423 }
424 return (0);
425}
426
427/*
428 * Start output on pseudo-tty.
429 * Wake up process selecting or sleeping for input from controlling tty.
430 */
431static void
432nmdmstart(struct tty *tp)
433{
434 register struct nm_softc *pti = tp->t_dev->si_drv1;
435
436 if (tp->t_state & TS_TTSTOP)
437 return;
438 pti->pt_flags &= ~PF_STOPPED;
439 wakeup_other(tp, FREAD);
440}
441
442/* Wakes up the OTHER tty;*/
443static void
444wakeup_other(struct tty *tp, int flag)
445{
446 struct softpart *ourpart, *otherpart;
447
448 GETPARTS(tp, ourpart, otherpart);
449 if (flag & FREAD) {
450 selwakeup(&otherpart->nm_tty.t_rsel);
451 wakeup(TSA_PTC_READ((&otherpart->nm_tty)));
452 }
453 if (flag & FWRITE) {
454 selwakeup(&otherpart->nm_tty.t_wsel);
455 wakeup(TSA_PTC_WRITE((&otherpart->nm_tty)));
456 }
457}
458
459/*
460 * stopped output on tty, called when device is closed
461 */
462static void
463nmdmstop(register struct tty *tp, int flush)
464{
465 struct nm_softc *pti = tp->t_dev->si_drv1;
466 int flag;
467
468 /* note: FLUSHREAD and FLUSHWRITE already ok */
469 if (flush == 0) {
470 flush = TIOCPKT_STOP;
471 pti->pt_flags |= PF_STOPPED;
472 } else
473 pti->pt_flags &= ~PF_STOPPED;
474 /* change of perspective */
475 flag = 0;
476 if (flush & FREAD)
477 flag |= FWRITE;
478 if (flush & FWRITE)
479 flag |= FREAD;
480 wakeup_other(tp, flag);
481}
482
483/*
484 * handle ioctl(2) request from userland
485 */
486static int
487nmdmioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct thread *td)
488{
489 register struct tty *tp = dev->si_tty;
490 struct nm_softc *pti = dev->si_drv1;
491 int error, s;
492 register struct tty *tp2;
493 struct softpart *ourpart, *otherpart;
494
495 s = spltty();
496 GETPARTS(tp, ourpart, otherpart);
497 tp2 = &otherpart->nm_tty;
498
499 error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag, td);
500 if (error == ENOIOCTL)
501 error = ttioctl(tp, cmd, data, flag);
502 if (error == ENOIOCTL) {
503 switch (cmd) {
504 case TIOCSBRK:
505 otherpart->gotbreak = 1;
506 break;
507 case TIOCCBRK:
508 break;
509 case TIOCSDTR:
510 ourpart->modemsignals |= TIOCM_DTR;
511 break;
512 case TIOCCDTR:
513 ourpart->modemsignals &= TIOCM_DTR;
514 break;
515 case TIOCMSET:
516 ourpart->modemsignals = *(int *)data;
517 otherpart->modemsignals = *(int *)data;
518 break;
519 case TIOCMBIS:
520 ourpart->modemsignals |= *(int *)data;
521 break;
522 case TIOCMBIC:
523 ourpart->modemsignals &= ~(*(int *)data);
524 otherpart->modemsignals &= ~(*(int *)data);
525 break;
526 case TIOCMGET:
527 *(int *)data = ourpart->modemsignals;
528 break;
529 case TIOCMSDTRWAIT:
530 break;
531 case TIOCMGDTRWAIT:
532 *(int *)data = 0;
533 break;
534 case TIOCTIMESTAMP:
535 /* FALLTHROUGH */
536 case TIOCDCDTIMESTAMP:
537 default:
538 splx(s);
539 error = ENOTTY;
540 return (error);
541 }
542 error = 0;
543 nmdm_crossover(pti, ourpart, otherpart);
544 }
545 splx(s);
546 return (error);
547}
548
549static void
550nmdm_crossover(struct nm_softc *pti, struct softpart *ourpart,
551 struct softpart *otherpart)
552{
553 otherpart->modemsignals &= ~(TIOCM_CTS|TIOCM_CAR);
554 if (ourpart->modemsignals & TIOCM_RTS)
555 otherpart->modemsignals |= TIOCM_CTS;
556 if (ourpart->modemsignals & TIOCM_DTR)
557 otherpart->modemsignals |= TIOCM_CAR;
558}
559
560/*
561 * Module handling
562 */
563static int
564nmdm_modevent(module_t mod, int type, void *data)
565{
566 int error = 0;
567
568 switch(type) {
569 case MOD_LOAD: /* start with 4 of them */
570 nmdminit(0);
571 nmdminit(1);
572 nmdminit(2);
573 nmdminit(3);
574 break;
575
576 case MOD_SHUTDOWN:
577 /* FALLTHROUGH */
578 case MOD_UNLOAD:
579 nmdmshutdown();
580 break;
581 default:
582 error = EOPNOTSUPP;
583 }
584 return (error);
585}
586
587/*
588 * Handle teardown of device
589 */
590static int
591nmdmshutdown(void)
592{
593 int i;
594 dev_t nextdev1;
595 dev_t nextdev2;
596 void * ptr1;
597
598 for(i = 0;( i < NMDM_MAX_NUM) ;i++) {
599 nextdev1 = makedev(CDEV_MAJOR, (i+i) );
600 nextdev2 = makedev(CDEV_MAJOR, (i+i) + 1);
601 ptr1 = nextdev1->si_drv1;
602 if (ptr1) {
603 revoke_and_destroy_dev(nextdev1);
604 revoke_and_destroy_dev(nextdev2);
605 free(ptr1, M_NLMDM);
606 } else {
607 freedev(nextdev1);
608 freedev(nextdev2);
609 }
610 }
611 return(0);
612}
613
614DEV_MODULE(nmdm, nmdm_modevent, NULL);
| 44#include <sys/param.h>
45#include <sys/systm.h>
46#if defined(COMPAT_43) || defined(COMPAT_SUNOS)
47#include <sys/ioctl_compat.h>
48#endif
49#include <sys/proc.h>
50#include <sys/tty.h>
51#include <sys/conf.h>
52#include <sys/fcntl.h>
53#include <sys/poll.h>
54#include <sys/kernel.h>
55#include <sys/vnode.h>
56#include <sys/signalvar.h>
57#include <sys/malloc.h>
58
59MALLOC_DEFINE(M_NLMDM, "nullmodem", "nullmodem data structures");
60
61static void nmdmstart(struct tty *tp);
62static void nmdmstop(struct tty *tp, int rw);
63static void wakeup_other(struct tty *tp, int flag);
64static void nmdminit(int);
65static int nmdmshutdown(void);
66
67static d_open_t nmdmopen;
68static d_close_t nmdmclose;
69static d_read_t nmdmread;
70static d_write_t nmdmwrite;
71static d_ioctl_t nmdmioctl;
72
73#define CDEV_MAJOR 18
74static struct cdevsw nmdm_cdevsw = {
75 .d_open = nmdmopen,
76 .d_close = nmdmclose,
77 .d_read = nmdmread,
78 .d_write = nmdmwrite,
79 .d_ioctl = nmdmioctl,
80 .d_poll = ttypoll,
81 .d_name = "pts",
82 .d_maj = CDEV_MAJOR,
83 .d_flags = D_TTY,
84};
85
86#define BUFSIZ 100 /* Chunk size iomoved to/from user */
87#define NMDM_MAX_NUM 128 /* Artificially limit # devices. */
88#define PF_STOPPED 0x10 /* user told stopped */
89
90struct softpart {
91 struct tty nm_tty;
92 dev_t dev;
93 int modemsignals; /* bits defined in sys/ttycom.h */
94 int gotbreak;
95};
96
97struct nm_softc {
98 int pt_flags;
99 struct softpart part1, part2;
100 struct prison *pt_prison;
101};
102
103static void
104nmdm_crossover(struct nm_softc *pti,
105 struct softpart *ourpart,
106 struct softpart *otherpart);
107
108#define GETPARTS(tp, ourpart, otherpart) \
109do { \
110 struct nm_softc *pti = tp->t_dev->si_drv1; \
111 if (tp == &pti->part1.nm_tty) { \
112 ourpart = &pti->part1; \
113 otherpart = &pti->part2; \
114 } else { \
115 ourpart = &pti->part2; \
116 otherpart = &pti->part1; \
117 } \
118} while (0)
119
120/*
121 * This function creates and initializes a pair of ttys.
122 */
123static void
124nmdminit(n)
125 int n;
126{
127 dev_t dev1, dev2;
128 struct nm_softc *pt;
129
130 /* For now we only map the lower 8 bits of the minor */
131 if (n & ~0xff)
132 return;
133
134 pt = malloc(sizeof(*pt), M_NLMDM, M_WAITOK);
135 bzero(pt, sizeof(*pt));
136 pt->part1.dev = dev1 = make_dev(&nmdm_cdevsw, n+n,
137 0, 0, 0666, "nmdm%dA", n);
138 pt->part2.dev = dev2 = make_dev(&nmdm_cdevsw, n+n+1,
139 0, 0, 0666, "nmdm%dB", n);
140
141 dev1->si_drv1 = dev2->si_drv1 = pt;
142 dev1->si_tty = &pt->part1.nm_tty;
143 dev2->si_tty = &pt->part2.nm_tty;
144 ttyregister(&pt->part1.nm_tty);
145 ttyregister(&pt->part2.nm_tty);
146 pt->part1.nm_tty.t_oproc = nmdmstart;
147 pt->part2.nm_tty.t_oproc = nmdmstart;
148 pt->part1.nm_tty.t_stop = nmdmstop;
149 pt->part2.nm_tty.t_dev = dev1;
150 pt->part1.nm_tty.t_dev = dev2;
151 pt->part2.nm_tty.t_stop = nmdmstop;
152}
153
154/*
155 * Device opened from userland
156 */
157static int
158nmdmopen(dev_t dev, int flag, int devtype, struct thread *td)
159{
160 register struct tty *tp, *tp2;
161 int error;
162 int minr;
163 dev_t nextdev;
164 struct nm_softc *pti;
165 int is_b;
166 int pair;
167 struct softpart *ourpart, *otherpart;
168
169 /*
170 * XXX: Gross hack for DEVFS:
171 * If we openned this device, ensure we have the
172 * next one too, so people can open it.
173 */
174 minr = dev2unit(dev);
175 pair = minr >> 1;
176 is_b = minr & 1;
177
178 if (pair < (NMDM_MAX_NUM - 1)) {
179 nextdev = makedev(major(dev), minr + 2);
180 if (!nextdev->si_drv1) {
181 nmdminit(pair + 1);
182 }
183 } else { /* Limit ourselves to 128 of them for now */
184 if (pair > (NMDM_MAX_NUM - 1))
185 return (ENXIO);
186 }
187 if (!dev->si_drv1)
188 nmdminit(pair);
189
190 if (!dev->si_drv1)
191 return(ENXIO);
192
193 pti = dev->si_drv1;
194 if (is_b)
195 tp = &pti->part2.nm_tty;
196 else
197 tp = &pti->part1.nm_tty;
198 GETPARTS(tp, ourpart, otherpart);
199
200 tp2 = &otherpart->nm_tty;
201 ourpart->modemsignals |= TIOCM_LE;
202
203 if ((tp->t_state & TS_ISOPEN) == 0) {
204 ttychars(tp); /* Set up default chars */
205 tp->t_iflag = TTYDEF_IFLAG;
206 tp->t_oflag = TTYDEF_OFLAG;
207 tp->t_lflag = TTYDEF_LFLAG;
208 tp->t_cflag = TTYDEF_CFLAG;
209 tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
210 } else if (tp->t_state & TS_XCLUDE && suser(td)) {
211 return (EBUSY);
212 } else if (pti->pt_prison != td->td_ucred->cr_prison) {
213 return (EBUSY);
214 }
215
216 /*
217 * If the other side is open we have carrier
218 */
219 if (tp2->t_state & TS_ISOPEN) {
220 (void)(*linesw[tp->t_line].l_modem)(tp, 1);
221 }
222
223 /*
224 * And the other side gets carrier as we are now open.
225 */
226 (void)(*linesw[tp2->t_line].l_modem)(tp2, 1);
227
228 /* External processing makes no sense here */
229 tp->t_lflag &= ~EXTPROC;
230
231 /*
232 * Wait here if we don't have carrier.
233 */
234#if 0
235 while ((tp->t_state & TS_CARR_ON) == 0) {
236 if (flag & FNONBLOCK)
237 break;
238 error = ttysleep(tp, TSA_CARR_ON(tp), TTIPRI | PCATCH,
239 "nmdopn", 0);
240 if (error)
241 return (error);
242 }
243#endif
244
245 /*
246 * Give the line disciplin a chance to set this end up.
247 */
248 error = (*linesw[tp->t_line].l_open)(dev, tp);
249
250 /*
251 * Wake up the other side.
252 * Theoretically not needed.
253 */
254 ourpart->modemsignals |= TIOCM_DTR;
255 nmdm_crossover(pti, ourpart, otherpart);
256 if (error == 0)
257 wakeup_other(tp, FREAD|FWRITE); /* XXX */
258 return (error);
259}
260
261/*
262 * Device closed again
263 */
264static int
265nmdmclose(dev_t dev, int flag, int mode, struct thread *td)
266{
267 register struct tty *tp, *tp2;
268 int err;
269 struct softpart *ourpart, *otherpart;
270
271 /*
272 * let the other end know that the game is up
273 */
274 tp = dev->si_tty;
275 GETPARTS(tp, ourpart, otherpart);
276 tp2 = &otherpart->nm_tty;
277 (void)(*linesw[tp2->t_line].l_modem)(tp2, 0);
278
279 /*
280 * XXX MDMBUF makes no sense for nmdms but would inhibit the above
281 * l_modem(). CLOCAL makes sense but isn't supported. Special
282 * l_modem()s that ignore carrier drop make no sense for nmdms but
283 * may be in use because other parts of the line discipline make
284 * sense for nmdms. Recover by doing everything that a normal
285 * ttymodem() would have done except for sending a SIGHUP.
286 */
287 if (tp2->t_state & TS_ISOPEN) {
288 tp2->t_state &= ~(TS_CARR_ON | TS_CONNECTED);
289 tp2->t_state |= TS_ZOMBIE;
290 ttyflush(tp2, FREAD | FWRITE);
291 }
292
293 err = (*linesw[tp->t_line].l_close)(tp, flag);
294 ourpart->modemsignals &= ~TIOCM_DTR;
295 nmdm_crossover(dev->si_drv1, ourpart, otherpart);
296 nmdmstop(tp, FREAD|FWRITE);
297 (void) ttyclose(tp);
298 return (err);
299}
300
301/*
302 * handle read(2) request from userland
303 */
304static int
305nmdmread(dev_t dev, struct uio *uio, int flag)
306{
307 int error = 0;
308 struct tty *tp, *tp2;
309 struct softpart *ourpart, *otherpart;
310
311 tp = dev->si_tty;
312 GETPARTS(tp, ourpart, otherpart);
313 tp2 = &otherpart->nm_tty;
314
315#if 0
316 if (tp2->t_state & TS_ISOPEN) {
317 error = (*linesw[tp->t_line].l_read)(tp, uio, flag);
318 wakeup_other(tp, FWRITE);
319 } else {
320 if (flag & IO_NDELAY) {
321 return (EWOULDBLOCK);
322 }
323 error = tsleep(TSA_PTC_READ(tp),
324 TTIPRI | PCATCH, "nmdout", 0);
325 }
326 }
327#else
328 if ((error = (*linesw[tp->t_line].l_read)(tp, uio, flag)) == 0)
329 wakeup_other(tp, FWRITE);
330#endif
331 return (error);
332}
333
334/*
335 * Write to pseudo-tty.
336 * Wakeups of controlling tty will happen
337 * indirectly, when tty driver calls nmdmstart.
338 */
339static int
340nmdmwrite(dev_t dev, struct uio *uio, int flag)
341{
342 register u_char *cp = 0;
343 register int cc = 0;
344 u_char locbuf[BUFSIZ];
345 int cnt = 0;
346 int error = 0;
347 struct tty *tp1, *tp;
348 struct softpart *ourpart, *otherpart;
349
350 tp1 = dev->si_tty;
351 /*
352 * Get the other tty struct.
353 * basically we are writing into the INPUT side of the other device.
354 */
355 GETPARTS(tp1, ourpart, otherpart);
356 tp = &otherpart->nm_tty;
357
358again:
359 if ((tp->t_state & TS_ISOPEN) == 0)
360 return (EIO);
361 while (uio->uio_resid > 0 || cc > 0) {
362 /*
363 * Fill up the buffer if it's empty
364 */
365 if (cc == 0) {
366 cc = min(uio->uio_resid, BUFSIZ);
367 cp = locbuf;
368 error = uiomove((caddr_t)cp, cc, uio);
369 if (error)
370 return (error);
371 /* check again for safety */
372 if ((tp->t_state & TS_ISOPEN) == 0) {
373 /* adjust for data copied in but not written */
374 uio->uio_resid += cc;
375 return (EIO);
376 }
377 }
378 while (cc > 0) {
379 if (((tp->t_rawq.c_cc + tp->t_canq.c_cc) >= (TTYHOG-2))
380 && ((tp->t_canq.c_cc > 0) || !(tp->t_iflag&ICANON))) {
381 /*
382 * Come here to wait for space in outq,
383 * or space in rawq, or an empty canq.
384 */
385 wakeup(TSA_HUP_OR_INPUT(tp));
386 if ((tp->t_state & TS_CONNECTED) == 0) {
387 /*
388 * Data piled up because not connected.
389 * Adjust for data copied in but
390 * not written.
391 */
392 uio->uio_resid += cc;
393 return (EIO);
394 }
395 if (flag & IO_NDELAY) {
396 /*
397 * Don't wait if asked not to.
398 * Adjust for data copied in but
399 * not written.
400 */
401 uio->uio_resid += cc;
402 if (cnt == 0)
403 return (EWOULDBLOCK);
404 return (0);
405 }
406 error = tsleep(TSA_PTC_WRITE(tp),
407 TTOPRI | PCATCH, "nmdout", 0);
408 if (error) {
409 /*
410 * Tsleep returned (signal?).
411 * Go find out what the user wants.
412 * adjust for data copied in but
413 * not written
414 */
415 uio->uio_resid += cc;
416 return (error);
417 }
418 goto again;
419 }
420 (*linesw[tp->t_line].l_rint)(*cp++, tp);
421 cnt++;
422 cc--;
423 }
424 cc = 0;
425 }
426 return (0);
427}
428
429/*
430 * Start output on pseudo-tty.
431 * Wake up process selecting or sleeping for input from controlling tty.
432 */
433static void
434nmdmstart(struct tty *tp)
435{
436 register struct nm_softc *pti = tp->t_dev->si_drv1;
437
438 if (tp->t_state & TS_TTSTOP)
439 return;
440 pti->pt_flags &= ~PF_STOPPED;
441 wakeup_other(tp, FREAD);
442}
443
444/* Wakes up the OTHER tty;*/
445static void
446wakeup_other(struct tty *tp, int flag)
447{
448 struct softpart *ourpart, *otherpart;
449
450 GETPARTS(tp, ourpart, otherpart);
451 if (flag & FREAD) {
452 selwakeup(&otherpart->nm_tty.t_rsel);
453 wakeup(TSA_PTC_READ((&otherpart->nm_tty)));
454 }
455 if (flag & FWRITE) {
456 selwakeup(&otherpart->nm_tty.t_wsel);
457 wakeup(TSA_PTC_WRITE((&otherpart->nm_tty)));
458 }
459}
460
461/*
462 * stopped output on tty, called when device is closed
463 */
464static void
465nmdmstop(register struct tty *tp, int flush)
466{
467 struct nm_softc *pti = tp->t_dev->si_drv1;
468 int flag;
469
470 /* note: FLUSHREAD and FLUSHWRITE already ok */
471 if (flush == 0) {
472 flush = TIOCPKT_STOP;
473 pti->pt_flags |= PF_STOPPED;
474 } else
475 pti->pt_flags &= ~PF_STOPPED;
476 /* change of perspective */
477 flag = 0;
478 if (flush & FREAD)
479 flag |= FWRITE;
480 if (flush & FWRITE)
481 flag |= FREAD;
482 wakeup_other(tp, flag);
483}
484
485/*
486 * handle ioctl(2) request from userland
487 */
488static int
489nmdmioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct thread *td)
490{
491 register struct tty *tp = dev->si_tty;
492 struct nm_softc *pti = dev->si_drv1;
493 int error, s;
494 register struct tty *tp2;
495 struct softpart *ourpart, *otherpart;
496
497 s = spltty();
498 GETPARTS(tp, ourpart, otherpart);
499 tp2 = &otherpart->nm_tty;
500
501 error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag, td);
502 if (error == ENOIOCTL)
503 error = ttioctl(tp, cmd, data, flag);
504 if (error == ENOIOCTL) {
505 switch (cmd) {
506 case TIOCSBRK:
507 otherpart->gotbreak = 1;
508 break;
509 case TIOCCBRK:
510 break;
511 case TIOCSDTR:
512 ourpart->modemsignals |= TIOCM_DTR;
513 break;
514 case TIOCCDTR:
515 ourpart->modemsignals &= TIOCM_DTR;
516 break;
517 case TIOCMSET:
518 ourpart->modemsignals = *(int *)data;
519 otherpart->modemsignals = *(int *)data;
520 break;
521 case TIOCMBIS:
522 ourpart->modemsignals |= *(int *)data;
523 break;
524 case TIOCMBIC:
525 ourpart->modemsignals &= ~(*(int *)data);
526 otherpart->modemsignals &= ~(*(int *)data);
527 break;
528 case TIOCMGET:
529 *(int *)data = ourpart->modemsignals;
530 break;
531 case TIOCMSDTRWAIT:
532 break;
533 case TIOCMGDTRWAIT:
534 *(int *)data = 0;
535 break;
536 case TIOCTIMESTAMP:
537 /* FALLTHROUGH */
538 case TIOCDCDTIMESTAMP:
539 default:
540 splx(s);
541 error = ENOTTY;
542 return (error);
543 }
544 error = 0;
545 nmdm_crossover(pti, ourpart, otherpart);
546 }
547 splx(s);
548 return (error);
549}
550
551static void
552nmdm_crossover(struct nm_softc *pti, struct softpart *ourpart,
553 struct softpart *otherpart)
554{
555 otherpart->modemsignals &= ~(TIOCM_CTS|TIOCM_CAR);
556 if (ourpart->modemsignals & TIOCM_RTS)
557 otherpart->modemsignals |= TIOCM_CTS;
558 if (ourpart->modemsignals & TIOCM_DTR)
559 otherpart->modemsignals |= TIOCM_CAR;
560}
561
562/*
563 * Module handling
564 */
565static int
566nmdm_modevent(module_t mod, int type, void *data)
567{
568 int error = 0;
569
570 switch(type) {
571 case MOD_LOAD: /* start with 4 of them */
572 nmdminit(0);
573 nmdminit(1);
574 nmdminit(2);
575 nmdminit(3);
576 break;
577
578 case MOD_SHUTDOWN:
579 /* FALLTHROUGH */
580 case MOD_UNLOAD:
581 nmdmshutdown();
582 break;
583 default:
584 error = EOPNOTSUPP;
585 }
586 return (error);
587}
588
589/*
590 * Handle teardown of device
591 */
592static int
593nmdmshutdown(void)
594{
595 int i;
596 dev_t nextdev1;
597 dev_t nextdev2;
598 void * ptr1;
599
600 for(i = 0;( i < NMDM_MAX_NUM) ;i++) {
601 nextdev1 = makedev(CDEV_MAJOR, (i+i) );
602 nextdev2 = makedev(CDEV_MAJOR, (i+i) + 1);
603 ptr1 = nextdev1->si_drv1;
604 if (ptr1) {
605 revoke_and_destroy_dev(nextdev1);
606 revoke_and_destroy_dev(nextdev2);
607 free(ptr1, M_NLMDM);
608 } else {
609 freedev(nextdev1);
610 freedev(nextdev2);
611 }
612 }
613 return(0);
614}
615
616DEV_MODULE(nmdm, nmdm_modevent, NULL);
|