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