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