1 /* $NetBSD: ucom.c,v 1.40 2001/11/13 06:24:54 lukem Exp $ */
2
3 /*-
4 * Copyright (c) 2001-2003, 2005, 2008
5 * Shunsuke Akiyama <akiyama@jp.FreeBSD.org>.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 * SUCH DAMAGE.
28 */
29
30 #include <sys/cdefs.h>
31 __FBSDID("$FreeBSD: stable/10/sys/dev/usb/serial/usb_serial.c 294637 2016-01-23 19:13:48Z ian $");
32
33 /*-
34 * Copyright (c) 1998, 2000 The NetBSD Foundation, Inc.
35 * All rights reserved.
36 *
37 * This code is derived from software contributed to The NetBSD Foundation
38 * by Lennart Augustsson (lennart@augustsson.net) at
39 * Carlstedt Research & Technology.
40 *
41 * Redistribution and use in source and binary forms, with or without
42 * modification, are permitted provided that the following conditions
43 * are met:
44 * 1. Redistributions of source code must retain the above copyright
45 * notice, this list of conditions and the following disclaimer.
46 * 2. Redistributions in binary form must reproduce the above copyright
47 * notice, this list of conditions and the following disclaimer in the
48 * documentation and/or other materials provided with the distribution.
49 *
50 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
51 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
52 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
53 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
54 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
55 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
56 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
57 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
58 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
59 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
60 * POSSIBILITY OF SUCH DAMAGE.
61 */
62
63 #include <sys/stdint.h>
64 #include <sys/stddef.h>
65 #include <sys/param.h>
66 #include <sys/queue.h>
67 #include <sys/types.h>
68 #include <sys/systm.h>
69 #include <sys/kernel.h>
70 #include <sys/bus.h>
71 #include <sys/module.h>
72 #include <sys/lock.h>
73 #include <sys/mutex.h>
74 #include <sys/condvar.h>
75 #include <sys/sysctl.h>
76 #include <sys/sx.h>
77 #include <sys/unistd.h>
78 #include <sys/callout.h>
79 #include <sys/malloc.h>
80 #include <sys/priv.h>
81 #include <sys/cons.h>
82 #include <sys/kdb.h>
83
84 #include <dev/uart/uart_ppstypes.h>
85
86 #include <dev/usb/usb.h>
87 #include <dev/usb/usbdi.h>
88 #include <dev/usb/usbdi_util.h>
89
90 #define USB_DEBUG_VAR ucom_debug
91 #include <dev/usb/usb_debug.h>
92 #include <dev/usb/usb_busdma.h>
93 #include <dev/usb/usb_process.h>
94
95 #include <dev/usb/serial/usb_serial.h>
96
97 #include "opt_gdb.h"
98
99 static SYSCTL_NODE(_hw_usb, OID_AUTO, ucom, CTLFLAG_RW, 0, "USB ucom");
100
101 static int ucom_pps_mode;
102
103 SYSCTL_INT(_hw_usb_ucom, OID_AUTO, pps_mode, CTLFLAG_RWTUN,
104 &ucom_pps_mode, 0,
105 "pulse capture mode: 0/1/2=disabled/CTS/DCD; add 0x10 to invert");
106
107 #ifdef USB_DEBUG
108 static int ucom_debug = 0;
109
110 SYSCTL_INT(_hw_usb_ucom, OID_AUTO, debug, CTLFLAG_RW,
111 &ucom_debug, 0, "ucom debug level");
112 #endif
113
114 #define UCOM_CONS_BUFSIZE 1024
115
116 static uint8_t ucom_cons_rx_buf[UCOM_CONS_BUFSIZE];
117 static uint8_t ucom_cons_tx_buf[UCOM_CONS_BUFSIZE];
118
119 static unsigned int ucom_cons_rx_low = 0;
120 static unsigned int ucom_cons_rx_high = 0;
121
122 static unsigned int ucom_cons_tx_low = 0;
123 static unsigned int ucom_cons_tx_high = 0;
124
125 static int ucom_cons_unit = -1;
126 static int ucom_cons_subunit = 0;
127 static int ucom_cons_baud = 9600;
128 static struct ucom_softc *ucom_cons_softc = NULL;
129
130 TUNABLE_INT("hw.usb.ucom.cons_unit", &ucom_cons_unit);
131 SYSCTL_INT(_hw_usb_ucom, OID_AUTO, cons_unit, CTLFLAG_RW | CTLFLAG_TUN,
132 &ucom_cons_unit, 0, "console unit number");
133 TUNABLE_INT("hw.usb.ucom.cons_subunit", &ucom_cons_subunit);
134 SYSCTL_INT(_hw_usb_ucom, OID_AUTO, cons_subunit, CTLFLAG_RW | CTLFLAG_TUN,
135 &ucom_cons_subunit, 0, "console subunit number");
136 TUNABLE_INT("hw.usb.ucom.cons_baud", &ucom_cons_baud);
137 SYSCTL_INT(_hw_usb_ucom, OID_AUTO, cons_baud, CTLFLAG_RW | CTLFLAG_TUN,
138 &ucom_cons_baud, 0, "console baud rate");
139
140 static usb_proc_callback_t ucom_cfg_start_transfers;
141 static usb_proc_callback_t ucom_cfg_open;
142 static usb_proc_callback_t ucom_cfg_close;
143 static usb_proc_callback_t ucom_cfg_line_state;
144 static usb_proc_callback_t ucom_cfg_status_change;
145 static usb_proc_callback_t ucom_cfg_param;
146
147 static int ucom_unit_alloc(void);
148 static void ucom_unit_free(int);
149 static int ucom_attach_tty(struct ucom_super_softc *, struct ucom_softc *);
150 static void ucom_detach_tty(struct ucom_super_softc *, struct ucom_softc *);
151 static void ucom_queue_command(struct ucom_softc *,
152 usb_proc_callback_t *, struct termios *pt,
153 struct usb_proc_msg *t0, struct usb_proc_msg *t1);
154 static void ucom_shutdown(struct ucom_softc *);
155 static void ucom_ring(struct ucom_softc *, uint8_t);
156 static void ucom_break(struct ucom_softc *, uint8_t);
157 static void ucom_dtr(struct ucom_softc *, uint8_t);
158 static void ucom_rts(struct ucom_softc *, uint8_t);
159
160 static tsw_open_t ucom_open;
161 static tsw_close_t ucom_close;
162 static tsw_ioctl_t ucom_ioctl;
163 static tsw_modem_t ucom_modem;
164 static tsw_param_t ucom_param;
165 static tsw_outwakeup_t ucom_outwakeup;
166 static tsw_inwakeup_t ucom_inwakeup;
167 static tsw_free_t ucom_free;
168
169 static struct ttydevsw ucom_class = {
170 .tsw_flags = TF_INITLOCK | TF_CALLOUT,
171 .tsw_open = ucom_open,
172 .tsw_close = ucom_close,
173 .tsw_outwakeup = ucom_outwakeup,
174 .tsw_inwakeup = ucom_inwakeup,
175 .tsw_ioctl = ucom_ioctl,
176 .tsw_param = ucom_param,
177 .tsw_modem = ucom_modem,
178 .tsw_free = ucom_free,
179 };
180
181 MODULE_DEPEND(ucom, usb, 1, 1, 1);
182 MODULE_VERSION(ucom, 1);
183
184 #define UCOM_UNIT_MAX 128 /* maximum number of units */
185 #define UCOM_TTY_PREFIX "U"
186
187 static struct unrhdr *ucom_unrhdr;
188 static struct mtx ucom_mtx;
189 static int ucom_close_refs;
190
191 static void
ucom_init(void * arg)192 ucom_init(void *arg)
193 {
194 DPRINTF("\n");
195 ucom_unrhdr = new_unrhdr(0, UCOM_UNIT_MAX - 1, NULL);
196 mtx_init(&ucom_mtx, "UCOM MTX", NULL, MTX_DEF);
197 }
198 SYSINIT(ucom_init, SI_SUB_KLD - 1, SI_ORDER_ANY, ucom_init, NULL);
199
200 static void
ucom_uninit(void * arg)201 ucom_uninit(void *arg)
202 {
203 struct unrhdr *hdr;
204 hdr = ucom_unrhdr;
205 ucom_unrhdr = NULL;
206
207 DPRINTF("\n");
208
209 if (hdr != NULL)
210 delete_unrhdr(hdr);
211
212 mtx_destroy(&ucom_mtx);
213 }
214 SYSUNINIT(ucom_uninit, SI_SUB_KLD - 3, SI_ORDER_ANY, ucom_uninit, NULL);
215
216 /*
217 * Mark a unit number (the X in cuaUX) as in use.
218 *
219 * Note that devices using a different naming scheme (see ucom_tty_name()
220 * callback) still use this unit allocation.
221 */
222 static int
ucom_unit_alloc(void)223 ucom_unit_alloc(void)
224 {
225 int unit;
226
227 /* sanity checks */
228 if (ucom_unrhdr == NULL) {
229 DPRINTF("ucom_unrhdr is NULL\n");
230 return (-1);
231 }
232 unit = alloc_unr(ucom_unrhdr);
233 DPRINTF("unit %d is allocated\n", unit);
234 return (unit);
235 }
236
237 /*
238 * Mark the unit number as not in use.
239 */
240 static void
ucom_unit_free(int unit)241 ucom_unit_free(int unit)
242 {
243 /* sanity checks */
244 if (unit < 0 || unit >= UCOM_UNIT_MAX || ucom_unrhdr == NULL) {
245 DPRINTF("cannot free unit number\n");
246 return;
247 }
248 DPRINTF("unit %d is freed\n", unit);
249 free_unr(ucom_unrhdr, unit);
250 }
251
252 /*
253 * Setup a group of one or more serial ports.
254 *
255 * The mutex pointed to by "mtx" is applied before all
256 * callbacks are called back. Also "mtx" must be applied
257 * before calling into the ucom-layer!
258 */
259 int
ucom_attach(struct ucom_super_softc * ssc,struct ucom_softc * sc,int subunits,void * parent,const struct ucom_callback * callback,struct mtx * mtx)260 ucom_attach(struct ucom_super_softc *ssc, struct ucom_softc *sc,
261 int subunits, void *parent,
262 const struct ucom_callback *callback, struct mtx *mtx)
263 {
264 int subunit;
265 int error = 0;
266
267 if ((sc == NULL) ||
268 (subunits <= 0) ||
269 (callback == NULL) ||
270 (mtx == NULL)) {
271 return (EINVAL);
272 }
273
274 /* allocate a uniq unit number */
275 ssc->sc_unit = ucom_unit_alloc();
276 if (ssc->sc_unit == -1)
277 return (ENOMEM);
278
279 /* generate TTY name string */
280 snprintf(ssc->sc_ttyname, sizeof(ssc->sc_ttyname),
281 UCOM_TTY_PREFIX "%d", ssc->sc_unit);
282
283 /* create USB request handling process */
284 error = usb_proc_create(&ssc->sc_tq, mtx, "ucom", USB_PRI_MED);
285 if (error) {
286 ucom_unit_free(ssc->sc_unit);
287 return (error);
288 }
289 ssc->sc_subunits = subunits;
290 ssc->sc_flag = UCOM_FLAG_ATTACHED |
291 UCOM_FLAG_FREE_UNIT;
292
293 if (callback->ucom_free == NULL)
294 ssc->sc_flag |= UCOM_FLAG_WAIT_REFS;
295
296 /* increment reference count */
297 ucom_ref(ssc);
298
299 for (subunit = 0; subunit < ssc->sc_subunits; subunit++) {
300 sc[subunit].sc_subunit = subunit;
301 sc[subunit].sc_super = ssc;
302 sc[subunit].sc_mtx = mtx;
303 sc[subunit].sc_parent = parent;
304 sc[subunit].sc_callback = callback;
305
306 error = ucom_attach_tty(ssc, &sc[subunit]);
307 if (error) {
308 ucom_detach(ssc, &sc[0]);
309 return (error);
310 }
311 /* increment reference count */
312 ucom_ref(ssc);
313
314 /* set subunit attached */
315 sc[subunit].sc_flag |= UCOM_FLAG_ATTACHED;
316 }
317
318 DPRINTF("tp = %p, unit = %d, subunits = %d\n",
319 sc->sc_tty, ssc->sc_unit, ssc->sc_subunits);
320
321 return (0);
322 }
323
324 /*
325 * The following function will do nothing if the structure pointed to
326 * by "ssc" and "sc" is zero or has already been detached.
327 */
328 void
ucom_detach(struct ucom_super_softc * ssc,struct ucom_softc * sc)329 ucom_detach(struct ucom_super_softc *ssc, struct ucom_softc *sc)
330 {
331 int subunit;
332
333 if (!(ssc->sc_flag & UCOM_FLAG_ATTACHED))
334 return; /* not initialized */
335
336 if (ssc->sc_sysctl_ttyname != NULL) {
337 sysctl_remove_oid(ssc->sc_sysctl_ttyname, 1, 0);
338 ssc->sc_sysctl_ttyname = NULL;
339 }
340
341 if (ssc->sc_sysctl_ttyports != NULL) {
342 sysctl_remove_oid(ssc->sc_sysctl_ttyports, 1, 0);
343 ssc->sc_sysctl_ttyports = NULL;
344 }
345
346 usb_proc_drain(&ssc->sc_tq);
347
348 for (subunit = 0; subunit < ssc->sc_subunits; subunit++) {
349 if (sc[subunit].sc_flag & UCOM_FLAG_ATTACHED) {
350
351 ucom_detach_tty(ssc, &sc[subunit]);
352
353 /* avoid duplicate detach */
354 sc[subunit].sc_flag &= ~UCOM_FLAG_ATTACHED;
355 }
356 }
357 usb_proc_free(&ssc->sc_tq);
358
359 ucom_unref(ssc);
360
361 if (ssc->sc_flag & UCOM_FLAG_WAIT_REFS)
362 ucom_drain(ssc);
363
364 /* make sure we don't detach twice */
365 ssc->sc_flag &= ~UCOM_FLAG_ATTACHED;
366 }
367
368 void
ucom_drain(struct ucom_super_softc * ssc)369 ucom_drain(struct ucom_super_softc *ssc)
370 {
371 mtx_lock(&ucom_mtx);
372 while (ssc->sc_refs > 0) {
373 printf("ucom: Waiting for a TTY device to close.\n");
374 usb_pause_mtx(&ucom_mtx, hz);
375 }
376 mtx_unlock(&ucom_mtx);
377 }
378
379 void
ucom_drain_all(void * arg)380 ucom_drain_all(void *arg)
381 {
382 mtx_lock(&ucom_mtx);
383 while (ucom_close_refs > 0) {
384 printf("ucom: Waiting for all detached TTY "
385 "devices to have open fds closed.\n");
386 usb_pause_mtx(&ucom_mtx, hz);
387 }
388 mtx_unlock(&ucom_mtx);
389 }
390
391 static int
ucom_attach_tty(struct ucom_super_softc * ssc,struct ucom_softc * sc)392 ucom_attach_tty(struct ucom_super_softc *ssc, struct ucom_softc *sc)
393 {
394 struct tty *tp;
395 char buf[32]; /* temporary TTY device name buffer */
396
397 tp = tty_alloc_mutex(&ucom_class, sc, sc->sc_mtx);
398 if (tp == NULL)
399 return (ENOMEM);
400
401 /* Check if the client has a custom TTY name */
402 buf[0] = '\0';
403 if (sc->sc_callback->ucom_tty_name) {
404 sc->sc_callback->ucom_tty_name(sc, buf,
405 sizeof(buf), ssc->sc_unit, sc->sc_subunit);
406 }
407 if (buf[0] == 0) {
408 /* Use default TTY name */
409 if (ssc->sc_subunits > 1) {
410 /* multiple modems in one */
411 snprintf(buf, sizeof(buf), UCOM_TTY_PREFIX "%u.%u",
412 ssc->sc_unit, sc->sc_subunit);
413 } else {
414 /* single modem */
415 snprintf(buf, sizeof(buf), UCOM_TTY_PREFIX "%u",
416 ssc->sc_unit);
417 }
418 }
419 tty_makedev(tp, NULL, "%s", buf);
420
421 sc->sc_tty = tp;
422
423 sc->sc_pps.ppscap = PPS_CAPTUREBOTH;
424 sc->sc_pps.driver_abi = PPS_ABI_VERSION;
425 sc->sc_pps.driver_mtx = sc->sc_mtx;
426 pps_init_abi(&sc->sc_pps);
427
428 DPRINTF("ttycreate: %s\n", buf);
429
430 /* Check if this device should be a console */
431 if ((ucom_cons_softc == NULL) &&
432 (ssc->sc_unit == ucom_cons_unit) &&
433 (sc->sc_subunit == ucom_cons_subunit)) {
434
435 DPRINTF("unit %d subunit %d is console",
436 ssc->sc_unit, sc->sc_subunit);
437
438 ucom_cons_softc = sc;
439
440 tty_init_console(tp, ucom_cons_baud);
441
442 UCOM_MTX_LOCK(ucom_cons_softc);
443 ucom_cons_rx_low = 0;
444 ucom_cons_rx_high = 0;
445 ucom_cons_tx_low = 0;
446 ucom_cons_tx_high = 0;
447 sc->sc_flag |= UCOM_FLAG_CONSOLE;
448 ucom_open(ucom_cons_softc->sc_tty);
449 ucom_param(ucom_cons_softc->sc_tty, &tp->t_termios_init_in);
450 UCOM_MTX_UNLOCK(ucom_cons_softc);
451 }
452
453 return (0);
454 }
455
456 static void
ucom_detach_tty(struct ucom_super_softc * ssc,struct ucom_softc * sc)457 ucom_detach_tty(struct ucom_super_softc *ssc, struct ucom_softc *sc)
458 {
459 struct tty *tp = sc->sc_tty;
460
461 DPRINTF("sc = %p, tp = %p\n", sc, sc->sc_tty);
462
463 if (sc->sc_flag & UCOM_FLAG_CONSOLE) {
464 UCOM_MTX_LOCK(ucom_cons_softc);
465 ucom_close(ucom_cons_softc->sc_tty);
466 sc->sc_flag &= ~UCOM_FLAG_CONSOLE;
467 UCOM_MTX_UNLOCK(ucom_cons_softc);
468 ucom_cons_softc = NULL;
469 }
470
471 /* the config thread has been stopped when we get here */
472
473 UCOM_MTX_LOCK(sc);
474 sc->sc_flag |= UCOM_FLAG_GONE;
475 sc->sc_flag &= ~(UCOM_FLAG_HL_READY | UCOM_FLAG_LL_READY);
476 UCOM_MTX_UNLOCK(sc);
477
478 if (tp) {
479 mtx_lock(&ucom_mtx);
480 ucom_close_refs++;
481 mtx_unlock(&ucom_mtx);
482
483 tty_lock(tp);
484
485 ucom_close(tp); /* close, if any */
486
487 tty_rel_gone(tp);
488
489 UCOM_MTX_LOCK(sc);
490 /*
491 * make sure that read and write transfers are stopped
492 */
493 if (sc->sc_callback->ucom_stop_read)
494 (sc->sc_callback->ucom_stop_read) (sc);
495 if (sc->sc_callback->ucom_stop_write)
496 (sc->sc_callback->ucom_stop_write) (sc);
497 UCOM_MTX_UNLOCK(sc);
498 }
499 }
500
501 void
ucom_set_pnpinfo_usb(struct ucom_super_softc * ssc,device_t dev)502 ucom_set_pnpinfo_usb(struct ucom_super_softc *ssc, device_t dev)
503 {
504 char buf[64];
505 uint8_t iface_index;
506 struct usb_attach_arg *uaa;
507
508 snprintf(buf, sizeof(buf), "ttyname=" UCOM_TTY_PREFIX
509 "%d ttyports=%d", ssc->sc_unit, ssc->sc_subunits);
510
511 /* Store the PNP info in the first interface for the device */
512 uaa = device_get_ivars(dev);
513 iface_index = uaa->info.bIfaceIndex;
514
515 if (usbd_set_pnpinfo(uaa->device, iface_index, buf) != 0)
516 device_printf(dev, "Could not set PNP info\n");
517
518 /*
519 * The following information is also replicated in the PNP-info
520 * string which is registered above:
521 */
522 if (ssc->sc_sysctl_ttyname == NULL) {
523 ssc->sc_sysctl_ttyname = SYSCTL_ADD_STRING(NULL,
524 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
525 OID_AUTO, "ttyname", CTLFLAG_RD, ssc->sc_ttyname, 0,
526 "TTY device basename");
527 }
528 if (ssc->sc_sysctl_ttyports == NULL) {
529 ssc->sc_sysctl_ttyports = SYSCTL_ADD_INT(NULL,
530 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
531 OID_AUTO, "ttyports", CTLFLAG_RD,
532 NULL, ssc->sc_subunits, "Number of ports");
533 }
534 }
535
536 static void
ucom_queue_command(struct ucom_softc * sc,usb_proc_callback_t * fn,struct termios * pt,struct usb_proc_msg * t0,struct usb_proc_msg * t1)537 ucom_queue_command(struct ucom_softc *sc,
538 usb_proc_callback_t *fn, struct termios *pt,
539 struct usb_proc_msg *t0, struct usb_proc_msg *t1)
540 {
541 struct ucom_super_softc *ssc = sc->sc_super;
542 struct ucom_param_task *task;
543
544 UCOM_MTX_ASSERT(sc, MA_OWNED);
545
546 if (usb_proc_is_gone(&ssc->sc_tq)) {
547 DPRINTF("proc is gone\n");
548 return; /* nothing to do */
549 }
550 /*
551 * NOTE: The task cannot get executed before we drop the
552 * "sc_mtx" mutex. It is safe to update fields in the message
553 * structure after that the message got queued.
554 */
555 task = (struct ucom_param_task *)
556 usb_proc_msignal(&ssc->sc_tq, t0, t1);
557
558 /* Setup callback and softc pointers */
559 task->hdr.pm_callback = fn;
560 task->sc = sc;
561
562 /*
563 * Make a copy of the termios. This field is only present if
564 * the "pt" field is not NULL.
565 */
566 if (pt != NULL)
567 task->termios_copy = *pt;
568
569 /*
570 * Closing the device should be synchronous.
571 */
572 if (fn == ucom_cfg_close)
573 usb_proc_mwait(&ssc->sc_tq, t0, t1);
574
575 /*
576 * In case of multiple configure requests,
577 * keep track of the last one!
578 */
579 if (fn == ucom_cfg_start_transfers)
580 sc->sc_last_start_xfer = &task->hdr;
581 }
582
583 static void
ucom_shutdown(struct ucom_softc * sc)584 ucom_shutdown(struct ucom_softc *sc)
585 {
586 struct tty *tp = sc->sc_tty;
587
588 UCOM_MTX_ASSERT(sc, MA_OWNED);
589
590 DPRINTF("\n");
591
592 /*
593 * Hang up if necessary:
594 */
595 if (tp->t_termios.c_cflag & HUPCL) {
596 ucom_modem(tp, 0, SER_DTR);
597 }
598 }
599
600 /*
601 * Return values:
602 * 0: normal
603 * else: taskqueue is draining or gone
604 */
605 uint8_t
ucom_cfg_is_gone(struct ucom_softc * sc)606 ucom_cfg_is_gone(struct ucom_softc *sc)
607 {
608 struct ucom_super_softc *ssc = sc->sc_super;
609
610 return (usb_proc_is_gone(&ssc->sc_tq));
611 }
612
613 static void
ucom_cfg_start_transfers(struct usb_proc_msg * _task)614 ucom_cfg_start_transfers(struct usb_proc_msg *_task)
615 {
616 struct ucom_cfg_task *task =
617 (struct ucom_cfg_task *)_task;
618 struct ucom_softc *sc = task->sc;
619
620 if (!(sc->sc_flag & UCOM_FLAG_LL_READY)) {
621 return;
622 }
623 if (!(sc->sc_flag & UCOM_FLAG_HL_READY)) {
624 /* TTY device closed */
625 return;
626 }
627
628 if (_task == sc->sc_last_start_xfer)
629 sc->sc_flag |= UCOM_FLAG_GP_DATA;
630
631 if (sc->sc_callback->ucom_start_read) {
632 (sc->sc_callback->ucom_start_read) (sc);
633 }
634 if (sc->sc_callback->ucom_start_write) {
635 (sc->sc_callback->ucom_start_write) (sc);
636 }
637 }
638
639 static void
ucom_start_transfers(struct ucom_softc * sc)640 ucom_start_transfers(struct ucom_softc *sc)
641 {
642 if (!(sc->sc_flag & UCOM_FLAG_HL_READY)) {
643 return;
644 }
645 /*
646 * Make sure that data transfers are started in both
647 * directions:
648 */
649 if (sc->sc_callback->ucom_start_read) {
650 (sc->sc_callback->ucom_start_read) (sc);
651 }
652 if (sc->sc_callback->ucom_start_write) {
653 (sc->sc_callback->ucom_start_write) (sc);
654 }
655 }
656
657 static void
ucom_cfg_open(struct usb_proc_msg * _task)658 ucom_cfg_open(struct usb_proc_msg *_task)
659 {
660 struct ucom_cfg_task *task =
661 (struct ucom_cfg_task *)_task;
662 struct ucom_softc *sc = task->sc;
663
664 DPRINTF("\n");
665
666 if (sc->sc_flag & UCOM_FLAG_LL_READY) {
667
668 /* already opened */
669
670 } else {
671
672 sc->sc_flag |= UCOM_FLAG_LL_READY;
673
674 if (sc->sc_callback->ucom_cfg_open) {
675 (sc->sc_callback->ucom_cfg_open) (sc);
676
677 /* wait a little */
678 usb_pause_mtx(sc->sc_mtx, hz / 10);
679 }
680 }
681 }
682
683 static int
ucom_open(struct tty * tp)684 ucom_open(struct tty *tp)
685 {
686 struct ucom_softc *sc = tty_softc(tp);
687 int error;
688
689 UCOM_MTX_ASSERT(sc, MA_OWNED);
690
691 if (sc->sc_flag & UCOM_FLAG_GONE) {
692 return (ENXIO);
693 }
694 if (sc->sc_flag & UCOM_FLAG_HL_READY) {
695 /* already opened */
696 return (0);
697 }
698 DPRINTF("tp = %p\n", tp);
699
700 if (sc->sc_callback->ucom_pre_open) {
701 /*
702 * give the lower layer a chance to disallow TTY open, for
703 * example if the device is not present:
704 */
705 error = (sc->sc_callback->ucom_pre_open) (sc);
706 if (error) {
707 return (error);
708 }
709 }
710 sc->sc_flag |= UCOM_FLAG_HL_READY;
711
712 /* Disable transfers */
713 sc->sc_flag &= ~UCOM_FLAG_GP_DATA;
714
715 sc->sc_lsr = 0;
716 sc->sc_msr = 0;
717 sc->sc_mcr = 0;
718
719 /* reset programmed line state */
720 sc->sc_pls_curr = 0;
721 sc->sc_pls_set = 0;
722 sc->sc_pls_clr = 0;
723
724 /* reset jitter buffer */
725 sc->sc_jitterbuf_in = 0;
726 sc->sc_jitterbuf_out = 0;
727
728 ucom_queue_command(sc, ucom_cfg_open, NULL,
729 &sc->sc_open_task[0].hdr,
730 &sc->sc_open_task[1].hdr);
731
732 /* Queue transfer enable command last */
733 ucom_queue_command(sc, ucom_cfg_start_transfers, NULL,
734 &sc->sc_start_task[0].hdr,
735 &sc->sc_start_task[1].hdr);
736
737 ucom_modem(tp, SER_DTR | SER_RTS, 0);
738
739 ucom_ring(sc, 0);
740
741 ucom_break(sc, 0);
742
743 ucom_status_change(sc);
744
745 return (0);
746 }
747
748 static void
ucom_cfg_close(struct usb_proc_msg * _task)749 ucom_cfg_close(struct usb_proc_msg *_task)
750 {
751 struct ucom_cfg_task *task =
752 (struct ucom_cfg_task *)_task;
753 struct ucom_softc *sc = task->sc;
754
755 DPRINTF("\n");
756
757 if (sc->sc_flag & UCOM_FLAG_LL_READY) {
758 sc->sc_flag &= ~UCOM_FLAG_LL_READY;
759 if (sc->sc_callback->ucom_cfg_close)
760 (sc->sc_callback->ucom_cfg_close) (sc);
761 } else {
762 /* already closed */
763 }
764 }
765
766 static void
ucom_close(struct tty * tp)767 ucom_close(struct tty *tp)
768 {
769 struct ucom_softc *sc = tty_softc(tp);
770
771 UCOM_MTX_ASSERT(sc, MA_OWNED);
772
773 DPRINTF("tp=%p\n", tp);
774
775 if (!(sc->sc_flag & UCOM_FLAG_HL_READY)) {
776 DPRINTF("tp=%p already closed\n", tp);
777 return;
778 }
779 ucom_shutdown(sc);
780
781 ucom_queue_command(sc, ucom_cfg_close, NULL,
782 &sc->sc_close_task[0].hdr,
783 &sc->sc_close_task[1].hdr);
784
785 sc->sc_flag &= ~(UCOM_FLAG_HL_READY | UCOM_FLAG_RTS_IFLOW);
786
787 if (sc->sc_callback->ucom_stop_read) {
788 (sc->sc_callback->ucom_stop_read) (sc);
789 }
790 }
791
792 static void
ucom_inwakeup(struct tty * tp)793 ucom_inwakeup(struct tty *tp)
794 {
795 struct ucom_softc *sc = tty_softc(tp);
796 uint16_t pos;
797
798 if (sc == NULL)
799 return;
800
801 UCOM_MTX_ASSERT(sc, MA_OWNED);
802
803 DPRINTF("tp=%p\n", tp);
804
805 if (ttydisc_can_bypass(tp) != 0 ||
806 (sc->sc_flag & UCOM_FLAG_HL_READY) == 0 ||
807 (sc->sc_flag & UCOM_FLAG_INWAKEUP) != 0) {
808 return;
809 }
810
811 /* prevent recursion */
812 sc->sc_flag |= UCOM_FLAG_INWAKEUP;
813
814 pos = sc->sc_jitterbuf_out;
815
816 while (sc->sc_jitterbuf_in != pos) {
817 int c;
818
819 c = (char)sc->sc_jitterbuf[pos];
820
821 if (ttydisc_rint(tp, c, 0) == -1)
822 break;
823 pos++;
824 if (pos >= UCOM_JITTERBUF_SIZE)
825 pos -= UCOM_JITTERBUF_SIZE;
826 }
827
828 sc->sc_jitterbuf_out = pos;
829
830 /* clear RTS in async fashion */
831 if ((sc->sc_jitterbuf_in == pos) &&
832 (sc->sc_flag & UCOM_FLAG_RTS_IFLOW))
833 ucom_rts(sc, 0);
834
835 sc->sc_flag &= ~UCOM_FLAG_INWAKEUP;
836 }
837
838 static int
ucom_ioctl(struct tty * tp,u_long cmd,caddr_t data,struct thread * td)839 ucom_ioctl(struct tty *tp, u_long cmd, caddr_t data, struct thread *td)
840 {
841 struct ucom_softc *sc = tty_softc(tp);
842 int error;
843
844 UCOM_MTX_ASSERT(sc, MA_OWNED);
845
846 if (!(sc->sc_flag & UCOM_FLAG_HL_READY)) {
847 return (EIO);
848 }
849 DPRINTF("cmd = 0x%08lx\n", cmd);
850
851 switch (cmd) {
852 #if 0
853 case TIOCSRING:
854 ucom_ring(sc, 1);
855 error = 0;
856 break;
857 case TIOCCRING:
858 ucom_ring(sc, 0);
859 error = 0;
860 break;
861 #endif
862 case TIOCSBRK:
863 ucom_break(sc, 1);
864 error = 0;
865 break;
866 case TIOCCBRK:
867 ucom_break(sc, 0);
868 error = 0;
869 break;
870 default:
871 if (sc->sc_callback->ucom_ioctl) {
872 error = (sc->sc_callback->ucom_ioctl)
873 (sc, cmd, data, 0, td);
874 } else {
875 error = ENOIOCTL;
876 }
877 if (error == ENOIOCTL)
878 error = pps_ioctl(cmd, data, &sc->sc_pps);
879 break;
880 }
881 return (error);
882 }
883
884 static int
ucom_modem(struct tty * tp,int sigon,int sigoff)885 ucom_modem(struct tty *tp, int sigon, int sigoff)
886 {
887 struct ucom_softc *sc = tty_softc(tp);
888 uint8_t onoff;
889
890 UCOM_MTX_ASSERT(sc, MA_OWNED);
891
892 if (!(sc->sc_flag & UCOM_FLAG_HL_READY)) {
893 return (0);
894 }
895 if ((sigon == 0) && (sigoff == 0)) {
896
897 if (sc->sc_mcr & SER_DTR) {
898 sigon |= SER_DTR;
899 }
900 if (sc->sc_mcr & SER_RTS) {
901 sigon |= SER_RTS;
902 }
903 if (sc->sc_msr & SER_CTS) {
904 sigon |= SER_CTS;
905 }
906 if (sc->sc_msr & SER_DCD) {
907 sigon |= SER_DCD;
908 }
909 if (sc->sc_msr & SER_DSR) {
910 sigon |= SER_DSR;
911 }
912 if (sc->sc_msr & SER_RI) {
913 sigon |= SER_RI;
914 }
915 return (sigon);
916 }
917 if (sigon & SER_DTR) {
918 sc->sc_mcr |= SER_DTR;
919 }
920 if (sigoff & SER_DTR) {
921 sc->sc_mcr &= ~SER_DTR;
922 }
923 if (sigon & SER_RTS) {
924 sc->sc_mcr |= SER_RTS;
925 }
926 if (sigoff & SER_RTS) {
927 sc->sc_mcr &= ~SER_RTS;
928 }
929 onoff = (sc->sc_mcr & SER_DTR) ? 1 : 0;
930 ucom_dtr(sc, onoff);
931
932 onoff = (sc->sc_mcr & SER_RTS) ? 1 : 0;
933 ucom_rts(sc, onoff);
934
935 return (0);
936 }
937
938 static void
ucom_cfg_line_state(struct usb_proc_msg * _task)939 ucom_cfg_line_state(struct usb_proc_msg *_task)
940 {
941 struct ucom_cfg_task *task =
942 (struct ucom_cfg_task *)_task;
943 struct ucom_softc *sc = task->sc;
944 uint8_t notch_bits;
945 uint8_t any_bits;
946 uint8_t prev_value;
947 uint8_t last_value;
948 uint8_t mask;
949
950 if (!(sc->sc_flag & UCOM_FLAG_LL_READY)) {
951 return;
952 }
953
954 mask = 0;
955 /* compute callback mask */
956 if (sc->sc_callback->ucom_cfg_set_dtr)
957 mask |= UCOM_LS_DTR;
958 if (sc->sc_callback->ucom_cfg_set_rts)
959 mask |= UCOM_LS_RTS;
960 if (sc->sc_callback->ucom_cfg_set_break)
961 mask |= UCOM_LS_BREAK;
962 if (sc->sc_callback->ucom_cfg_set_ring)
963 mask |= UCOM_LS_RING;
964
965 /* compute the bits we are to program */
966 notch_bits = (sc->sc_pls_set & sc->sc_pls_clr) & mask;
967 any_bits = (sc->sc_pls_set | sc->sc_pls_clr) & mask;
968 prev_value = sc->sc_pls_curr ^ notch_bits;
969 last_value = sc->sc_pls_curr;
970
971 /* reset programmed line state */
972 sc->sc_pls_curr = 0;
973 sc->sc_pls_set = 0;
974 sc->sc_pls_clr = 0;
975
976 /* ensure that we don't lose any levels */
977 if (notch_bits & UCOM_LS_DTR)
978 sc->sc_callback->ucom_cfg_set_dtr(sc,
979 (prev_value & UCOM_LS_DTR) ? 1 : 0);
980 if (notch_bits & UCOM_LS_RTS)
981 sc->sc_callback->ucom_cfg_set_rts(sc,
982 (prev_value & UCOM_LS_RTS) ? 1 : 0);
983 if (notch_bits & UCOM_LS_BREAK)
984 sc->sc_callback->ucom_cfg_set_break(sc,
985 (prev_value & UCOM_LS_BREAK) ? 1 : 0);
986 if (notch_bits & UCOM_LS_RING)
987 sc->sc_callback->ucom_cfg_set_ring(sc,
988 (prev_value & UCOM_LS_RING) ? 1 : 0);
989
990 /* set last value */
991 if (any_bits & UCOM_LS_DTR)
992 sc->sc_callback->ucom_cfg_set_dtr(sc,
993 (last_value & UCOM_LS_DTR) ? 1 : 0);
994 if (any_bits & UCOM_LS_RTS)
995 sc->sc_callback->ucom_cfg_set_rts(sc,
996 (last_value & UCOM_LS_RTS) ? 1 : 0);
997 if (any_bits & UCOM_LS_BREAK)
998 sc->sc_callback->ucom_cfg_set_break(sc,
999 (last_value & UCOM_LS_BREAK) ? 1 : 0);
1000 if (any_bits & UCOM_LS_RING)
1001 sc->sc_callback->ucom_cfg_set_ring(sc,
1002 (last_value & UCOM_LS_RING) ? 1 : 0);
1003 }
1004
1005 static void
ucom_line_state(struct ucom_softc * sc,uint8_t set_bits,uint8_t clear_bits)1006 ucom_line_state(struct ucom_softc *sc,
1007 uint8_t set_bits, uint8_t clear_bits)
1008 {
1009 UCOM_MTX_ASSERT(sc, MA_OWNED);
1010
1011 if (!(sc->sc_flag & UCOM_FLAG_HL_READY)) {
1012 return;
1013 }
1014
1015 DPRINTF("on=0x%02x, off=0x%02x\n", set_bits, clear_bits);
1016
1017 /* update current programmed line state */
1018 sc->sc_pls_curr |= set_bits;
1019 sc->sc_pls_curr &= ~clear_bits;
1020 sc->sc_pls_set |= set_bits;
1021 sc->sc_pls_clr |= clear_bits;
1022
1023 /* defer driver programming */
1024 ucom_queue_command(sc, ucom_cfg_line_state, NULL,
1025 &sc->sc_line_state_task[0].hdr,
1026 &sc->sc_line_state_task[1].hdr);
1027 }
1028
1029 static void
ucom_ring(struct ucom_softc * sc,uint8_t onoff)1030 ucom_ring(struct ucom_softc *sc, uint8_t onoff)
1031 {
1032 DPRINTF("onoff = %d\n", onoff);
1033
1034 if (onoff)
1035 ucom_line_state(sc, UCOM_LS_RING, 0);
1036 else
1037 ucom_line_state(sc, 0, UCOM_LS_RING);
1038 }
1039
1040 static void
ucom_break(struct ucom_softc * sc,uint8_t onoff)1041 ucom_break(struct ucom_softc *sc, uint8_t onoff)
1042 {
1043 DPRINTF("onoff = %d\n", onoff);
1044
1045 if (onoff)
1046 ucom_line_state(sc, UCOM_LS_BREAK, 0);
1047 else
1048 ucom_line_state(sc, 0, UCOM_LS_BREAK);
1049 }
1050
1051 static void
ucom_dtr(struct ucom_softc * sc,uint8_t onoff)1052 ucom_dtr(struct ucom_softc *sc, uint8_t onoff)
1053 {
1054 DPRINTF("onoff = %d\n", onoff);
1055
1056 if (onoff)
1057 ucom_line_state(sc, UCOM_LS_DTR, 0);
1058 else
1059 ucom_line_state(sc, 0, UCOM_LS_DTR);
1060 }
1061
1062 static void
ucom_rts(struct ucom_softc * sc,uint8_t onoff)1063 ucom_rts(struct ucom_softc *sc, uint8_t onoff)
1064 {
1065 DPRINTF("onoff = %d\n", onoff);
1066
1067 if (onoff)
1068 ucom_line_state(sc, UCOM_LS_RTS, 0);
1069 else
1070 ucom_line_state(sc, 0, UCOM_LS_RTS);
1071 }
1072
1073 static void
ucom_cfg_status_change(struct usb_proc_msg * _task)1074 ucom_cfg_status_change(struct usb_proc_msg *_task)
1075 {
1076 struct ucom_cfg_task *task =
1077 (struct ucom_cfg_task *)_task;
1078 struct ucom_softc *sc = task->sc;
1079 struct tty *tp;
1080 int onoff;
1081 uint8_t new_msr;
1082 uint8_t new_lsr;
1083 uint8_t msr_delta;
1084 uint8_t lsr_delta;
1085 uint8_t pps_signal;
1086
1087 tp = sc->sc_tty;
1088
1089 UCOM_MTX_ASSERT(sc, MA_OWNED);
1090
1091 if (!(sc->sc_flag & UCOM_FLAG_LL_READY)) {
1092 return;
1093 }
1094 if (sc->sc_callback->ucom_cfg_get_status == NULL) {
1095 return;
1096 }
1097 /* get status */
1098
1099 new_msr = 0;
1100 new_lsr = 0;
1101
1102 (sc->sc_callback->ucom_cfg_get_status) (sc, &new_lsr, &new_msr);
1103
1104 if (!(sc->sc_flag & UCOM_FLAG_HL_READY)) {
1105 /* TTY device closed */
1106 return;
1107 }
1108 msr_delta = (sc->sc_msr ^ new_msr);
1109 lsr_delta = (sc->sc_lsr ^ new_lsr);
1110
1111 sc->sc_msr = new_msr;
1112 sc->sc_lsr = new_lsr;
1113
1114 /*
1115 * Time pulse counting support.
1116 */
1117 switch(ucom_pps_mode & UART_PPS_SIGNAL_MASK) {
1118 case UART_PPS_CTS:
1119 pps_signal = SER_CTS;
1120 break;
1121 case UART_PPS_DCD:
1122 pps_signal = SER_DCD;
1123 break;
1124 default:
1125 pps_signal = 0;
1126 break;
1127 }
1128
1129 if ((sc->sc_pps.ppsparam.mode & PPS_CAPTUREBOTH) &&
1130 (msr_delta & pps_signal)) {
1131 pps_capture(&sc->sc_pps);
1132 onoff = (sc->sc_msr & pps_signal) ? 1 : 0;
1133 if (ucom_pps_mode & UART_PPS_INVERT_PULSE)
1134 onoff = !onoff;
1135 pps_event(&sc->sc_pps, onoff ? PPS_CAPTUREASSERT :
1136 PPS_CAPTURECLEAR);
1137 }
1138
1139 if (msr_delta & SER_DCD) {
1140
1141 onoff = (sc->sc_msr & SER_DCD) ? 1 : 0;
1142
1143 DPRINTF("DCD changed to %d\n", onoff);
1144
1145 ttydisc_modem(tp, onoff);
1146 }
1147
1148 if ((lsr_delta & ULSR_BI) && (sc->sc_lsr & ULSR_BI)) {
1149
1150 DPRINTF("BREAK detected\n");
1151
1152 ttydisc_rint(tp, 0, TRE_BREAK);
1153 ttydisc_rint_done(tp);
1154 }
1155
1156 if ((lsr_delta & ULSR_FE) && (sc->sc_lsr & ULSR_FE)) {
1157
1158 DPRINTF("Frame error detected\n");
1159
1160 ttydisc_rint(tp, 0, TRE_FRAMING);
1161 ttydisc_rint_done(tp);
1162 }
1163
1164 if ((lsr_delta & ULSR_PE) && (sc->sc_lsr & ULSR_PE)) {
1165
1166 DPRINTF("Parity error detected\n");
1167
1168 ttydisc_rint(tp, 0, TRE_PARITY);
1169 ttydisc_rint_done(tp);
1170 }
1171 }
1172
1173 void
ucom_status_change(struct ucom_softc * sc)1174 ucom_status_change(struct ucom_softc *sc)
1175 {
1176 UCOM_MTX_ASSERT(sc, MA_OWNED);
1177
1178 if (sc->sc_flag & UCOM_FLAG_CONSOLE)
1179 return; /* not supported */
1180
1181 if (!(sc->sc_flag & UCOM_FLAG_HL_READY)) {
1182 return;
1183 }
1184 DPRINTF("\n");
1185
1186 ucom_queue_command(sc, ucom_cfg_status_change, NULL,
1187 &sc->sc_status_task[0].hdr,
1188 &sc->sc_status_task[1].hdr);
1189 }
1190
1191 static void
ucom_cfg_param(struct usb_proc_msg * _task)1192 ucom_cfg_param(struct usb_proc_msg *_task)
1193 {
1194 struct ucom_param_task *task =
1195 (struct ucom_param_task *)_task;
1196 struct ucom_softc *sc = task->sc;
1197
1198 if (!(sc->sc_flag & UCOM_FLAG_LL_READY)) {
1199 return;
1200 }
1201 if (sc->sc_callback->ucom_cfg_param == NULL) {
1202 return;
1203 }
1204
1205 (sc->sc_callback->ucom_cfg_param) (sc, &task->termios_copy);
1206
1207 /* wait a little */
1208 usb_pause_mtx(sc->sc_mtx, hz / 10);
1209 }
1210
1211 static int
ucom_param(struct tty * tp,struct termios * t)1212 ucom_param(struct tty *tp, struct termios *t)
1213 {
1214 struct ucom_softc *sc = tty_softc(tp);
1215 uint8_t opened;
1216 int error;
1217
1218 UCOM_MTX_ASSERT(sc, MA_OWNED);
1219
1220 opened = 0;
1221 error = 0;
1222
1223 if (!(sc->sc_flag & UCOM_FLAG_HL_READY)) {
1224
1225 /* XXX the TTY layer should call "open()" first! */
1226 /*
1227 * Not quite: Its ordering is partly backwards, but
1228 * some parameters must be set early in ttydev_open(),
1229 * possibly before calling ttydevsw_open().
1230 */
1231 error = ucom_open(tp);
1232 if (error)
1233 goto done;
1234
1235 opened = 1;
1236 }
1237 DPRINTF("sc = %p\n", sc);
1238
1239 /* Check requested parameters. */
1240 if (t->c_ispeed && (t->c_ispeed != t->c_ospeed)) {
1241 /* XXX c_ospeed == 0 is perfectly valid. */
1242 DPRINTF("mismatch ispeed and ospeed\n");
1243 error = EINVAL;
1244 goto done;
1245 }
1246 t->c_ispeed = t->c_ospeed;
1247
1248 if (sc->sc_callback->ucom_pre_param) {
1249 /* Let the lower layer verify the parameters */
1250 error = (sc->sc_callback->ucom_pre_param) (sc, t);
1251 if (error) {
1252 DPRINTF("callback error = %d\n", error);
1253 goto done;
1254 }
1255 }
1256
1257 /* Disable transfers */
1258 sc->sc_flag &= ~UCOM_FLAG_GP_DATA;
1259
1260 /* Queue baud rate programming command first */
1261 ucom_queue_command(sc, ucom_cfg_param, t,
1262 &sc->sc_param_task[0].hdr,
1263 &sc->sc_param_task[1].hdr);
1264
1265 /* Queue transfer enable command last */
1266 ucom_queue_command(sc, ucom_cfg_start_transfers, NULL,
1267 &sc->sc_start_task[0].hdr,
1268 &sc->sc_start_task[1].hdr);
1269
1270 if (t->c_cflag & CRTS_IFLOW) {
1271 sc->sc_flag |= UCOM_FLAG_RTS_IFLOW;
1272 } else if (sc->sc_flag & UCOM_FLAG_RTS_IFLOW) {
1273 sc->sc_flag &= ~UCOM_FLAG_RTS_IFLOW;
1274 ucom_modem(tp, SER_RTS, 0);
1275 }
1276 done:
1277 if (error) {
1278 if (opened) {
1279 ucom_close(tp);
1280 }
1281 }
1282 return (error);
1283 }
1284
1285 static void
ucom_outwakeup(struct tty * tp)1286 ucom_outwakeup(struct tty *tp)
1287 {
1288 struct ucom_softc *sc = tty_softc(tp);
1289
1290 UCOM_MTX_ASSERT(sc, MA_OWNED);
1291
1292 DPRINTF("sc = %p\n", sc);
1293
1294 if (!(sc->sc_flag & UCOM_FLAG_HL_READY)) {
1295 /* The higher layer is not ready */
1296 return;
1297 }
1298 ucom_start_transfers(sc);
1299 }
1300
1301 /*------------------------------------------------------------------------*
1302 * ucom_get_data
1303 *
1304 * Return values:
1305 * 0: No data is available.
1306 * Else: Data is available.
1307 *------------------------------------------------------------------------*/
1308 uint8_t
ucom_get_data(struct ucom_softc * sc,struct usb_page_cache * pc,uint32_t offset,uint32_t len,uint32_t * actlen)1309 ucom_get_data(struct ucom_softc *sc, struct usb_page_cache *pc,
1310 uint32_t offset, uint32_t len, uint32_t *actlen)
1311 {
1312 struct usb_page_search res;
1313 struct tty *tp = sc->sc_tty;
1314 uint32_t cnt;
1315 uint32_t offset_orig;
1316
1317 UCOM_MTX_ASSERT(sc, MA_OWNED);
1318
1319 if (sc->sc_flag & UCOM_FLAG_CONSOLE) {
1320 unsigned int temp;
1321
1322 /* get total TX length */
1323
1324 temp = ucom_cons_tx_high - ucom_cons_tx_low;
1325 temp %= UCOM_CONS_BUFSIZE;
1326
1327 /* limit TX length */
1328
1329 if (temp > (UCOM_CONS_BUFSIZE - ucom_cons_tx_low))
1330 temp = (UCOM_CONS_BUFSIZE - ucom_cons_tx_low);
1331
1332 if (temp > len)
1333 temp = len;
1334
1335 /* copy in data */
1336
1337 usbd_copy_in(pc, offset, ucom_cons_tx_buf + ucom_cons_tx_low, temp);
1338
1339 /* update counters */
1340
1341 ucom_cons_tx_low += temp;
1342 ucom_cons_tx_low %= UCOM_CONS_BUFSIZE;
1343
1344 /* store actual length */
1345
1346 *actlen = temp;
1347
1348 return (temp ? 1 : 0);
1349 }
1350
1351 if (tty_gone(tp) ||
1352 !(sc->sc_flag & UCOM_FLAG_GP_DATA)) {
1353 actlen[0] = 0;
1354 return (0); /* multiport device polling */
1355 }
1356 offset_orig = offset;
1357
1358 while (len != 0) {
1359
1360 usbd_get_page(pc, offset, &res);
1361
1362 if (res.length > len) {
1363 res.length = len;
1364 }
1365 /* copy data directly into USB buffer */
1366 cnt = ttydisc_getc(tp, res.buffer, res.length);
1367
1368 offset += cnt;
1369 len -= cnt;
1370
1371 if (cnt < res.length) {
1372 /* end of buffer */
1373 break;
1374 }
1375 }
1376
1377 actlen[0] = offset - offset_orig;
1378
1379 DPRINTF("cnt=%d\n", actlen[0]);
1380
1381 if (actlen[0] == 0) {
1382 return (0);
1383 }
1384 return (1);
1385 }
1386
1387 void
ucom_put_data(struct ucom_softc * sc,struct usb_page_cache * pc,uint32_t offset,uint32_t len)1388 ucom_put_data(struct ucom_softc *sc, struct usb_page_cache *pc,
1389 uint32_t offset, uint32_t len)
1390 {
1391 struct usb_page_search res;
1392 struct tty *tp = sc->sc_tty;
1393 char *buf;
1394 uint32_t cnt;
1395
1396 UCOM_MTX_ASSERT(sc, MA_OWNED);
1397
1398 if (sc->sc_flag & UCOM_FLAG_CONSOLE) {
1399 unsigned int temp;
1400
1401 /* get maximum RX length */
1402
1403 temp = (UCOM_CONS_BUFSIZE - 1) - ucom_cons_rx_high + ucom_cons_rx_low;
1404 temp %= UCOM_CONS_BUFSIZE;
1405
1406 /* limit RX length */
1407
1408 if (temp > (UCOM_CONS_BUFSIZE - ucom_cons_rx_high))
1409 temp = (UCOM_CONS_BUFSIZE - ucom_cons_rx_high);
1410
1411 if (temp > len)
1412 temp = len;
1413
1414 /* copy out data */
1415
1416 usbd_copy_out(pc, offset, ucom_cons_rx_buf + ucom_cons_rx_high, temp);
1417
1418 /* update counters */
1419
1420 ucom_cons_rx_high += temp;
1421 ucom_cons_rx_high %= UCOM_CONS_BUFSIZE;
1422
1423 return;
1424 }
1425
1426 if (tty_gone(tp))
1427 return; /* multiport device polling */
1428
1429 if (len == 0)
1430 return; /* no data */
1431
1432 /* set a flag to prevent recursation ? */
1433
1434 while (len > 0) {
1435
1436 usbd_get_page(pc, offset, &res);
1437
1438 if (res.length > len) {
1439 res.length = len;
1440 }
1441 len -= res.length;
1442 offset += res.length;
1443
1444 /* pass characters to tty layer */
1445
1446 buf = res.buffer;
1447 cnt = res.length;
1448
1449 /* first check if we can pass the buffer directly */
1450
1451 if (ttydisc_can_bypass(tp)) {
1452
1453 /* clear any jitter buffer */
1454 sc->sc_jitterbuf_in = 0;
1455 sc->sc_jitterbuf_out = 0;
1456
1457 if (ttydisc_rint_bypass(tp, buf, cnt) != cnt) {
1458 DPRINTF("tp=%p, data lost\n", tp);
1459 }
1460 continue;
1461 }
1462 /* need to loop */
1463
1464 for (cnt = 0; cnt != res.length; cnt++) {
1465 if (sc->sc_jitterbuf_in != sc->sc_jitterbuf_out ||
1466 ttydisc_rint(tp, buf[cnt], 0) == -1) {
1467 uint16_t end;
1468 uint16_t pos;
1469
1470 pos = sc->sc_jitterbuf_in;
1471 end = sc->sc_jitterbuf_out +
1472 UCOM_JITTERBUF_SIZE - 1;
1473 if (end >= UCOM_JITTERBUF_SIZE)
1474 end -= UCOM_JITTERBUF_SIZE;
1475
1476 for (; cnt != res.length; cnt++) {
1477 if (pos == end)
1478 break;
1479 sc->sc_jitterbuf[pos] = buf[cnt];
1480 pos++;
1481 if (pos >= UCOM_JITTERBUF_SIZE)
1482 pos -= UCOM_JITTERBUF_SIZE;
1483 }
1484
1485 sc->sc_jitterbuf_in = pos;
1486
1487 /* set RTS in async fashion */
1488 if (sc->sc_flag & UCOM_FLAG_RTS_IFLOW)
1489 ucom_rts(sc, 1);
1490
1491 DPRINTF("tp=%p, lost %d "
1492 "chars\n", tp, res.length - cnt);
1493 break;
1494 }
1495 }
1496 }
1497 ttydisc_rint_done(tp);
1498 }
1499
1500 static void
ucom_free(void * xsc)1501 ucom_free(void *xsc)
1502 {
1503 struct ucom_softc *sc = xsc;
1504
1505 if (sc->sc_callback->ucom_free != NULL)
1506 sc->sc_callback->ucom_free(sc);
1507 else
1508 ucom_unref(sc->sc_super);
1509
1510 mtx_lock(&ucom_mtx);
1511 ucom_close_refs--;
1512 mtx_unlock(&ucom_mtx);
1513 }
1514
1515 static cn_probe_t ucom_cnprobe;
1516 static cn_init_t ucom_cninit;
1517 static cn_term_t ucom_cnterm;
1518 static cn_getc_t ucom_cngetc;
1519 static cn_putc_t ucom_cnputc;
1520 static cn_grab_t ucom_cngrab;
1521 static cn_ungrab_t ucom_cnungrab;
1522
1523 CONSOLE_DRIVER(ucom);
1524
1525 static void
ucom_cnprobe(struct consdev * cp)1526 ucom_cnprobe(struct consdev *cp)
1527 {
1528 if (ucom_cons_unit != -1)
1529 cp->cn_pri = CN_NORMAL;
1530 else
1531 cp->cn_pri = CN_DEAD;
1532
1533 strlcpy(cp->cn_name, "ucom", sizeof(cp->cn_name));
1534 }
1535
1536 static void
ucom_cninit(struct consdev * cp)1537 ucom_cninit(struct consdev *cp)
1538 {
1539 }
1540
1541 static void
ucom_cnterm(struct consdev * cp)1542 ucom_cnterm(struct consdev *cp)
1543 {
1544 }
1545
1546 static void
ucom_cngrab(struct consdev * cp)1547 ucom_cngrab(struct consdev *cp)
1548 {
1549 }
1550
1551 static void
ucom_cnungrab(struct consdev * cp)1552 ucom_cnungrab(struct consdev *cp)
1553 {
1554 }
1555
1556 static int
ucom_cngetc(struct consdev * cd)1557 ucom_cngetc(struct consdev *cd)
1558 {
1559 struct ucom_softc *sc = ucom_cons_softc;
1560 int c;
1561
1562 if (sc == NULL)
1563 return (-1);
1564
1565 UCOM_MTX_LOCK(sc);
1566
1567 if (ucom_cons_rx_low != ucom_cons_rx_high) {
1568 c = ucom_cons_rx_buf[ucom_cons_rx_low];
1569 ucom_cons_rx_low ++;
1570 ucom_cons_rx_low %= UCOM_CONS_BUFSIZE;
1571 } else {
1572 c = -1;
1573 }
1574
1575 /* start USB transfers */
1576 ucom_outwakeup(sc->sc_tty);
1577
1578 UCOM_MTX_UNLOCK(sc);
1579
1580 /* poll if necessary */
1581 if (kdb_active && sc->sc_callback->ucom_poll)
1582 (sc->sc_callback->ucom_poll) (sc);
1583
1584 return (c);
1585 }
1586
1587 static void
ucom_cnputc(struct consdev * cd,int c)1588 ucom_cnputc(struct consdev *cd, int c)
1589 {
1590 struct ucom_softc *sc = ucom_cons_softc;
1591 unsigned int temp;
1592
1593 if (sc == NULL)
1594 return;
1595
1596 repeat:
1597
1598 UCOM_MTX_LOCK(sc);
1599
1600 /* compute maximum TX length */
1601
1602 temp = (UCOM_CONS_BUFSIZE - 1) - ucom_cons_tx_high + ucom_cons_tx_low;
1603 temp %= UCOM_CONS_BUFSIZE;
1604
1605 if (temp) {
1606 ucom_cons_tx_buf[ucom_cons_tx_high] = c;
1607 ucom_cons_tx_high ++;
1608 ucom_cons_tx_high %= UCOM_CONS_BUFSIZE;
1609 }
1610
1611 /* start USB transfers */
1612 ucom_outwakeup(sc->sc_tty);
1613
1614 UCOM_MTX_UNLOCK(sc);
1615
1616 /* poll if necessary */
1617 if (kdb_active && sc->sc_callback->ucom_poll) {
1618 (sc->sc_callback->ucom_poll) (sc);
1619 /* simple flow control */
1620 if (temp == 0)
1621 goto repeat;
1622 }
1623 }
1624
1625 /*------------------------------------------------------------------------*
1626 * ucom_ref
1627 *
1628 * This function will increment the super UCOM reference count.
1629 *------------------------------------------------------------------------*/
1630 void
ucom_ref(struct ucom_super_softc * ssc)1631 ucom_ref(struct ucom_super_softc *ssc)
1632 {
1633 mtx_lock(&ucom_mtx);
1634 ssc->sc_refs++;
1635 mtx_unlock(&ucom_mtx);
1636 }
1637
1638 /*------------------------------------------------------------------------*
1639 * ucom_free_unit
1640 *
1641 * This function will free the super UCOM's allocated unit
1642 * number. This function can be called on a zero-initialized
1643 * structure. This function can be called multiple times.
1644 *------------------------------------------------------------------------*/
1645 static void
ucom_free_unit(struct ucom_super_softc * ssc)1646 ucom_free_unit(struct ucom_super_softc *ssc)
1647 {
1648 if (!(ssc->sc_flag & UCOM_FLAG_FREE_UNIT))
1649 return;
1650
1651 ucom_unit_free(ssc->sc_unit);
1652
1653 ssc->sc_flag &= ~UCOM_FLAG_FREE_UNIT;
1654 }
1655
1656 /*------------------------------------------------------------------------*
1657 * ucom_unref
1658 *
1659 * This function will decrement the super UCOM reference count.
1660 *
1661 * Return values:
1662 * 0: UCOM structures are still referenced.
1663 * Else: UCOM structures are no longer referenced.
1664 *------------------------------------------------------------------------*/
1665 int
ucom_unref(struct ucom_super_softc * ssc)1666 ucom_unref(struct ucom_super_softc *ssc)
1667 {
1668 int retval;
1669
1670 mtx_lock(&ucom_mtx);
1671 retval = (ssc->sc_refs < 2);
1672 ssc->sc_refs--;
1673 mtx_unlock(&ucom_mtx);
1674
1675 if (retval)
1676 ucom_free_unit(ssc);
1677
1678 return (retval);
1679 }
1680
1681 #if defined(GDB)
1682
1683 #include <gdb/gdb.h>
1684
1685 static gdb_probe_f ucom_gdbprobe;
1686 static gdb_init_f ucom_gdbinit;
1687 static gdb_term_f ucom_gdbterm;
1688 static gdb_getc_f ucom_gdbgetc;
1689 static gdb_putc_f ucom_gdbputc;
1690
1691 GDB_DBGPORT(sio, ucom_gdbprobe, ucom_gdbinit, ucom_gdbterm, ucom_gdbgetc, ucom_gdbputc);
1692
1693 static int
ucom_gdbprobe(void)1694 ucom_gdbprobe(void)
1695 {
1696 return ((ucom_cons_softc != NULL) ? 0 : -1);
1697 }
1698
1699 static void
ucom_gdbinit(void)1700 ucom_gdbinit(void)
1701 {
1702 }
1703
1704 static void
ucom_gdbterm(void)1705 ucom_gdbterm(void)
1706 {
1707 }
1708
1709 static void
ucom_gdbputc(int c)1710 ucom_gdbputc(int c)
1711 {
1712 ucom_cnputc(NULL, c);
1713 }
1714
1715 static int
ucom_gdbgetc(void)1716 ucom_gdbgetc(void)
1717 {
1718 return (ucom_cngetc(NULL));
1719 }
1720
1721 #endif
1722