Nuke SIMPLEQ_* and logprintf.
[dragonfly/vkernel-mp.git] / sys / dev / usbmisc / ubsa / ubsa.c
blob5add93a17cb1eeb45566e1bd90e5dc3fee99c36f
1 /*-
2 * Copyright (c) 2002, Alexander Kabaev <kan.FreeBSD.org>.
3 * All rights reserved.
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
28 * Copyright (c) 2001 The NetBSD Foundation, Inc.
29 * All rights reserved.
31 * This code is derived from software contributed to The NetBSD Foundation
32 * by Ichiro FUKUHARA (ichiro@ichiro.org).
34 * Redistribution and use in source and binary forms, with or without
35 * modification, are permitted provided that the following conditions
36 * are met:
37 * 1. Redistributions of source code must retain the above copyright
38 * notice, this list of conditions and the following disclaimer.
39 * 2. Redistributions in binary form must reproduce the above copyright
40 * notice, this list of conditions and the following disclaimer in the
41 * documentation and/or other materials provided with the distribution.
42 * 3. All advertising materials mentioning features or use of this software
43 * must display the following acknowledgement:
44 * This product includes software developed by the NetBSD
45 * Foundation, Inc. and its contributors.
46 * 4. Neither the name of The NetBSD Foundation nor the names of its
47 * contributors may be used to endorse or promote products derived
48 * from this software without specific prior written permission.
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.
62 * $FreeBSD: src/sys/dev/usb/ubsa.c,v 1.11 2003/11/16 12:13:39 akiyama Exp $
63 * $DragonFly: src/sys/dev/usbmisc/ubsa/ubsa.c,v 1.12 2007/06/28 13:55:12 hasso Exp $
66 #include <sys/param.h>
67 #include <sys/systm.h>
68 #include <sys/kernel.h>
69 #include <sys/malloc.h>
70 #include <sys/bus.h>
71 #include <sys/ioccom.h>
72 #include <sys/fcntl.h>
73 #include <sys/interrupt.h>
74 #include <sys/conf.h>
75 #include <sys/tty.h>
76 #include <sys/file.h>
77 #include <sys/select.h>
78 #include <sys/proc.h>
79 #include <sys/vnode.h>
80 #include <sys/poll.h>
81 #include <sys/sysctl.h>
83 #include <bus/usb/usb.h>
84 #include <bus/usb/usbcdc.h>
86 #include <bus/usb/usbdi.h>
87 #include <bus/usb/usbdi_util.h>
88 #include <bus/usb/usbdevs.h>
89 #include <bus/usb/usb_quirks.h>
91 #include "../ucom/ucomvar.h"
93 #ifdef USB_DEBUG
94 static int ubsadebug = 0;
95 SYSCTL_NODE(_hw_usb, OID_AUTO, ubsa, CTLFLAG_RW, 0, "USB ubsa");
96 SYSCTL_INT(_hw_usb_ubsa, OID_AUTO, debug, CTLFLAG_RW,
97 &ubsadebug, 0, "ubsa debug level");
99 #define DPRINTFN(n, x) do { \
100 if (ubsadebug > (n)) \
101 kprintf x; \
102 } while (0)
103 #else
104 #define DPRINTFN(n, x)
105 #endif
106 #define DPRINTF(x) DPRINTFN(0, x)
108 #define UBSA_MODVER 1 /* module version */
110 #define UBSA_CONFIG_INDEX 1
111 #define UBSA_IFACE_INDEX 0
113 #define UBSA_INTR_INTERVAL 100 /* ms */
115 #define UBSA_SET_BAUDRATE 0x00
116 #define UBSA_SET_STOP_BITS 0x01
117 #define UBSA_SET_DATA_BITS 0x02
118 #define UBSA_SET_PARITY 0x03
119 #define UBSA_SET_DTR 0x0A
120 #define UBSA_SET_RTS 0x0B
121 #define UBSA_SET_BREAK 0x0C
122 #define UBSA_SET_FLOW_CTRL 0x10
124 #define UBSA_PARITY_NONE 0x00
125 #define UBSA_PARITY_EVEN 0x01
126 #define UBSA_PARITY_ODD 0x02
127 #define UBSA_PARITY_MARK 0x03
128 #define UBSA_PARITY_SPACE 0x04
130 #define UBSA_FLOW_NONE 0x0000
131 #define UBSA_FLOW_OCTS 0x0001
132 #define UBSA_FLOW_ODSR 0x0002
133 #define UBSA_FLOW_IDSR 0x0004
134 #define UBSA_FLOW_IDTR 0x0008
135 #define UBSA_FLOW_IRTS 0x0010
136 #define UBSA_FLOW_ORTS 0x0020
137 #define UBSA_FLOW_UNKNOWN 0x0040
138 #define UBSA_FLOW_OXON 0x0080
139 #define UBSA_FLOW_IXON 0x0100
141 /* line status register */
142 #define UBSA_LSR_TSRE 0x40 /* Transmitter empty: byte sent */
143 #define UBSA_LSR_TXRDY 0x20 /* Transmitter buffer empty */
144 #define UBSA_LSR_BI 0x10 /* Break detected */
145 #define UBSA_LSR_FE 0x08 /* Framing error: bad stop bit */
146 #define UBSA_LSR_PE 0x04 /* Parity error */
147 #define UBSA_LSR_OE 0x02 /* Overrun, lost incoming byte */
148 #define UBSA_LSR_RXRDY 0x01 /* Byte ready in Receive Buffer */
149 #define UBSA_LSR_RCV_MASK 0x1f /* Mask for incoming data or error */
151 /* modem status register */
152 /* All deltas are from the last read of the MSR. */
153 #define UBSA_MSR_DCD 0x80 /* Current Data Carrier Detect */
154 #define UBSA_MSR_RI 0x40 /* Current Ring Indicator */
155 #define UBSA_MSR_DSR 0x20 /* Current Data Set Ready */
156 #define UBSA_MSR_CTS 0x10 /* Current Clear to Send */
157 #define UBSA_MSR_DDCD 0x08 /* DCD has changed state */
158 #define UBSA_MSR_TERI 0x04 /* RI has toggled low to high */
159 #define UBSA_MSR_DDSR 0x02 /* DSR has changed state */
160 #define UBSA_MSR_DCTS 0x01 /* CTS has changed state */
162 struct ubsa_softc {
163 struct ucom_softc sc_ucom;
165 int sc_iface_number; /* interface number */
167 usbd_interface_handle sc_intr_iface; /* interrupt interface */
168 int sc_intr_number; /* interrupt number */
169 usbd_pipe_handle sc_intr_pipe; /* interrupt pipe */
170 u_char *sc_intr_buf; /* interrupt buffer */
171 int sc_isize;
173 u_char sc_dtr; /* current DTR state */
174 u_char sc_rts; /* current RTS state */
176 u_char sc_lsr; /* Local status register */
177 u_char sc_msr; /* ubsa status register */
180 static void ubsa_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
181 static void ubsa_notify(void *);
183 static void ubsa_get_status(void *, int, u_char *, u_char *);
184 static void ubsa_set(void *, int, int, int);
185 static int ubsa_param(void *, int, struct termios *);
186 static int ubsa_open(void *, int);
187 static void ubsa_close(void *, int);
189 static int ubsa_request(struct ubsa_softc *, u_int8_t, u_int16_t);
190 static void ubsa_dtr(struct ubsa_softc *, int);
191 static void ubsa_rts(struct ubsa_softc *, int);
192 static void ubsa_baudrate(struct ubsa_softc *, speed_t);
193 static void ubsa_parity(struct ubsa_softc *, tcflag_t);
194 static void ubsa_databits(struct ubsa_softc *, tcflag_t);
195 static void ubsa_stopbits(struct ubsa_softc *, tcflag_t);
196 static void ubsa_flow(struct ubsa_softc *, tcflag_t, tcflag_t);
198 struct ucom_callback ubsa_callback = {
199 ubsa_get_status,
200 ubsa_set,
201 ubsa_param,
202 NULL,
203 ubsa_open,
204 ubsa_close,
205 NULL,
206 NULL
209 static const struct ubsa_product {
210 uint16_t vendor;
211 uint16_t product;
212 } ubsa_products [] = {
213 /* BELKIN F5U103 */
214 { USB_VENDOR_BELKIN, USB_PRODUCT_BELKIN_F5U103 },
215 /* BELKIN F5U120 */
216 { USB_VENDOR_BELKIN, USB_PRODUCT_BELKIN_F5U120 },
217 /* GoHubs GO-COM232 */
218 { USB_VENDOR_ETEK, USB_PRODUCT_ETEK_1COM },
219 /* GoHubs GO-COM232 */
220 { USB_VENDOR_GOHUBS, USB_PRODUCT_GOHUBS_GOCOM232 },
221 /* Peracom */
222 { USB_VENDOR_PERACOM, USB_PRODUCT_PERACOM_SERIAL1 },
223 { 0, 0 }
226 static device_probe_t ubsa_match;
227 static device_attach_t ubsa_attach;
228 static device_detach_t ubsa_detach;
230 static device_method_t ubsa_methods[] = {
231 /* Device interface */
232 DEVMETHOD(device_probe, ubsa_match),
233 DEVMETHOD(device_attach, ubsa_attach),
234 DEVMETHOD(device_detach, ubsa_detach),
235 { 0, 0 }
238 static driver_t ubsa_driver = {
239 "ucom",
240 ubsa_methods,
241 sizeof (struct ubsa_softc)
244 DRIVER_MODULE(ubsa, uhub, ubsa_driver, ucom_devclass, usbd_driver_load, 0);
245 MODULE_DEPEND(ubsa, usb, 1, 1, 1);
246 MODULE_DEPEND(ubsa, ucom, UCOM_MINVER, UCOM_PREFVER, UCOM_MAXVER);
247 MODULE_VERSION(ubsa, UBSA_MODVER);
249 USB_MATCH(ubsa)
251 USB_MATCH_START(ubsa, uaa);
252 int i;
254 if (uaa->iface != NULL)
255 return (UMATCH_NONE);
257 for (i = 0; ubsa_products[i].vendor != 0; i++) {
258 if (ubsa_products[i].vendor == uaa->vendor &&
259 ubsa_products[i].product == uaa->product) {
260 return (UMATCH_VENDOR_PRODUCT);
263 return (UMATCH_NONE);
266 USB_ATTACH(ubsa)
268 USB_ATTACH_START(ubsa, sc, uaa);
269 usbd_device_handle dev;
270 struct ucom_softc *ucom;
271 usb_config_descriptor_t *cdesc;
272 usb_interface_descriptor_t *id;
273 usb_endpoint_descriptor_t *ed;
274 char *devinfo;
275 const char *devname;
276 usbd_status err;
277 int i;
279 dev = uaa->device;
280 devinfo = kmalloc(1024, M_USBDEV, M_INTWAIT);
281 ucom = &sc->sc_ucom;
283 bzero(sc, sizeof (struct ubsa_softc));
286 * initialize rts, dtr variables to something
287 * different from boolean 0, 1
289 sc->sc_dtr = -1;
290 sc->sc_rts = -1;
292 usbd_devinfo(dev, 0, devinfo);
293 /* USB_ATTACH_SETUP; */
294 ucom->sc_dev = self;
295 device_set_desc_copy(self, devinfo);
296 /* USB_ATTACH_SETUP; */
298 ucom->sc_udev = dev;
299 ucom->sc_iface = uaa->iface;
301 devname = device_get_nameunit(ucom->sc_dev);
302 kprintf("%s: %s\n", devname, devinfo);
304 DPRINTF(("ubsa attach: sc = %p\n", sc));
306 /* initialize endpoints */
307 ucom->sc_bulkin_no = ucom->sc_bulkout_no = -1;
308 sc->sc_intr_number = -1;
309 sc->sc_intr_pipe = NULL;
311 /* Move the device into the configured state. */
312 err = usbd_set_config_index(dev, UBSA_CONFIG_INDEX, 1);
313 if (err) {
314 kprintf("%s: failed to set configuration: %s\n",
315 devname, usbd_errstr(err));
316 ucom->sc_dying = 1;
317 goto error;
320 /* get the config descriptor */
321 cdesc = usbd_get_config_descriptor(ucom->sc_udev);
323 if (cdesc == NULL) {
324 kprintf("%s: failed to get configuration descriptor\n",
325 device_get_nameunit(ucom->sc_dev));
326 ucom->sc_dying = 1;
327 goto error;
330 /* get the first interface */
331 err = usbd_device2interface_handle(dev, UBSA_IFACE_INDEX,
332 &ucom->sc_iface);
333 if (err) {
334 kprintf("%s: failed to get interface: %s\n",
335 devname, usbd_errstr(err));
336 ucom->sc_dying = 1;
337 goto error;
340 /* Find the endpoints */
342 id = usbd_get_interface_descriptor(ucom->sc_iface);
343 sc->sc_iface_number = id->bInterfaceNumber;
345 for (i = 0; i < id->bNumEndpoints; i++) {
346 ed = usbd_interface2endpoint_descriptor(ucom->sc_iface, i);
347 if (ed == NULL) {
348 kprintf("%s: no endpoint descriptor for %d\n",
349 device_get_nameunit(ucom->sc_dev), i);
350 ucom->sc_dying = 1;
351 goto error;
354 if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
355 UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
356 sc->sc_intr_number = ed->bEndpointAddress;
357 sc->sc_isize = UGETW(ed->wMaxPacketSize);
358 } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
359 UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
360 ucom->sc_bulkin_no = ed->bEndpointAddress;
361 ucom->sc_ibufsize = UGETW(ed->wMaxPacketSize);
362 } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
363 UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
364 ucom->sc_bulkout_no = ed->bEndpointAddress;
365 ucom->sc_obufsize = UGETW(ed->wMaxPacketSize);
369 if (sc->sc_intr_number == -1) {
370 kprintf("%s: Could not find interrupt in\n",
371 device_get_nameunit(ucom->sc_dev));
372 ucom->sc_dying = 1;
373 goto error;
376 /* keep interface for interrupt */
377 sc->sc_intr_iface = ucom->sc_iface;
379 if (ucom->sc_bulkin_no == -1) {
380 kprintf("%s: Could not find data bulk in\n",
381 device_get_nameunit(ucom->sc_dev));
382 ucom->sc_dying = 1;
383 goto error;
386 if (ucom->sc_bulkout_no == -1) {
387 kprintf("%s: Could not find data bulk out\n",
388 device_get_nameunit(ucom->sc_dev));
389 ucom->sc_dying = 1;
390 goto error;
393 ucom->sc_parent = sc;
394 ucom->sc_portno = UCOM_UNK_PORTNO;
395 /* bulkin, bulkout set above */
396 ucom->sc_ibufsizepad = ucom->sc_ibufsize;
397 ucom->sc_opkthdrlen = 0;
398 ucom->sc_callback = &ubsa_callback;
400 DPRINTF(("ubsa: in = 0x%x, out = 0x%x, intr = 0x%x\n",
401 ucom->sc_bulkin_no, ucom->sc_bulkout_no, sc->sc_intr_number));
403 ucom_attach(ucom);
405 kfree(devinfo, M_USBDEV);
406 USB_ATTACH_SUCCESS_RETURN;
408 error:
409 kfree(devinfo, M_USBDEV);
410 USB_ATTACH_ERROR_RETURN;
413 USB_DETACH(ubsa)
415 USB_DETACH_START(ubsa, sc);
416 int rv;
419 DPRINTF(("ubsa_detach: sc = %p\n", sc));
421 if (sc->sc_intr_pipe != NULL) {
422 usbd_abort_pipe(sc->sc_intr_pipe);
423 usbd_close_pipe(sc->sc_intr_pipe);
424 kfree(sc->sc_intr_buf, M_USBDEV);
425 sc->sc_intr_pipe = NULL;
428 sc->sc_ucom.sc_dying = 1;
430 rv = ucom_detach(&sc->sc_ucom);
432 return (rv);
435 static int
436 ubsa_request(struct ubsa_softc *sc, u_int8_t request, u_int16_t value)
438 usb_device_request_t req;
439 usbd_status err;
441 req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
442 req.bRequest = request;
443 USETW(req.wValue, value);
444 USETW(req.wIndex, sc->sc_iface_number);
445 USETW(req.wLength, 0);
447 err = usbd_do_request(sc->sc_ucom.sc_udev, &req, 0);
448 if (err)
449 kprintf("%s: ubsa_request: %s\n",
450 device_get_nameunit(sc->sc_ucom.sc_dev), usbd_errstr(err));
451 return (err);
454 static void
455 ubsa_dtr(struct ubsa_softc *sc, int onoff)
458 DPRINTF(("ubsa_dtr: onoff = %d\n", onoff));
460 if (sc->sc_dtr == onoff)
461 return;
462 sc->sc_dtr = onoff;
464 ubsa_request(sc, UBSA_SET_DTR, onoff ? 1 : 0);
467 static void
468 ubsa_rts(struct ubsa_softc *sc, int onoff)
471 DPRINTF(("ubsa_rts: onoff = %d\n", onoff));
473 if (sc->sc_rts == onoff)
474 return;
475 sc->sc_rts = onoff;
477 ubsa_request(sc, UBSA_SET_RTS, onoff ? 1 : 0);
480 static void
481 ubsa_break(struct ubsa_softc *sc, int onoff)
484 DPRINTF(("ubsa_rts: onoff = %d\n", onoff));
486 ubsa_request(sc, UBSA_SET_BREAK, onoff ? 1 : 0);
489 static void
490 ubsa_set(void *addr, int portno, int reg, int onoff)
492 struct ubsa_softc *sc;
494 sc = addr;
495 switch (reg) {
496 case UCOM_SET_DTR:
497 ubsa_dtr(sc, onoff);
498 break;
499 case UCOM_SET_RTS:
500 ubsa_rts(sc, onoff);
501 break;
502 case UCOM_SET_BREAK:
503 ubsa_break(sc, onoff);
504 break;
505 default:
506 break;
510 static void
511 ubsa_baudrate(struct ubsa_softc *sc, speed_t speed)
513 u_int16_t value = 0;
515 DPRINTF(("ubsa_baudrate: speed = %d\n", speed));
517 switch(speed) {
518 case B0:
519 break;
520 case B300:
521 case B600:
522 case B1200:
523 case B2400:
524 case B4800:
525 case B9600:
526 case B19200:
527 case B38400:
528 case B57600:
529 case B115200:
530 case B230400:
531 value = B230400 / speed;
532 break;
533 default:
534 kprintf("%s: ubsa_param: unsupported baudrate, "
535 "forcing default of 9600\n",
536 device_get_nameunit(sc->sc_ucom.sc_dev));
537 value = B230400 / B9600;
538 break;
541 if (speed == B0) {
542 ubsa_flow(sc, 0, 0);
543 ubsa_dtr(sc, 0);
544 ubsa_rts(sc, 0);
545 } else
546 ubsa_request(sc, UBSA_SET_BAUDRATE, value);
549 static void
550 ubsa_parity(struct ubsa_softc *sc, tcflag_t cflag)
552 int value;
554 DPRINTF(("ubsa_parity: cflag = 0x%x\n", cflag));
556 if (cflag & PARENB)
557 value = (cflag & PARODD) ? UBSA_PARITY_ODD : UBSA_PARITY_EVEN;
558 else
559 value = UBSA_PARITY_NONE;
561 ubsa_request(sc, UBSA_SET_PARITY, value);
564 static void
565 ubsa_databits(struct ubsa_softc *sc, tcflag_t cflag)
567 int value;
569 DPRINTF(("ubsa_databits: cflag = 0x%x\n", cflag));
571 switch (cflag & CSIZE) {
572 case CS5: value = 0; break;
573 case CS6: value = 1; break;
574 case CS7: value = 2; break;
575 case CS8: value = 3; break;
576 default:
577 kprintf("%s: ubsa_param: unsupported databits requested, "
578 "forcing default of 8\n",
579 device_get_nameunit(sc->sc_ucom.sc_dev));
580 value = 3;
583 ubsa_request(sc, UBSA_SET_DATA_BITS, value);
586 static void
587 ubsa_stopbits(struct ubsa_softc *sc, tcflag_t cflag)
589 int value;
591 DPRINTF(("ubsa_stopbits: cflag = 0x%x\n", cflag));
593 value = (cflag & CSTOPB) ? 1 : 0;
595 ubsa_request(sc, UBSA_SET_STOP_BITS, value);
598 static void
599 ubsa_flow(struct ubsa_softc *sc, tcflag_t cflag, tcflag_t iflag)
601 int value;
603 DPRINTF(("ubsa_flow: cflag = 0x%x, iflag = 0x%x\n", cflag, iflag));
605 value = 0;
606 if (cflag & CRTSCTS)
607 value |= UBSA_FLOW_OCTS | UBSA_FLOW_IRTS;
608 if (iflag & (IXON|IXOFF))
609 value |= UBSA_FLOW_OXON | UBSA_FLOW_IXON;
611 ubsa_request(sc, UBSA_SET_FLOW_CTRL, value);
614 static int
615 ubsa_param(void *addr, int portno, struct termios *ti)
617 struct ubsa_softc *sc;
619 sc = addr;
621 DPRINTF(("ubsa_param: sc = %p\n", sc));
623 ubsa_baudrate(sc, ti->c_ospeed);
624 ubsa_parity(sc, ti->c_cflag);
625 ubsa_databits(sc, ti->c_cflag);
626 ubsa_stopbits(sc, ti->c_cflag);
627 ubsa_flow(sc, ti->c_cflag, ti->c_iflag);
629 return (0);
632 static int
633 ubsa_open(void *addr, int portno)
635 struct ubsa_softc *sc;
636 int err;
638 sc = addr;
639 if (sc->sc_ucom.sc_dying)
640 return (ENXIO);
642 DPRINTF(("ubsa_open: sc = %p\n", sc));
644 if (sc->sc_intr_number != -1 && sc->sc_intr_pipe == NULL) {
645 sc->sc_intr_buf = kmalloc(sc->sc_isize, M_USBDEV, M_WAITOK);
646 err = usbd_open_pipe_intr(sc->sc_intr_iface,
647 sc->sc_intr_number,
648 USBD_SHORT_XFER_OK,
649 &sc->sc_intr_pipe,
651 sc->sc_intr_buf,
652 sc->sc_isize,
653 ubsa_intr,
654 UBSA_INTR_INTERVAL);
655 if (err) {
656 kprintf("%s: cannot open interrupt pipe (addr %d)\n",
657 device_get_nameunit(sc->sc_ucom.sc_dev),
658 sc->sc_intr_number);
659 return (EIO);
663 return (0);
666 static void
667 ubsa_close(void *addr, int portno)
669 struct ubsa_softc *sc;
670 int err;
672 sc = addr;
673 if (sc->sc_ucom.sc_dying)
674 return;
676 DPRINTF(("ubsa_close: close\n"));
678 if (sc->sc_intr_pipe != NULL) {
679 err = usbd_abort_pipe(sc->sc_intr_pipe);
680 if (err)
681 kprintf("%s: abort interrupt pipe failed: %s\n",
682 device_get_nameunit(sc->sc_ucom.sc_dev),
683 usbd_errstr(err));
684 err = usbd_close_pipe(sc->sc_intr_pipe);
685 if (err)
686 kprintf("%s: close interrupt pipe failed: %s\n",
687 device_get_nameunit(sc->sc_ucom.sc_dev),
688 usbd_errstr(err));
689 kfree(sc->sc_intr_buf, M_USBDEV);
690 sc->sc_intr_pipe = NULL;
694 static void
695 ubsa_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
697 struct ubsa_softc *sc;
698 u_char *buf;
700 sc = priv;
701 buf = sc->sc_intr_buf;
702 if (sc->sc_ucom.sc_dying)
703 return;
705 if (status != USBD_NORMAL_COMPLETION) {
706 if (status == USBD_NOT_STARTED || status == USBD_CANCELLED)
707 return;
709 DPRINTF(("%s: ubsa_intr: abnormal status: %s\n",
710 device_get_nameunit(sc->sc_ucom.sc_dev),
711 usbd_errstr(status)));
712 usbd_clear_endpoint_stall_async(sc->sc_intr_pipe);
713 return;
716 /* incidentally, Belkin adapter status bits match UART 16550 bits */
717 sc->sc_lsr = buf[2];
718 sc->sc_msr = buf[3];
720 DPRINTF(("%s: ubsa lsr = 0x%02x, msr = 0x%02x\n",
721 device_get_nameunit(sc->sc_ucom.sc_dev), sc->sc_lsr, sc->sc_msr));
723 ubsa_notify(sc);
726 /* Handle delayed events. */
727 static void
728 ubsa_notify(void *arg)
730 struct ubsa_softc *sc;
732 sc = arg;
733 ucom_status_change(&sc->sc_ucom);
736 static void
737 ubsa_get_status(void *addr, int portno, u_char *lsr, u_char *msr)
739 struct ubsa_softc *sc;
741 DPRINTF(("ubsa_get_status\n"));
743 sc = addr;
744 if (lsr != NULL)
745 *lsr = sc->sc_lsr;
746 if (msr != NULL)
747 *msr = sc->sc_msr;