Home | History | Annotate | Line # | Download | only in usb
umodem.c revision 1.40
      1  1.40  augustss /*	$NetBSD: umodem.c,v 1.40 2001/03/25 23:02:34 augustss Exp $	*/
      2   1.1  augustss 
      3   1.1  augustss /*
      4   1.1  augustss  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5   1.1  augustss  * All rights reserved.
      6   1.1  augustss  *
      7   1.1  augustss  * This code is derived from software contributed to The NetBSD Foundation
      8  1.28  augustss  * by Lennart Augustsson (lennart (at) augustsson.net) at
      9   1.1  augustss  * Carlstedt Research & Technology.
     10   1.1  augustss  *
     11   1.1  augustss  * Redistribution and use in source and binary forms, with or without
     12   1.1  augustss  * modification, are permitted provided that the following conditions
     13   1.1  augustss  * are met:
     14   1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     15   1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     16   1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     17   1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     18   1.1  augustss  *    documentation and/or other materials provided with the distribution.
     19   1.1  augustss  * 3. All advertising materials mentioning features or use of this software
     20   1.1  augustss  *    must display the following acknowledgement:
     21   1.1  augustss  *        This product includes software developed by the NetBSD
     22   1.1  augustss  *        Foundation, Inc. and its contributors.
     23   1.1  augustss  * 4. Neither the name of The NetBSD Foundation nor the names of its
     24   1.1  augustss  *    contributors may be used to endorse or promote products derived
     25   1.1  augustss  *    from this software without specific prior written permission.
     26   1.1  augustss  *
     27   1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     28   1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     29   1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     30   1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     31   1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     32   1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     33   1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     34   1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     35   1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     36   1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     37   1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     38   1.6  augustss  */
     39   1.6  augustss 
     40   1.6  augustss /*
     41  1.35  augustss  * Comm Class spec:  http://www.usb.org/developers/data/devclass/usbcdc10.pdf
     42  1.35  augustss  *                   http://www.usb.org/developers/data/devclass/usbcdc11.pdf
     43   1.9  augustss  */
     44   1.9  augustss 
     45   1.9  augustss /*
     46   1.9  augustss  * TODO:
     47   1.9  augustss  * - Add error recovery in various places; the big problem is what
     48   1.9  augustss  *   to do in a callback if there is an error.
     49   1.9  augustss  * - Implement a Call Device for modems without multiplexed commands.
     50   1.9  augustss  *
     51   1.1  augustss  */
     52   1.1  augustss 
     53   1.1  augustss #include <sys/param.h>
     54   1.1  augustss #include <sys/systm.h>
     55   1.1  augustss #include <sys/kernel.h>
     56   1.1  augustss #include <sys/ioctl.h>
     57   1.3  augustss #include <sys/conf.h>
     58   1.1  augustss #include <sys/tty.h>
     59   1.1  augustss #include <sys/file.h>
     60   1.1  augustss #include <sys/select.h>
     61   1.1  augustss #include <sys/proc.h>
     62   1.1  augustss #include <sys/vnode.h>
     63   1.1  augustss #include <sys/device.h>
     64   1.1  augustss #include <sys/poll.h>
     65   1.1  augustss 
     66   1.1  augustss #include <dev/usb/usb.h>
     67   1.9  augustss #include <dev/usb/usbcdc.h>
     68   1.9  augustss 
     69   1.1  augustss #include <dev/usb/usbdi.h>
     70   1.1  augustss #include <dev/usb/usbdi_util.h>
     71   1.1  augustss #include <dev/usb/usbdevs.h>
     72   1.1  augustss #include <dev/usb/usb_quirks.h>
     73   1.1  augustss 
     74   1.9  augustss #include <dev/usb/usbdevs.h>
     75  1.20  augustss #include <dev/usb/ucomvar.h>
     76   1.9  augustss 
     77  1.20  augustss #ifdef UMODEM_DEBUG
     78   1.9  augustss #define DPRINTFN(n, x)	if (umodemdebug > (n)) logprintf x
     79   1.1  augustss int	umodemdebug = 0;
     80   1.1  augustss #else
     81   1.9  augustss #define DPRINTFN(n, x)
     82   1.1  augustss #endif
     83   1.9  augustss #define DPRINTF(x) DPRINTFN(0, x)
     84   1.9  augustss 
     85  1.26  augustss /*
     86  1.26  augustss  * These are the maximum number of bytes transferred per frame.
     87  1.26  augustss  * If some really high speed devices should use this driver they
     88  1.26  augustss  * may need to be increased, but this is good enough for normal modems.
     89  1.26  augustss  */
     90  1.26  augustss #define UMODEMIBUFSIZE 64
     91  1.26  augustss #define UMODEMOBUFSIZE 256
     92  1.26  augustss 
     93   1.1  augustss struct umodem_softc {
     94  1.13  augustss 	USBBASEDEVICE		sc_dev;		/* base device */
     95   1.9  augustss 
     96   1.9  augustss 	usbd_device_handle	sc_udev;	/* USB device */
     97   1.9  augustss 
     98   1.9  augustss 	int			sc_ctl_iface_no;
     99   1.9  augustss 	usbd_interface_handle	sc_ctl_iface;	/* control interface */
    100   1.9  augustss 	int			sc_data_iface_no;
    101   1.9  augustss 	usbd_interface_handle	sc_data_iface;	/* data interface */
    102   1.9  augustss 
    103   1.9  augustss 	int			sc_cm_cap;	/* CM capabilities */
    104   1.9  augustss 	int			sc_acm_cap;	/* ACM capabilities */
    105   1.9  augustss 
    106   1.9  augustss 	int			sc_cm_over_data;
    107   1.9  augustss 
    108   1.9  augustss 	usb_cdc_line_state_t	sc_line_state;	/* current line state */
    109   1.9  augustss 	u_char			sc_dtr;		/* current DTR state */
    110  1.20  augustss 	u_char			sc_rts;		/* current RTS state */
    111  1.20  augustss 
    112  1.20  augustss 	device_ptr_t		sc_subdev;	/* ucom device */
    113   1.9  augustss 
    114   1.9  augustss 	u_char			sc_opening;	/* lock during open */
    115   1.9  augustss 	u_char			sc_dying;	/* disconnecting */
    116  1.39      kenh 
    117  1.39      kenh 	int			sc_ctl_notify;	/* Notification endpoint */
    118  1.39      kenh 	usbd_pipe_handle	sc_notify_pipe; /* Notification pipe */
    119  1.39      kenh 	usb_cdc_notification_t	sc_notify_buf;	/* Notification structure */
    120  1.39      kenh 	u_char			sc_lsr;		/* Local status register */
    121  1.39      kenh 	u_char			sc_msr;		/* Modem status register */
    122   1.1  augustss };
    123   1.1  augustss 
    124  1.29  augustss Static void	*umodem_get_desc(usbd_device_handle dev, int type, int subtype);
    125  1.29  augustss Static usbd_status umodem_set_comm_feature(struct umodem_softc *sc,
    126  1.29  augustss 					   int feature, int state);
    127  1.29  augustss Static usbd_status umodem_set_line_coding(struct umodem_softc *sc,
    128  1.29  augustss 					  usb_cdc_line_state_t *state);
    129  1.29  augustss 
    130  1.29  augustss Static void	umodem_get_caps(usbd_device_handle, int *, int *);
    131  1.29  augustss 
    132  1.29  augustss Static void	umodem_get_status(void *, int portno, u_char *lsr, u_char *msr);
    133  1.29  augustss Static void	umodem_set(void *, int, int, int);
    134  1.29  augustss Static void	umodem_dtr(struct umodem_softc *, int);
    135  1.29  augustss Static void	umodem_rts(struct umodem_softc *, int);
    136  1.29  augustss Static void	umodem_break(struct umodem_softc *, int);
    137  1.29  augustss Static void	umodem_set_line_state(struct umodem_softc *);
    138  1.29  augustss Static int	umodem_param(void *, int, struct termios *);
    139  1.29  augustss Static int	umodem_ioctl(void *, int, u_long, caddr_t, int, struct proc *);
    140  1.39      kenh Static int	umodem_open(void *, int portno);
    141  1.39      kenh Static void	umodem_close(void *, int portno);
    142  1.39      kenh Static void	umodem_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
    143  1.20  augustss 
    144  1.25  augustss Static struct ucom_methods umodem_methods = {
    145  1.20  augustss 	umodem_get_status,
    146  1.20  augustss 	umodem_set,
    147  1.20  augustss 	umodem_param,
    148  1.20  augustss 	umodem_ioctl,
    149  1.39      kenh 	umodem_open,
    150  1.39      kenh 	umodem_close,
    151  1.27  augustss 	NULL,
    152  1.27  augustss 	NULL,
    153  1.20  augustss };
    154   1.1  augustss 
    155   1.3  augustss USB_DECLARE_DRIVER(umodem);
    156   1.1  augustss 
    157   1.3  augustss USB_MATCH(umodem)
    158   1.3  augustss {
    159   1.3  augustss 	USB_MATCH_START(umodem, uaa);
    160   1.1  augustss 	usb_interface_descriptor_t *id;
    161   1.9  augustss 	int cm, acm;
    162  1.31  explorer 
    163  1.20  augustss 	if (uaa->iface == NULL)
    164   1.1  augustss 		return (UMATCH_NONE);
    165   1.9  augustss 
    166   1.1  augustss 	id = usbd_get_interface_descriptor(uaa->iface);
    167  1.20  augustss 	if (id == NULL ||
    168  1.23  augustss 	    id->bInterfaceClass != UICLASS_CDC ||
    169  1.23  augustss 	    id->bInterfaceSubClass != UISUBCLASS_ABSTRACT_CONTROL_MODEL ||
    170  1.23  augustss 	    id->bInterfaceProtocol != UIPROTO_CDC_AT)
    171   1.1  augustss 		return (UMATCH_NONE);
    172  1.31  explorer 
    173   1.9  augustss 	umodem_get_caps(uaa->device, &cm, &acm);
    174   1.9  augustss 	if (!(cm & USB_CDC_CM_DOES_CM) ||
    175   1.9  augustss 	    !(cm & USB_CDC_CM_OVER_DATA) ||
    176   1.9  augustss 	    !(acm & USB_CDC_ACM_HAS_LINE))
    177   1.9  augustss 		return (UMATCH_NONE);
    178   1.9  augustss 
    179   1.2  augustss 	return (UMATCH_IFACECLASS_IFACESUBCLASS_IFACEPROTO);
    180   1.1  augustss }
    181   1.1  augustss 
    182   1.3  augustss USB_ATTACH(umodem)
    183   1.1  augustss {
    184   1.3  augustss 	USB_ATTACH_START(umodem, sc, uaa);
    185   1.9  augustss 	usbd_device_handle dev = uaa->device;
    186   1.1  augustss 	usb_interface_descriptor_t *id;
    187   1.9  augustss 	usb_endpoint_descriptor_t *ed;
    188   1.9  augustss 	usb_cdc_cm_descriptor_t *cmd;
    189   1.1  augustss 	char devinfo[1024];
    190  1.18  augustss 	usbd_status err;
    191  1.20  augustss 	int data_ifcno;
    192   1.9  augustss 	int i;
    193  1.20  augustss 	struct ucom_attach_args uca;
    194   1.9  augustss 
    195   1.1  augustss 	usbd_devinfo(uaa->device, 0, devinfo);
    196   1.3  augustss 	USB_ATTACH_SETUP;
    197   1.9  augustss 
    198   1.9  augustss 	sc->sc_udev = dev;
    199  1.20  augustss 	sc->sc_ctl_iface = uaa->iface;
    200   1.9  augustss 
    201   1.9  augustss 	id = usbd_get_interface_descriptor(sc->sc_ctl_iface);
    202   1.3  augustss 	printf("%s: %s, iclass %d/%d\n", USBDEVNAME(sc->sc_dev),
    203   1.1  augustss 	       devinfo, id->bInterfaceClass, id->bInterfaceSubClass);
    204   1.9  augustss 	sc->sc_ctl_iface_no = id->bInterfaceNumber;
    205   1.9  augustss 
    206   1.9  augustss 	umodem_get_caps(dev, &sc->sc_cm_cap, &sc->sc_acm_cap);
    207   1.9  augustss 
    208   1.9  augustss 	/* Get the data interface no. */
    209   1.9  augustss 	cmd = umodem_get_desc(dev, UDESC_CS_INTERFACE, UDESCSUB_CDC_CM);
    210  1.18  augustss 	if (cmd == NULL) {
    211  1.20  augustss 		printf("%s: no CM descriptor\n", USBDEVNAME(sc->sc_dev));
    212   1.9  augustss 		goto bad;
    213   1.9  augustss 	}
    214  1.20  augustss 	sc->sc_data_iface_no = data_ifcno = cmd->bDataInterface;
    215   1.9  augustss 
    216   1.9  augustss 	printf("%s: data interface %d, has %sCM over data, has %sbreak\n",
    217  1.20  augustss 	       USBDEVNAME(sc->sc_dev), data_ifcno,
    218   1.9  augustss 	       sc->sc_cm_cap & USB_CDC_CM_OVER_DATA ? "" : "no ",
    219   1.9  augustss 	       sc->sc_acm_cap & USB_CDC_ACM_HAS_BREAK ? "" : "no ");
    220   1.9  augustss 
    221   1.9  augustss 	/* Get the data interface too. */
    222   1.9  augustss 	for (i = 0; i < uaa->nifaces; i++) {
    223  1.20  augustss 		if (uaa->ifaces[i] != NULL) {
    224   1.9  augustss 			id = usbd_get_interface_descriptor(uaa->ifaces[i]);
    225  1.20  augustss 			if (id != NULL && id->bInterfaceNumber == data_ifcno) {
    226   1.9  augustss 				sc->sc_data_iface = uaa->ifaces[i];
    227  1.20  augustss 				uaa->ifaces[i] = NULL;
    228   1.9  augustss 			}
    229   1.9  augustss 		}
    230   1.9  augustss 	}
    231  1.18  augustss 	if (sc->sc_data_iface == NULL) {
    232   1.9  augustss 		printf("%s: no data interface\n", USBDEVNAME(sc->sc_dev));
    233   1.9  augustss 		goto bad;
    234   1.9  augustss 	}
    235   1.9  augustss 
    236   1.9  augustss 	/*
    237   1.9  augustss 	 * Find the bulk endpoints.
    238   1.9  augustss 	 * Iterate over all endpoints in the data interface and take note.
    239   1.9  augustss 	 */
    240  1.20  augustss 	uca.bulkin = uca.bulkout = -1;
    241   1.9  augustss 
    242   1.9  augustss 	id = usbd_get_interface_descriptor(sc->sc_data_iface);
    243   1.9  augustss 	for (i = 0; i < id->bNumEndpoints; i++) {
    244   1.9  augustss 		ed = usbd_interface2endpoint_descriptor(sc->sc_data_iface, i);
    245  1.18  augustss 		if (ed == NULL) {
    246   1.9  augustss 			printf("%s: no endpoint descriptor for %d\n",
    247   1.9  augustss 				USBDEVNAME(sc->sc_dev), i);
    248   1.9  augustss 			goto bad;
    249   1.9  augustss 		}
    250  1.12  augustss 		if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
    251   1.9  augustss 		    (ed->bmAttributes & UE_XFERTYPE) == UE_BULK) {
    252  1.20  augustss                         uca.bulkin = ed->bEndpointAddress;
    253  1.12  augustss                 } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
    254   1.9  augustss 			   (ed->bmAttributes & UE_XFERTYPE) == UE_BULK) {
    255  1.20  augustss                         uca.bulkout = ed->bEndpointAddress;
    256   1.9  augustss                 }
    257   1.9  augustss         }
    258   1.9  augustss 
    259  1.20  augustss 	if (uca.bulkin == -1) {
    260  1.20  augustss 		printf("%s: Could not find data bulk in\n",
    261  1.20  augustss 		       USBDEVNAME(sc->sc_dev));
    262   1.9  augustss 		goto bad;
    263   1.9  augustss 	}
    264  1.20  augustss 	if (uca.bulkout == -1) {
    265  1.20  augustss 		printf("%s: Could not find data bulk out\n",
    266  1.20  augustss 			USBDEVNAME(sc->sc_dev));
    267   1.9  augustss 		goto bad;
    268   1.9  augustss 	}
    269   1.9  augustss 
    270  1.36  explorer 	if (usbd_get_quirks(sc->sc_udev)->uq_flags & UQ_ASSUME_CM_OVER_DATA) {
    271  1.36  explorer 		sc->sc_cm_over_data = 1;
    272  1.36  explorer 	} else {
    273  1.36  explorer 		if (sc->sc_cm_cap & USB_CDC_CM_OVER_DATA) {
    274  1.36  explorer 			if (sc->sc_acm_cap & USB_CDC_ACM_HAS_FEATURE)
    275  1.36  explorer 				err = umodem_set_comm_feature(sc,
    276  1.36  explorer 				    UCDC_ABSTRACT_STATE, UCDC_DATA_MULTIPLEXED);
    277  1.36  explorer 			else
    278  1.36  explorer 				err = 0;
    279  1.36  explorer 			if (err) {
    280  1.36  explorer 				printf("%s: could not set data multiplex mode\n",
    281  1.36  explorer 				       USBDEVNAME(sc->sc_dev));
    282  1.36  explorer 				goto bad;
    283  1.36  explorer 			}
    284  1.36  explorer 			sc->sc_cm_over_data = 1;
    285  1.34  augustss 		}
    286   1.9  augustss 	}
    287  1.39      kenh 
    288  1.39      kenh 	/*
    289  1.39      kenh 	 * The standard allows for notification messages (to indicate things
    290  1.39      kenh 	 * like a modem hangup) to come in via an interrupt endpoint
    291  1.40  augustss 	 * off of the control interface.  Iterate over the endpoints on
    292  1.39      kenh 	 * the control interface and see if there are any interrupt
    293  1.39      kenh 	 * endpoints; if there are, then register it.
    294  1.39      kenh 	 */
    295  1.39      kenh 
    296  1.39      kenh 	sc->sc_ctl_notify = -1;
    297  1.39      kenh 	sc->sc_notify_pipe = NULL;
    298  1.39      kenh 
    299  1.39      kenh 	for (i = 0; i < id->bNumEndpoints; i++) {
    300  1.39      kenh 		ed = usbd_interface2endpoint_descriptor(sc->sc_ctl_iface, i);
    301  1.39      kenh 		if (ed == NULL)
    302  1.39      kenh 			continue;
    303  1.39      kenh 
    304  1.39      kenh 		if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
    305  1.39      kenh 		    (ed->bmAttributes & UE_XFERTYPE) == UE_INTERRUPT) {
    306  1.39      kenh 			printf("%s: status change notification available\n",
    307  1.39      kenh 			       USBDEVNAME(sc->sc_dev));
    308  1.39      kenh 			sc->sc_ctl_notify = ed->bEndpointAddress;
    309  1.39      kenh 		}
    310  1.39      kenh 	}
    311  1.39      kenh 
    312  1.20  augustss 	sc->sc_dtr = -1;
    313   1.9  augustss 
    314  1.20  augustss 	uca.portno = UCOM_UNK_PORTNO;
    315  1.20  augustss 	/* bulkin, bulkout set above */
    316  1.26  augustss 	uca.ibufsize = UMODEMIBUFSIZE;
    317  1.26  augustss 	uca.obufsize = UMODEMOBUFSIZE;
    318  1.27  augustss 	uca.ibufsizepad = UMODEMIBUFSIZE;
    319  1.30  augustss 	uca.opkthdrlen = 0;
    320  1.20  augustss 	uca.device = sc->sc_udev;
    321  1.20  augustss 	uca.iface = sc->sc_data_iface;
    322  1.20  augustss 	uca.methods = &umodem_methods;
    323  1.20  augustss 	uca.arg = sc;
    324  1.38  augustss 	uca.info = NULL;
    325  1.20  augustss 
    326  1.37  augustss 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
    327  1.37  augustss 			   USBDEV(sc->sc_dev));
    328  1.37  augustss 
    329  1.20  augustss 	DPRINTF(("umodem_attach: sc=%p\n", sc));
    330  1.20  augustss 	sc->sc_subdev = config_found_sm(self, &uca, ucomprint, ucomsubmatch);
    331  1.21  augustss 
    332   1.3  augustss 	USB_ATTACH_SUCCESS_RETURN;
    333   1.9  augustss 
    334   1.9  augustss  bad:
    335   1.9  augustss 	sc->sc_dying = 1;
    336   1.9  augustss 	USB_ATTACH_ERROR_RETURN;
    337   1.1  augustss }
    338   1.3  augustss 
    339  1.39      kenh Static int
    340  1.39      kenh umodem_open(void *addr, int portno)
    341  1.39      kenh {
    342  1.39      kenh 	struct umodem_softc *sc = addr;
    343  1.39      kenh 	int err;
    344  1.39      kenh 
    345  1.39      kenh 	DPRINTF(("umodem_open: sc=%p\n", sc));
    346  1.39      kenh 
    347  1.39      kenh 	if (sc->sc_ctl_notify != -1 && sc->sc_notify_pipe == NULL) {
    348  1.39      kenh 		err = usbd_open_pipe_intr(sc->sc_ctl_iface, sc->sc_ctl_notify,
    349  1.39      kenh 		    USBD_SHORT_XFER_OK, &sc->sc_notify_pipe, sc,
    350  1.39      kenh 		    &sc->sc_notify_buf, sizeof(sc->sc_notify_buf),
    351  1.39      kenh 		    umodem_intr, USBD_DEFAULT_INTERVAL);
    352  1.39      kenh 
    353  1.39      kenh 		if (err) {
    354  1.39      kenh 			DPRINTF(("Failed to establish notify pipe: %s\n",
    355  1.39      kenh 				usbd_errstr(err)));
    356  1.39      kenh 			return EIO;
    357  1.39      kenh 		}
    358  1.39      kenh 	}
    359  1.39      kenh 
    360  1.39      kenh 	return 0;
    361  1.39      kenh }
    362  1.39      kenh 
    363  1.39      kenh Static void
    364  1.39      kenh umodem_close(void *addr, int portno)
    365  1.39      kenh {
    366  1.39      kenh 	struct umodem_softc *sc = addr;
    367  1.39      kenh 	int err;
    368  1.39      kenh 
    369  1.39      kenh 	DPRINTF(("umodem_close: sc=%p\n", sc));
    370  1.39      kenh 
    371  1.39      kenh 	if (sc->sc_notify_pipe != NULL) {
    372  1.39      kenh 		err = usbd_abort_pipe(sc->sc_notify_pipe);
    373  1.39      kenh 		if (err)
    374  1.39      kenh 			printf("%s: abort notify pipe failed: %s\n",
    375  1.39      kenh 			    USBDEVNAME(sc->sc_dev), usbd_errstr(err));
    376  1.39      kenh 		err = usbd_close_pipe(sc->sc_notify_pipe);
    377  1.39      kenh 		if (err)
    378  1.39      kenh 			printf("%s: close notify pipe failed: %s\n",
    379  1.39      kenh 			    USBDEVNAME(sc->sc_dev), usbd_errstr(err));
    380  1.39      kenh 		sc->sc_notify_pipe = NULL;
    381  1.39      kenh 	}
    382  1.39      kenh }
    383  1.39      kenh 
    384  1.39      kenh Static void
    385  1.39      kenh umodem_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
    386  1.39      kenh {
    387  1.39      kenh 	struct umodem_softc *sc = priv;
    388  1.39      kenh 	u_char mstatus;
    389  1.39      kenh 
    390  1.39      kenh 	if (sc->sc_dying)
    391  1.39      kenh 		return;
    392  1.39      kenh 
    393  1.39      kenh 	if (status != USBD_NORMAL_COMPLETION) {
    394  1.39      kenh 		if (status == USBD_NOT_STARTED || status == USBD_CANCELLED)
    395  1.39      kenh 			return;
    396  1.39      kenh 		printf("%s: abnormal status: %s\n", USBDEVNAME(sc->sc_dev),
    397  1.39      kenh 		       usbd_errstr(status));
    398  1.39      kenh 		return;
    399  1.39      kenh 	}
    400  1.39      kenh 
    401  1.40  augustss 	if (sc->sc_notify_buf.bmRequestType != UCDC_NOTIFICATION) {
    402  1.39      kenh 		DPRINTF(("%s: unknown message type (%02x) on notify pipe\n",
    403  1.39      kenh 			 USBDEVNAME(sc->sc_dev),
    404  1.39      kenh 			 sc->sc_notify_buf.bmRequestType));
    405  1.40  augustss 		return;
    406  1.40  augustss 	}
    407  1.39      kenh 
    408  1.40  augustss 	switch (sc->sc_notify_buf.bNotification) {
    409  1.40  augustss 	case UCDC_N_SERIAL_STATE:
    410  1.40  augustss 		/*
    411  1.40  augustss 		 * Set the serial state in ucom driver based on
    412  1.40  augustss 		 * the bits from the notify message
    413  1.40  augustss 		 */
    414  1.40  augustss 		if (UGETW(sc->sc_notify_buf.wLength) != 2) {
    415  1.40  augustss 			printf("%s: Invalid notification length! (%d)\n",
    416  1.40  augustss 			       USBDEVNAME(sc->sc_dev),
    417  1.40  augustss 			       UGETW(sc->sc_notify_buf.wLength));
    418  1.40  augustss 			break;
    419  1.40  augustss 		}
    420  1.40  augustss 		DPRINTF(("%s: notify bytes = %02x%02x\n",
    421  1.40  augustss 			 USBDEVNAME(sc->sc_dev),
    422  1.40  augustss 			 sc->sc_notify_buf.data[0],
    423  1.40  augustss 			 sc->sc_notify_buf.data[1]));
    424  1.40  augustss 		/* Currently, lsr is always zero. */
    425  1.40  augustss 		sc->sc_lsr = sc->sc_msr = 0;
    426  1.40  augustss 		mstatus = sc->sc_notify_buf.data[0];
    427  1.40  augustss 
    428  1.40  augustss 		if (ISSET(mstatus, UCDC_N_SERIAL_RI))
    429  1.40  augustss 			sc->sc_msr |= UMSR_RI;
    430  1.40  augustss 		if (ISSET(mstatus, UCDC_N_SERIAL_DSR))
    431  1.40  augustss 			sc->sc_msr |= UMSR_DSR;
    432  1.40  augustss 		if (ISSET(mstatus, UCDC_N_SERIAL_DCD))
    433  1.40  augustss 			sc->sc_msr |= UMSR_DCD;
    434  1.40  augustss 		ucom_status_change((struct ucom_softc *)sc->sc_subdev);
    435  1.40  augustss 		break;
    436  1.40  augustss 	default:
    437  1.40  augustss 		DPRINTF(("%s: unknown notify message: %02x\n",
    438  1.40  augustss 			 USBDEVNAME(sc->sc_dev),
    439  1.40  augustss 			 sc->sc_notify_buf.bNotification));
    440  1.40  augustss 		break;
    441  1.40  augustss 	}
    442  1.39      kenh }
    443  1.39      kenh 
    444   1.9  augustss void
    445  1.29  augustss umodem_get_caps(usbd_device_handle dev, int *cm, int *acm)
    446   1.9  augustss {
    447   1.9  augustss 	usb_cdc_cm_descriptor_t *cmd;
    448   1.9  augustss 	usb_cdc_acm_descriptor_t *cad;
    449   1.9  augustss 
    450   1.9  augustss 	*cm = *acm = 0;
    451   1.9  augustss 
    452   1.9  augustss 	cmd = umodem_get_desc(dev, UDESC_CS_INTERFACE, UDESCSUB_CDC_CM);
    453  1.20  augustss 	if (cmd == NULL) {
    454   1.9  augustss 		DPRINTF(("umodem_get_desc: no CM desc\n"));
    455   1.9  augustss 		return;
    456   1.9  augustss 	}
    457   1.9  augustss 	*cm = cmd->bmCapabilities;
    458   1.9  augustss 
    459   1.9  augustss 	cad = umodem_get_desc(dev, UDESC_CS_INTERFACE, UDESCSUB_CDC_ACM);
    460  1.20  augustss 	if (cad == NULL) {
    461   1.9  augustss 		DPRINTF(("umodem_get_desc: no ACM desc\n"));
    462   1.9  augustss 		return;
    463   1.9  augustss 	}
    464   1.9  augustss 	*acm = cad->bmCapabilities;
    465   1.9  augustss }
    466   1.9  augustss 
    467   1.9  augustss void
    468  1.29  augustss umodem_get_status(void *addr, int portno, u_char *lsr, u_char *msr)
    469  1.20  augustss {
    470  1.39      kenh 	struct umodem_softc *sc = addr;
    471  1.39      kenh 
    472  1.20  augustss 	DPRINTF(("umodem_get_status:\n"));
    473  1.20  augustss 
    474  1.20  augustss 	if (lsr != NULL)
    475  1.39      kenh 		*lsr = sc->sc_lsr;
    476  1.20  augustss 	if (msr != NULL)
    477  1.39      kenh 		*msr = sc->sc_msr;
    478   1.9  augustss }
    479   1.9  augustss 
    480   1.9  augustss int
    481  1.29  augustss umodem_param(void *addr, int portno, struct termios *t)
    482   1.9  augustss {
    483  1.20  augustss 	struct umodem_softc *sc = addr;
    484  1.20  augustss 	usbd_status err;
    485   1.9  augustss 	usb_cdc_line_state_t ls;
    486   1.9  augustss 
    487  1.20  augustss 	DPRINTF(("umodem_param: sc=%p\n", sc));
    488   1.9  augustss 
    489   1.9  augustss 	USETDW(ls.dwDTERate, t->c_ospeed);
    490   1.9  augustss 	if (ISSET(t->c_cflag, CSTOPB))
    491   1.9  augustss 		ls.bCharFormat = UCDC_STOP_BIT_2;
    492   1.9  augustss 	else
    493   1.9  augustss 		ls.bCharFormat = UCDC_STOP_BIT_1;
    494   1.9  augustss 	if (ISSET(t->c_cflag, PARENB)) {
    495   1.9  augustss 		if (ISSET(t->c_cflag, PARODD))
    496   1.9  augustss 			ls.bParityType = UCDC_PARITY_ODD;
    497   1.9  augustss 		else
    498   1.9  augustss 			ls.bParityType = UCDC_PARITY_EVEN;
    499   1.9  augustss 	} else
    500   1.9  augustss 		ls.bParityType = UCDC_PARITY_NONE;
    501   1.9  augustss 	switch (ISSET(t->c_cflag, CSIZE)) {
    502   1.9  augustss 	case CS5:
    503   1.9  augustss 		ls.bDataBits = 5;
    504   1.9  augustss 		break;
    505   1.9  augustss 	case CS6:
    506   1.9  augustss 		ls.bDataBits = 6;
    507   1.9  augustss 		break;
    508   1.9  augustss 	case CS7:
    509   1.9  augustss 		ls.bDataBits = 7;
    510   1.9  augustss 		break;
    511   1.9  augustss 	case CS8:
    512   1.9  augustss 		ls.bDataBits = 8;
    513   1.9  augustss 		break;
    514   1.9  augustss 	}
    515   1.9  augustss 
    516  1.20  augustss 	err = umodem_set_line_coding(sc, &ls);
    517  1.20  augustss 	if (err) {
    518  1.20  augustss 		DPRINTF(("umodem_param: err=%s\n", usbd_errstr(err)));
    519  1.20  augustss 		return (1);
    520   1.9  augustss 	}
    521   1.9  augustss 	return (0);
    522   1.9  augustss }
    523   1.9  augustss 
    524   1.9  augustss int
    525  1.29  augustss umodem_ioctl(void *addr, int portno, u_long cmd, caddr_t data, int flag,
    526  1.29  augustss 	     struct proc *p)
    527   1.9  augustss {
    528  1.20  augustss 	struct umodem_softc *sc = addr;
    529  1.24  augustss 	int error = 0;
    530   1.9  augustss 
    531   1.9  augustss 	if (sc->sc_dying)
    532   1.9  augustss 		return (EIO);
    533   1.9  augustss 
    534   1.9  augustss 	DPRINTF(("umodemioctl: cmd=0x%08lx\n", cmd));
    535   1.9  augustss 
    536   1.9  augustss 	switch (cmd) {
    537   1.9  augustss 	case USB_GET_CM_OVER_DATA:
    538   1.9  augustss 		*(int *)data = sc->sc_cm_over_data;
    539   1.9  augustss 		break;
    540   1.9  augustss 
    541   1.9  augustss 	case USB_SET_CM_OVER_DATA:
    542   1.9  augustss 		if (*(int *)data != sc->sc_cm_over_data) {
    543   1.9  augustss 			/* XXX change it */
    544   1.9  augustss 		}
    545   1.9  augustss 		break;
    546   1.9  augustss 
    547   1.9  augustss 	default:
    548   1.9  augustss 		DPRINTF(("umodemioctl: unknown\n"));
    549   1.9  augustss 		error = ENOTTY;
    550   1.9  augustss 		break;
    551   1.9  augustss 	}
    552   1.9  augustss 
    553   1.9  augustss 	return (error);
    554   1.9  augustss }
    555   1.9  augustss 
    556   1.9  augustss void
    557  1.29  augustss umodem_dtr(struct umodem_softc *sc, int onoff)
    558   1.9  augustss {
    559  1.20  augustss 	DPRINTF(("umodem_modem: onoff=%d\n", onoff));
    560   1.9  augustss 
    561  1.20  augustss 	if (sc->sc_dtr == onoff)
    562  1.20  augustss 		return;
    563  1.20  augustss 	sc->sc_dtr = onoff;
    564  1.20  augustss 
    565  1.20  augustss 	umodem_set_line_state(sc);
    566   1.9  augustss }
    567   1.9  augustss 
    568   1.9  augustss void
    569  1.29  augustss umodem_rts(struct umodem_softc *sc, int onoff)
    570   1.9  augustss {
    571   1.9  augustss 	DPRINTF(("umodem_modem: onoff=%d\n", onoff));
    572   1.9  augustss 
    573  1.20  augustss 	if (sc->sc_rts == onoff)
    574   1.9  augustss 		return;
    575  1.20  augustss 	sc->sc_rts = onoff;
    576  1.20  augustss 
    577  1.20  augustss 	umodem_set_line_state(sc);
    578  1.20  augustss }
    579   1.9  augustss 
    580  1.20  augustss void
    581  1.29  augustss umodem_set_line_state(struct umodem_softc *sc)
    582  1.20  augustss {
    583  1.20  augustss 	usb_device_request_t req;
    584  1.20  augustss 	int ls;
    585  1.20  augustss 
    586  1.20  augustss 	ls = (sc->sc_dtr ? UCDC_LINE_DTR : 0) |
    587  1.20  augustss 	     (sc->sc_rts ? UCDC_LINE_RTS : 0);
    588   1.9  augustss 	req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
    589   1.9  augustss 	req.bRequest = UCDC_SET_CONTROL_LINE_STATE;
    590  1.20  augustss 	USETW(req.wValue, ls);
    591   1.9  augustss 	USETW(req.wIndex, sc->sc_ctl_iface_no);
    592   1.9  augustss 	USETW(req.wLength, 0);
    593   1.9  augustss 
    594   1.9  augustss 	(void)usbd_do_request(sc->sc_udev, &req, 0);
    595   1.9  augustss 
    596   1.9  augustss }
    597   1.9  augustss 
    598   1.9  augustss void
    599  1.29  augustss umodem_break(struct umodem_softc *sc, int onoff)
    600   1.9  augustss {
    601   1.9  augustss 	usb_device_request_t req;
    602   1.9  augustss 
    603   1.9  augustss 	DPRINTF(("umodem_break: onoff=%d\n", onoff));
    604   1.9  augustss 
    605   1.9  augustss 	if (!(sc->sc_acm_cap & USB_CDC_ACM_HAS_BREAK))
    606   1.9  augustss 		return;
    607   1.9  augustss 
    608   1.9  augustss 	req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
    609   1.9  augustss 	req.bRequest = UCDC_SEND_BREAK;
    610   1.9  augustss 	USETW(req.wValue, onoff ? UCDC_BREAK_ON : UCDC_BREAK_OFF);
    611   1.9  augustss 	USETW(req.wIndex, sc->sc_ctl_iface_no);
    612   1.9  augustss 	USETW(req.wLength, 0);
    613   1.9  augustss 
    614   1.9  augustss 	(void)usbd_do_request(sc->sc_udev, &req, 0);
    615   1.9  augustss }
    616   1.9  augustss 
    617  1.20  augustss void
    618  1.29  augustss umodem_set(void *addr, int portno, int reg, int onoff)
    619  1.20  augustss {
    620  1.20  augustss 	struct umodem_softc *sc = addr;
    621  1.20  augustss 
    622  1.20  augustss 	switch (reg) {
    623  1.20  augustss 	case UCOM_SET_DTR:
    624  1.20  augustss 		umodem_dtr(sc, onoff);
    625  1.20  augustss 		break;
    626  1.20  augustss 	case UCOM_SET_RTS:
    627  1.20  augustss 		umodem_rts(sc, onoff);
    628  1.20  augustss 		break;
    629  1.20  augustss 	case UCOM_SET_BREAK:
    630  1.20  augustss 		umodem_break(sc, onoff);
    631  1.20  augustss 		break;
    632  1.20  augustss 	default:
    633  1.20  augustss 		break;
    634  1.20  augustss 	}
    635  1.20  augustss }
    636  1.20  augustss 
    637  1.20  augustss usbd_status
    638  1.29  augustss umodem_set_line_coding(struct umodem_softc *sc, usb_cdc_line_state_t *state)
    639  1.20  augustss {
    640  1.20  augustss 	usb_device_request_t req;
    641  1.20  augustss 	usbd_status err;
    642  1.20  augustss 
    643  1.20  augustss 	DPRINTF(("umodem_set_line_coding: rate=%d fmt=%d parity=%d bits=%d\n",
    644  1.20  augustss 		 UGETDW(state->dwDTERate), state->bCharFormat,
    645  1.20  augustss 		 state->bParityType, state->bDataBits));
    646  1.20  augustss 
    647  1.20  augustss 	if (memcmp(state, &sc->sc_line_state, UCDC_LINE_STATE_LENGTH) == 0) {
    648  1.20  augustss 		DPRINTF(("umodem_set_line_coding: already set\n"));
    649  1.20  augustss 		return (USBD_NORMAL_COMPLETION);
    650  1.20  augustss 	}
    651  1.20  augustss 
    652  1.20  augustss 	req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
    653  1.20  augustss 	req.bRequest = UCDC_SET_LINE_CODING;
    654  1.20  augustss 	USETW(req.wValue, 0);
    655  1.20  augustss 	USETW(req.wIndex, sc->sc_ctl_iface_no);
    656  1.20  augustss 	USETW(req.wLength, UCDC_LINE_STATE_LENGTH);
    657  1.20  augustss 
    658  1.20  augustss 	err = usbd_do_request(sc->sc_udev, &req, state);
    659  1.20  augustss 	if (err) {
    660  1.20  augustss 		DPRINTF(("umodem_set_line_coding: failed, err=%s\n",
    661  1.20  augustss 			 usbd_errstr(err)));
    662  1.20  augustss 		return (err);
    663  1.20  augustss 	}
    664  1.20  augustss 
    665  1.20  augustss 	sc->sc_line_state = *state;
    666  1.20  augustss 
    667  1.20  augustss 	return (USBD_NORMAL_COMPLETION);
    668  1.20  augustss }
    669  1.20  augustss 
    670   1.9  augustss void *
    671  1.29  augustss umodem_get_desc(usbd_device_handle dev, int type, int subtype)
    672   1.9  augustss {
    673   1.9  augustss 	usb_descriptor_t *desc;
    674   1.9  augustss 	usb_config_descriptor_t *cd = usbd_get_config_descriptor(dev);
    675   1.9  augustss         uByte *p = (uByte *)cd;
    676   1.9  augustss         uByte *end = p + UGETW(cd->wTotalLength);
    677   1.9  augustss 
    678   1.9  augustss 	while (p < end) {
    679   1.9  augustss 		desc = (usb_descriptor_t *)p;
    680   1.9  augustss 		if (desc->bDescriptorType == type &&
    681   1.9  augustss 		    desc->bDescriptorSubtype == subtype)
    682   1.9  augustss 			return (desc);
    683   1.9  augustss 		p += desc->bLength;
    684   1.9  augustss 	}
    685   1.9  augustss 
    686   1.9  augustss 	return (0);
    687   1.9  augustss }
    688   1.9  augustss 
    689   1.9  augustss usbd_status
    690  1.29  augustss umodem_set_comm_feature(struct umodem_softc *sc, int feature, int state)
    691   1.9  augustss {
    692   1.9  augustss 	usb_device_request_t req;
    693  1.18  augustss 	usbd_status err;
    694   1.9  augustss 	usb_cdc_abstract_state_t ast;
    695   1.9  augustss 
    696  1.20  augustss 	DPRINTF(("umodem_set_comm_feature: feature=%d state=%d\n", feature,
    697  1.20  augustss 		 state));
    698  1.20  augustss 
    699   1.9  augustss 	req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
    700   1.9  augustss 	req.bRequest = UCDC_SET_COMM_FEATURE;
    701   1.9  augustss 	USETW(req.wValue, feature);
    702   1.9  augustss 	USETW(req.wIndex, sc->sc_ctl_iface_no);
    703   1.9  augustss 	USETW(req.wLength, UCDC_ABSTRACT_STATE_LENGTH);
    704   1.9  augustss 	USETW(ast.wState, state);
    705   1.9  augustss 
    706  1.18  augustss 	err = usbd_do_request(sc->sc_udev, &req, &ast);
    707  1.18  augustss 	if (err) {
    708  1.20  augustss 		DPRINTF(("umodem_set_comm_feature: feature=%d, err=%s\n",
    709  1.20  augustss 			 feature, usbd_errstr(err)));
    710  1.18  augustss 		return (err);
    711   1.9  augustss 	}
    712   1.9  augustss 
    713   1.9  augustss 	return (USBD_NORMAL_COMPLETION);
    714   1.9  augustss }
    715   1.9  augustss 
    716   1.9  augustss int
    717  1.29  augustss umodem_activate(device_ptr_t self, enum devact act)
    718   1.9  augustss {
    719   1.9  augustss 	struct umodem_softc *sc = (struct umodem_softc *)self;
    720  1.20  augustss 	int rv = 0;
    721   1.9  augustss 
    722   1.9  augustss 	switch (act) {
    723   1.9  augustss 	case DVACT_ACTIVATE:
    724   1.9  augustss 		return (EOPNOTSUPP);
    725   1.9  augustss 		break;
    726   1.9  augustss 
    727   1.9  augustss 	case DVACT_DEACTIVATE:
    728   1.9  augustss 		sc->sc_dying = 1;
    729  1.20  augustss 		if (sc->sc_subdev)
    730  1.20  augustss 			rv = config_deactivate(sc->sc_subdev);
    731   1.9  augustss 		break;
    732   1.9  augustss 	}
    733  1.20  augustss 	return (rv);
    734   1.9  augustss }
    735   1.9  augustss 
    736  1.21  augustss USB_DETACH(umodem)
    737   1.9  augustss {
    738  1.21  augustss 	USB_DETACH_START(umodem, sc);
    739  1.20  augustss 	int rv = 0;
    740   1.9  augustss 
    741  1.20  augustss 	DPRINTF(("umodem_detach: sc=%p flags=%d\n", sc, flags));
    742   1.9  augustss 
    743   1.9  augustss 	sc->sc_dying = 1;
    744   1.9  augustss 
    745  1.20  augustss 	if (sc->sc_subdev != NULL)
    746  1.20  augustss 		rv = config_detach(sc->sc_subdev, flags);
    747  1.21  augustss 
    748  1.21  augustss 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
    749  1.21  augustss 			   USBDEV(sc->sc_dev));
    750   1.9  augustss 
    751  1.20  augustss 	return (rv);
    752   1.9  augustss }
    753