/* $NetBSD: uirda.c,v 1.17 2004/04/23 17:25:25 itojun Exp $ */ /* * Copyright (c) 2001 The NetBSD Foundation, Inc. * All rights reserved. * * This code is derived from software contributed to The NetBSD Foundation * by Lennart Augustsson (lennart@augustsson.net). * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by the NetBSD * Foundation, Inc. and its contributors. * 4. Neither the name of The NetBSD Foundation nor the names of its * contributors may be used to endorse or promote products derived * from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include __KERNEL_RCSID(0, "$NetBSD: uirda.c,v 1.17 2004/04/23 17:25:25 itojun Exp $"); #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #ifdef UIRDA_DEBUG #define DPRINTF(x) if (uirdadebug) logprintf x #define DPRINTFN(n,x) if (uirdadebug>(n)) logprintf x int uirdadebug = 0; #else #define DPRINTF(x) #define DPRINTFN(n,x) #endif /* * Protocol related definitions */ #define UIRDA_INPUT_HEADER_SIZE 1 /* Inbound header byte */ #define UIRDA_MEDIA_BUSY 0x80 #define UIRDA_SPEED_MASK 0x0f #define UIRDA_NO_SPEED 0x00 #define UIRDA_2400 0x01 #define UIRDA_9600 0x02 #define UIRDA_19200 0x03 #define UIRDA_38400 0x04 #define UIRDA_57600 0x05 #define UIRDA_115200 0x06 #define UIRDA_576000 0x07 #define UIRDA_1152000 0x08 #define UIRDA_4000000 0x09 #define UIRDA_OUTPUT_HEADER_SIZE 1 /* Outbound header byte */ #define UIRDA_EB_NO_CHANGE 0x00 #define UIRDA_EB_48 0x10 #define UIRDA_EB_24 0x20 #define UIRDA_EB_12 0x30 #define UIRDA_EB_6 0x40 #define UIRDA_EB_3 0x50 #define UIRDA_EB_2 0x60 #define UIRDA_EB_1 0x70 #define UIRDA_EB_0 0x80 /* Speeds as above */ /* Class specific requests */ #define UR_IRDA_RECEIVING 0x01 /* Receive in progress? */ #define UR_IRDA_CHECK_MEDIA_BUSY 0x03 #define UR_IRDA_SET_RATE_SNIFF 0x04 /* opt */ #define UR_IRDA_SET_UNICAST_LIST 0x05 /* opt */ #define UR_IRDA_GET_DESC 0x06 typedef struct { uByte bLength; uByte bDescriptorType; #define UDESC_IRDA 0x21 uWord bcdSpecRevision; uByte bmDataSize; #define UI_DS_2048 0x20 #define UI_DS_1024 0x10 #define UI_DS_512 0x08 #define UI_DS_256 0x04 #define UI_DS_128 0x02 #define UI_DS_64 0x01 uByte bmWindowSize; #define UI_WS_7 0x40 #define UI_WS_6 0x20 #define UI_WS_5 0x10 #define UI_WS_4 0x08 #define UI_WS_3 0x04 #define UI_WS_2 0x02 #define UI_WS_1 0x01 uByte bmMinTurnaroundTime; #define UI_TA_0 0x80 #define UI_TA_10 0x40 #define UI_TA_50 0x20 #define UI_TA_100 0x10 #define UI_TA_500 0x08 #define UI_TA_1000 0x04 #define UI_TA_5000 0x02 #define UI_TA_10000 0x01 uWord wBaudRate; #define UI_BR_4000000 0x0100 #define UI_BR_1152000 0x0080 #define UI_BR_576000 0x0040 #define UI_BR_115200 0x0020 #define UI_BR_57600 0x0010 #define UI_BR_38400 0x0008 #define UI_BR_19200 0x0004 #define UI_BR_9600 0x0002 #define UI_BR_2400 0x0001 uByte bmAdditionalBOFs; #define UI_EB_0 0x80 #define UI_EB_1 0x40 #define UI_EB_2 0x20 #define UI_EB_3 0x10 #define UI_EB_6 0x08 #define UI_EB_12 0x04 #define UI_EB_24 0x02 #define UI_EB_48 0x01 uByte bIrdaSniff; uByte bMaxUnicastList; } UPACKED usb_irda_descriptor_t; #define USB_IRDA_DESCRIPTOR_SIZE 12 #define UIRDA_NEBOFS 8 static struct { int count; int mask; int header; } uirda_ebofs[UIRDA_NEBOFS] = { { 0, UI_EB_0, UIRDA_EB_0 }, { 1, UI_EB_1, UIRDA_EB_1 }, { 2, UI_EB_2, UIRDA_EB_2 }, { 3, UI_EB_3, UIRDA_EB_3 }, { 6, UI_EB_6, UIRDA_EB_6 }, { 12, UI_EB_12, UIRDA_EB_12 }, { 24, UI_EB_24, UIRDA_EB_24 }, { 48, UI_EB_48, UIRDA_EB_48 } }; #define UIRDA_NSPEEDS 9 static struct { int speed; int mask; int header; } uirda_speeds[UIRDA_NSPEEDS] = { { 4000000, UI_BR_4000000, UIRDA_4000000 }, { 1152000, UI_BR_1152000, UIRDA_1152000 }, { 576000, UI_BR_576000, UIRDA_576000 }, { 115200, UI_BR_115200, UIRDA_115200 }, { 57600, UI_BR_57600, UIRDA_57600 }, { 38400, UI_BR_38400, UIRDA_38400 }, { 19200, UI_BR_19200, UIRDA_19200 }, { 9600, UI_BR_9600, UIRDA_9600 }, { 2400, UI_BR_2400, UIRDA_2400 }, }; struct uirda_softc { USBBASEDEVICE sc_dev; usbd_device_handle sc_udev; usbd_interface_handle sc_iface; struct lock sc_rd_buf_lk; u_int8_t *sc_rd_buf; int sc_rd_addr; usbd_pipe_handle sc_rd_pipe; usbd_xfer_handle sc_rd_xfer; struct selinfo sc_rd_sel; u_int sc_rd_count; u_char sc_rd_err; struct lock sc_wr_buf_lk; u_int8_t *sc_wr_buf; int sc_wr_addr; usbd_xfer_handle sc_wr_xfer; usbd_pipe_handle sc_wr_pipe; int sc_wr_hdr; struct selinfo sc_wr_sel; struct device *sc_child; struct irda_params sc_params; usb_irda_descriptor_t sc_irdadesc; int sc_refcnt; char sc_dying; }; #define UIRDA_WR_TIMEOUT 200 int uirda_open(void *h, int flag, int mode, usb_proc_ptr p); int uirda_close(void *h, int flag, int mode, usb_proc_ptr p); int uirda_read(void *h, struct uio *uio, int flag); int uirda_write(void *h, struct uio *uio, int flag); int uirda_set_params(void *h, struct irda_params *params); int uirda_get_speeds(void *h, int *speeds); int uirda_get_turnarounds(void *h, int *times); int uirda_poll(void *h, int events, usb_proc_ptr p); int uirda_kqfilter(void *h, struct knote *kn); struct irframe_methods uirda_methods = { uirda_open, uirda_close, uirda_read, uirda_write, uirda_poll, uirda_kqfilter, uirda_set_params, uirda_get_speeds, uirda_get_turnarounds }; void uirda_rd_cb(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status); usbd_status uirda_start_read(struct uirda_softc *sc); usb_descriptor_t *usb_find_desc(usbd_device_handle dev, int type); /* * These devices don't quite follow the spec. Speed changing is broken * and they don't handle windows. * But we change speed in a safe way, and don't use windows now. * Some devices also seem to have an interrupt pipe that can be ignored. * * Table information taken from Linux driver. */ Static const struct usb_devno uirda_devs[] = { { USB_VENDOR_ACTISYS, USB_PRODUCT_ACTISYS_IR2000U }, { USB_VENDOR_EXTENDED, USB_PRODUCT_EXTENDED_XTNDACCESS }, { USB_VENDOR_KAWATSU, USB_PRODUCT_KAWATSU_KC180 }, }; #define uirda_lookup(v, p) (usb_lookup(uirda_devs, v, p)) USB_DECLARE_DRIVER(uirda); USB_MATCH(uirda) { USB_MATCH_START(uirda, uaa); usb_interface_descriptor_t *id; DPRINTFN(50,("uirda_match\n")); if (uaa->iface == NULL) return (UMATCH_NONE); if (uirda_lookup(uaa->vendor, uaa->product) != NULL) return (UMATCH_VENDOR_PRODUCT); id = usbd_get_interface_descriptor(uaa->iface); if (id != NULL && id->bInterfaceClass == UICLASS_APPL_SPEC && id->bInterfaceSubClass == UISUBCLASS_IRDA && id->bInterfaceProtocol == UIPROTO_IRDA) return (UMATCH_IFACECLASS_IFACESUBCLASS_IFACEPROTO); return (UMATCH_NONE); } USB_ATTACH(uirda) { USB_ATTACH_START(uirda, sc, uaa); usbd_device_handle dev = uaa->device; usbd_interface_handle iface = uaa->iface; char devinfo[1024]; usb_endpoint_descriptor_t *ed; usbd_status err; u_int8_t epcount; u_int specrev; int i; struct ir_attach_args ia; DPRINTFN(10,("uirda_attach: sc=%p\n", sc)); usbd_devinfo(dev, 0, devinfo, sizeof(devinfo)); USB_ATTACH_SETUP; printf("%s: %s\n", USBDEVNAME(sc->sc_dev), devinfo); sc->sc_udev = dev; sc->sc_iface = iface; epcount = 0; (void)usbd_endpoint_count(iface, &epcount); sc->sc_rd_addr = -1; sc->sc_wr_addr = -1; for (i = 0; i < epcount; i++) { ed = usbd_interface2endpoint_descriptor(iface, i); if (ed == NULL) { printf("%s: couldn't get ep %d\n", USBDEVNAME(sc->sc_dev), i); USB_ATTACH_ERROR_RETURN; } if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN && UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) { sc->sc_rd_addr = ed->bEndpointAddress; } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT && UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) { sc->sc_wr_addr = ed->bEndpointAddress; } } if (sc->sc_rd_addr == -1 || sc->sc_wr_addr == -1) { printf("%s: missing endpoint\n", USBDEVNAME(sc->sc_dev)); USB_ATTACH_ERROR_RETURN; } /* Get the IrDA descriptor */ err = usbd_get_desc(sc->sc_udev, UDESC_IRDA, 0, USB_IRDA_DESCRIPTOR_SIZE, &sc->sc_irdadesc); if (err) { /* maybe it's embedded in the config desc? */ void *d = usb_find_desc(sc->sc_udev, UDESC_IRDA); if (d == NULL) { printf("%s: Cannot get IrDA descriptor\n", USBDEVNAME(sc->sc_dev)); USB_ATTACH_ERROR_RETURN; } memcpy(&sc->sc_irdadesc, d, USB_IRDA_DESCRIPTOR_SIZE); } DPRINTF(("uirda_attach: bmDataSize=0x%02x bmWindowSize=0x%02x " "bmMinTurnaroundTime=0x%02x wBaudRate=0x%04x " "bmAdditionalBOFs=0x%02x bIrdaSniff=%d bMaxUnicastList=%d\n", sc->sc_irdadesc.bmDataSize, sc->sc_irdadesc.bmWindowSize, sc->sc_irdadesc.bmMinTurnaroundTime, UGETW(sc->sc_irdadesc.wBaudRate), sc->sc_irdadesc.bmAdditionalBOFs, sc->sc_irdadesc.bIrdaSniff, sc->sc_irdadesc.bMaxUnicastList)); specrev = UGETW(sc->sc_irdadesc.bcdSpecRevision); printf("%s: USB-IrDA protocol version %x.%02x\n", USBDEVNAME(sc->sc_dev), specrev >> 8, specrev & 0xff); DPRINTFN(10, ("uirda_attach: %p\n", sc->sc_udev)); usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, USBDEV(sc->sc_dev)); lockinit(&sc->sc_wr_buf_lk, PZERO, "iirwrl", 0, 0); lockinit(&sc->sc_rd_buf_lk, PZERO, "uirrdl", 0, 0); ia.ia_type = IR_TYPE_IRFRAME; ia.ia_methods = &uirda_methods; ia.ia_handle = sc; sc->sc_child = config_found(self, &ia, ir_print); USB_ATTACH_SUCCESS_RETURN; } USB_DETACH(uirda) { USB_DETACH_START(uirda, sc); int s; int rv = 0; DPRINTF(("uirda_detach: sc=%p flags=%d\n", sc, flags)); sc->sc_dying = 1; /* Abort all pipes. Causes processes waiting for transfer to wake. */ if (sc->sc_rd_pipe != NULL) { usbd_abort_pipe(sc->sc_rd_pipe); usbd_close_pipe(sc->sc_rd_pipe); sc->sc_rd_pipe = NULL; } if (sc->sc_wr_pipe != NULL) { usbd_abort_pipe(sc->sc_wr_pipe); usbd_close_pipe(sc->sc_wr_pipe); sc->sc_wr_pipe = NULL; } wakeup(&sc->sc_rd_count); s = splusb(); if (--sc->sc_refcnt >= 0) { /* Wait for processes to go away. */ usb_detach_wait(USBDEV(sc->sc_dev)); } splx(s); if (sc->sc_child != NULL) { rv = config_detach(sc->sc_child, flags); sc->sc_child = NULL; } usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, USBDEV(sc->sc_dev)); return (rv); } int uirda_activate(device_ptr_t self, enum devact act) { struct uirda_softc *sc = (struct uirda_softc *)self; int error = 0; switch (act) { case DVACT_ACTIVATE: return (EOPNOTSUPP); break; case DVACT_DEACTIVATE: sc->sc_dying = 1; if (sc->sc_child != NULL) error = config_deactivate(sc->sc_child); break; } return (error); } int uirda_open(void *h, int flag, int mode, usb_proc_ptr p) { struct uirda_softc *sc = h; int error; usbd_status err; DPRINTF(("%s: sc=%p\n", __func__, sc)); err = usbd_open_pipe(sc->sc_iface, sc->sc_rd_addr, 0, &sc->sc_rd_pipe); if (err) { error = EIO; goto bad1; } err = usbd_open_pipe(sc->sc_iface, sc->sc_wr_addr, 0, &sc->sc_wr_pipe); if (err) { error = EIO; goto bad2; } sc->sc_rd_xfer = usbd_alloc_xfer(sc->sc_udev); if (sc->sc_rd_xfer == NULL) { error = ENOMEM; goto bad3; } sc->sc_wr_xfer = usbd_alloc_xfer(sc->sc_udev); if (sc->sc_wr_xfer == NULL) { error = ENOMEM; goto bad4; } sc->sc_rd_buf = usbd_alloc_buffer(sc->sc_rd_xfer, IRDA_MAX_FRAME_SIZE + UIRDA_INPUT_HEADER_SIZE); if (sc->sc_rd_buf == NULL) { error = ENOMEM; goto bad5; } sc->sc_wr_buf = usbd_alloc_buffer(sc->sc_wr_xfer, IRDA_MAX_FRAME_SIZE + UIRDA_OUTPUT_HEADER_SIZE); if (sc->sc_wr_buf == NULL) { error = ENOMEM; goto bad5; } sc->sc_rd_count = 0; sc->sc_rd_err = 0; sc->sc_params.speed = 0; sc->sc_params.ebofs = 0; sc->sc_params.maxsize = IRDA_MAX_FRAME_SIZE; sc->sc_wr_hdr = -1; err = uirda_start_read(sc); /* XXX check err */ return (0); bad5: usbd_free_xfer(sc->sc_wr_xfer); sc->sc_wr_xfer = NULL; bad4: usbd_free_xfer(sc->sc_rd_xfer); sc->sc_rd_xfer = NULL; bad3: usbd_close_pipe(sc->sc_wr_pipe); sc->sc_wr_pipe = NULL; bad2: usbd_close_pipe(sc->sc_rd_pipe); sc->sc_rd_pipe = NULL; bad1: return (error); } int uirda_close(void *h, int flag, int mode, usb_proc_ptr p) { struct uirda_softc *sc = h; DPRINTF(("%s: sc=%p\n", __func__, sc)); if (sc->sc_rd_pipe != NULL) { usbd_abort_pipe(sc->sc_rd_pipe); usbd_close_pipe(sc->sc_rd_pipe); sc->sc_rd_pipe = NULL; } if (sc->sc_wr_pipe != NULL) { usbd_abort_pipe(sc->sc_wr_pipe); usbd_close_pipe(sc->sc_wr_pipe); sc->sc_wr_pipe = NULL; } if (sc->sc_rd_xfer != NULL) { usbd_free_xfer(sc->sc_rd_xfer); sc->sc_rd_xfer = NULL; sc->sc_rd_buf = NULL; } if (sc->sc_wr_xfer != NULL) { usbd_free_xfer(sc->sc_wr_xfer); sc->sc_wr_xfer = NULL; sc->sc_wr_buf = NULL; } return (0); } int uirda_read(void *h, struct uio *uio, int flag) { struct uirda_softc *sc = h; usbd_status err; int s; int error; u_int n; DPRINTFN(1,("%s: sc=%p\n", __func__, sc)); if (sc->sc_dying) return (EIO); #ifdef DIAGNOSTIC if (sc->sc_rd_buf == NULL) return (EINVAL); #endif sc->sc_refcnt++; do { s = splusb(); while (sc->sc_rd_count == 0) { DPRINTFN(5,("uirda_read: calling tsleep()\n")); error = tsleep(&sc->sc_rd_count, PZERO | PCATCH, "uirdrd", 0); if (sc->sc_dying) error = EIO; if (error) { splx(s); DPRINTF(("uirda_read: tsleep() = %d\n", error)); goto ret; } } splx(s); lockmgr(&sc->sc_rd_buf_lk, LK_EXCLUSIVE, NULL); n = sc->sc_rd_count - UIRDA_INPUT_HEADER_SIZE; DPRINTFN(1,("%s: sc=%p n=%u, hdr=0x%02x\n", __func__, sc, n, sc->sc_rd_buf[0])); if (n > uio->uio_resid) error = EINVAL; else error = uiomove(sc->sc_rd_buf+UIRDA_INPUT_HEADER_SIZE, n, uio); sc->sc_rd_count = 0; lockmgr(&sc->sc_rd_buf_lk, LK_RELEASE, NULL); err = uirda_start_read(sc); /* XXX check err */ } while (n == 0); DPRINTFN(1,("uirda_read: return %d\n", error)); ret: if (--sc->sc_refcnt < 0) usb_detach_wakeup(USBDEV(sc->sc_dev)); return (error); } int uirda_write(void *h, struct uio *uio, int flag) { struct uirda_softc *sc = h; usbd_status err; u_int32_t n; int error = 0; DPRINTFN(1,("%s: sc=%p\n", __func__, sc)); if (sc->sc_dying) return (EIO); #ifdef DIAGNOSTIC if (sc->sc_wr_buf == NULL) return (EINVAL); #endif n = uio->uio_resid; if (n > sc->sc_params.maxsize) return (EINVAL); sc->sc_refcnt++; lockmgr(&sc->sc_wr_buf_lk, LK_EXCLUSIVE, NULL); sc->sc_wr_buf[0] = UIRDA_EB_NO_CHANGE | UIRDA_NO_SPEED; error = uiomove(sc->sc_wr_buf + UIRDA_OUTPUT_HEADER_SIZE, n, uio); if (!error) { DPRINTFN(1, ("uirdawrite: transfer %d bytes\n", n)); n++; err = usbd_bulk_transfer(sc->sc_wr_xfer, sc->sc_wr_pipe, USBD_FORCE_SHORT_XFER | USBD_NO_COPY, UIRDA_WR_TIMEOUT, sc->sc_wr_buf, &n, "uirdawr"); DPRINTFN(2, ("uirdawrite: err=%d\n", err)); if (err) { if (err == USBD_INTERRUPTED) error = EINTR; else if (err == USBD_TIMEOUT) error = ETIMEDOUT; else error = EIO; } } lockmgr(&sc->sc_wr_buf_lk, LK_RELEASE, NULL); if (--sc->sc_refcnt < 0) usb_detach_wakeup(USBDEV(sc->sc_dev)); DPRINTFN(1,("%s: sc=%p done\n", __func__, sc)); return (error); } int uirda_poll(void *h, int events, usb_proc_ptr p) { struct uirda_softc *sc = h; int revents = 0; int s; DPRINTFN(1,("%s: sc=%p\n", __func__, sc)); s = splusb(); if (events & (POLLOUT | POLLWRNORM)) revents |= events & (POLLOUT | POLLWRNORM); if (events & (POLLIN | POLLRDNORM)) { if (sc->sc_rd_count != 0) { DPRINTFN(2,("%s: have data\n", __func__)); revents |= events & (POLLIN | POLLRDNORM); } else { DPRINTFN(2,("%s: recording select\n", __func__)); selrecord(p, &sc->sc_rd_sel); } } splx(s); return (revents); } static void filt_uirdardetach(struct knote *kn) { struct uirda_softc *sc = kn->kn_hook; int s; s = splusb(); SLIST_REMOVE(&sc->sc_rd_sel.sel_klist, kn, knote, kn_selnext); splx(s); } static int filt_uirdaread(struct knote *kn, long hint) { struct uirda_softc *sc = kn->kn_hook; kn->kn_data = sc->sc_rd_count; return (kn->kn_data > 0); } static void filt_uirdawdetach(struct knote *kn) { struct uirda_softc *sc = kn->kn_hook; int s; s = splusb(); SLIST_REMOVE(&sc->sc_wr_sel.sel_klist, kn, knote, kn_selnext); splx(s); } static const struct filterops uirdaread_filtops = { 1, NULL, filt_uirdardetach, filt_uirdaread }; static const struct filterops uirdawrite_filtops = { 1, NULL, filt_uirdawdetach, filt_seltrue }; int uirda_kqfilter(void *h, struct knote *kn) { struct uirda_softc *sc = kn->kn_hook; struct klist *klist; int s; switch (kn->kn_filter) { case EVFILT_READ: klist = &sc->sc_rd_sel.sel_klist; kn->kn_fop = &uirdaread_filtops; break; case EVFILT_WRITE: klist = &sc->sc_wr_sel.sel_klist; kn->kn_fop = &uirdawrite_filtops; break; default: return (1); } kn->kn_hook = sc; s = splusb(); SLIST_INSERT_HEAD(klist, kn, kn_selnext); splx(s); return (0); } int uirda_set_params(void *h, struct irda_params *p) { struct uirda_softc *sc = h; usbd_status err; int i; u_int8_t hdr; u_int32_t n; u_int mask; DPRINTF(("%s: sc=%p, speed=%d ebofs=%d maxsize=%d\n", __func__, sc, p->speed, p->ebofs, p->maxsize)); if (sc->sc_dying) return (EIO); hdr = 0; if (p->ebofs != sc->sc_params.ebofs) { /* round up ebofs */ mask = sc->sc_irdadesc.bmAdditionalBOFs; for (i = 0; i < UIRDA_NEBOFS; i++) { if ((mask & uirda_ebofs[i].mask) && uirda_ebofs[i].count >= p->ebofs) { hdr = uirda_ebofs[i].header; goto found1; } } /* no good value found */ return (EINVAL); found1: DPRINTF(("uirda_set_params: ebofs hdr=0x%02x\n", hdr)); ; } if (hdr != 0 || p->speed != sc->sc_params.speed) { /* find speed */ mask = UGETW(sc->sc_irdadesc.wBaudRate); for (i = 0; i < UIRDA_NSPEEDS; i++) { if ((mask & uirda_speeds[i].mask) && uirda_speeds[i].speed == p->speed) { hdr |= uirda_speeds[i].header; goto found2; } } /* no good value found */ return (EINVAL); found2: DPRINTF(("uirda_set_params: speed hdr=0x%02x\n", hdr)); ; } if (p->maxsize != sc->sc_params.maxsize) { if (p->maxsize > IRDA_MAX_FRAME_SIZE) return (EINVAL); sc->sc_params.maxsize = p->maxsize; #if 0 DPRINTF(("%s: new buffers, old size=%d\n", __func__, sc->sc_params.maxsize)); if (p->maxsize > 10000 || p < 0) /* XXX */ return (EINVAL); /* Change the write buffer */ lockmgr(&sc->sc_wr_buf_lk, LK_EXCLUSIVE, NULL); if (sc->sc_wr_buf != NULL) usbd_free_buffer(sc->sc_wr_xfer); sc->sc_wr_buf = usbd_alloc_buffer(sc->sc_wr_xfer, p->maxsize+1); lockmgr(&sc->sc_wr_buf_lk, LK_RELEASE, NULL); if (sc->sc_wr_buf == NULL) return (ENOMEM); /* Change the read buffer */ lockmgr(&sc->sc_rd_buf_lk, LK_EXCLUSIVE, NULL); usbd_abort_pipe(sc->sc_rd_pipe); if (sc->sc_rd_buf != NULL) usbd_free_buffer(sc->sc_rd_xfer); sc->sc_rd_buf = usbd_alloc_buffer(sc->sc_rd_xfer, p->maxsize+1); sc->sc_rd_count = 0; if (sc->sc_rd_buf == NULL) { lockmgr(&sc->sc_rd_buf_lk, LK_RELEASE, NULL); return (ENOMEM); } sc->sc_params.maxsize = p->maxsize; err = uirda_start_read(sc); /* XXX check */ lockmgr(&sc->sc_rd_buf_lk, LK_RELEASE, NULL); #endif } if (hdr != 0 && hdr != sc->sc_wr_hdr) { /* * A change has occurred, transmit a 0 length frame with * the new settings. The 0 length frame is not sent to the * device. */ DPRINTF(("%s: sc=%p setting header 0x%02x\n", __func__, sc, hdr)); sc->sc_wr_hdr = hdr; lockmgr(&sc->sc_wr_buf_lk, LK_EXCLUSIVE, NULL); sc->sc_wr_buf[0] = hdr; n = UIRDA_OUTPUT_HEADER_SIZE; err = usbd_bulk_transfer(sc->sc_wr_xfer, sc->sc_wr_pipe, USBD_FORCE_SHORT_XFER | USBD_NO_COPY, UIRDA_WR_TIMEOUT, sc->sc_wr_buf, &n, "uirdast"); if (err) { printf("%s: set failed, err=%d\n", USBDEVNAME(sc->sc_dev), err); usbd_clear_endpoint_stall(sc->sc_wr_pipe); } lockmgr(&sc->sc_wr_buf_lk, LK_RELEASE, NULL); } sc->sc_params = *p; return (0); } int uirda_get_speeds(void *h, int *speeds) { struct uirda_softc *sc = h; u_int isp; u_int usp; DPRINTF(("%s: sc=%p\n", __func__, sc)); if (sc->sc_dying) return (EIO); usp = UGETW(sc->sc_irdadesc.wBaudRate); isp = 0; if (usp & UI_BR_4000000) isp |= IRDA_SPEED_4000000; if (usp & UI_BR_1152000) isp |= IRDA_SPEED_1152000; if (usp & UI_BR_576000) isp |= IRDA_SPEED_576000; if (usp & UI_BR_115200) isp |= IRDA_SPEED_115200; if (usp & UI_BR_57600) isp |= IRDA_SPEED_57600; if (usp & UI_BR_38400) isp |= IRDA_SPEED_38400; if (usp & UI_BR_19200) isp |= IRDA_SPEED_19200; if (usp & UI_BR_9600) isp |= IRDA_SPEED_9600; if (usp & UI_BR_2400) isp |= IRDA_SPEED_2400; *speeds = isp; return (0); } int uirda_get_turnarounds(void *h, int *turnarounds) { struct uirda_softc *sc = h; u_int ita; u_int uta; DPRINTF(("%s: sc=%p\n", __func__, sc)); if (sc->sc_dying) return (EIO); uta = sc->sc_irdadesc.bmMinTurnaroundTime; ita = 0; if (uta & UI_TA_0) ita |= IRDA_TURNT_0; if (uta & UI_TA_10) ita |= IRDA_TURNT_10; if (uta & UI_TA_50) ita |= IRDA_TURNT_50; if (uta & UI_TA_100) ita |= IRDA_TURNT_100; if (uta & UI_TA_500) ita |= IRDA_TURNT_500; if (uta & UI_TA_1000) ita |= IRDA_TURNT_1000; if (uta & UI_TA_5000) ita |= IRDA_TURNT_5000; if (uta & UI_TA_10000) ita |= IRDA_TURNT_10000; *turnarounds = ita; return (0); } void uirda_rd_cb(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status) { struct uirda_softc *sc = priv; u_int32_t size; DPRINTFN(1,("%s: sc=%p\n", __func__, sc)); if (status == USBD_CANCELLED) /* this is normal */ return; if (status) { size = UIRDA_INPUT_HEADER_SIZE; sc->sc_rd_err = 1; } else { usbd_get_xfer_status(xfer, NULL, NULL, &size, NULL); } DPRINTFN(1,("%s: sc=%p size=%u, err=%d\n", __func__, sc, size, sc->sc_rd_err)); sc->sc_rd_count = size; wakeup(&sc->sc_rd_count); /* XXX should use flag */ selnotify(&sc->sc_rd_sel, 0); } usbd_status uirda_start_read(struct uirda_softc *sc) { usbd_status err; DPRINTFN(1,("%s: sc=%p, size=%d\n", __func__, sc, sc->sc_params.maxsize + UIRDA_INPUT_HEADER_SIZE)); if (sc->sc_dying) return (USBD_IOERROR); if (sc->sc_rd_err) { sc->sc_rd_err = 0; DPRINTF(("uirda_start_read: clear stall\n")); usbd_clear_endpoint_stall(sc->sc_rd_pipe); } usbd_setup_xfer(sc->sc_rd_xfer, sc->sc_rd_pipe, sc, sc->sc_rd_buf, sc->sc_params.maxsize + UIRDA_INPUT_HEADER_SIZE, USBD_SHORT_XFER_OK | USBD_NO_COPY, USBD_NO_TIMEOUT, uirda_rd_cb); err = usbd_transfer(sc->sc_rd_xfer); if (err != USBD_IN_PROGRESS) { DPRINTF(("uirda_start_read: err=%d\n", err)); return (err); } return (USBD_NORMAL_COMPLETION); }