Home | History | Annotate | Line # | Download | only in usb
umodem.c revision 1.29.2.1
      1  1.29.2.1  augustss /*	$NetBSD: umodem.c,v 1.29.2.1 2000/09/04 17:53:14 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.9  augustss  * Comm Class spec: http://www.usb.org/developers/data/usbcdc11.pdf
     42       1.9  augustss  */
     43       1.9  augustss 
     44       1.9  augustss /*
     45       1.9  augustss  * TODO:
     46       1.9  augustss  * - Add error recovery in various places; the big problem is what
     47       1.9  augustss  *   to do in a callback if there is an error.
     48       1.9  augustss  * - Implement a Call Device for modems without multiplexed commands.
     49       1.9  augustss  *
     50       1.1  augustss  */
     51       1.1  augustss 
     52       1.1  augustss #include <sys/param.h>
     53       1.1  augustss #include <sys/systm.h>
     54       1.1  augustss #include <sys/kernel.h>
     55       1.1  augustss #include <sys/ioctl.h>
     56       1.3  augustss #include <sys/conf.h>
     57       1.1  augustss #include <sys/tty.h>
     58       1.1  augustss #include <sys/file.h>
     59       1.1  augustss #include <sys/select.h>
     60       1.1  augustss #include <sys/proc.h>
     61       1.1  augustss #include <sys/vnode.h>
     62       1.1  augustss #include <sys/device.h>
     63       1.1  augustss #include <sys/poll.h>
     64       1.1  augustss 
     65       1.1  augustss #include <dev/usb/usb.h>
     66       1.9  augustss #include <dev/usb/usbcdc.h>
     67       1.9  augustss 
     68       1.1  augustss #include <dev/usb/usbdi.h>
     69       1.1  augustss #include <dev/usb/usbdi_util.h>
     70       1.1  augustss #include <dev/usb/usbdevs.h>
     71       1.1  augustss #include <dev/usb/usb_quirks.h>
     72       1.1  augustss 
     73       1.9  augustss #include <dev/usb/usbdevs.h>
     74      1.20  augustss #include <dev/usb/ucomvar.h>
     75       1.9  augustss 
     76      1.20  augustss #ifdef UMODEM_DEBUG
     77       1.9  augustss #define DPRINTFN(n, x)	if (umodemdebug > (n)) logprintf x
     78       1.1  augustss int	umodemdebug = 0;
     79       1.1  augustss #else
     80       1.9  augustss #define DPRINTFN(n, x)
     81       1.1  augustss #endif
     82       1.9  augustss #define DPRINTF(x) DPRINTFN(0, x)
     83       1.9  augustss 
     84      1.26  augustss /*
     85      1.26  augustss  * These are the maximum number of bytes transferred per frame.
     86      1.26  augustss  * If some really high speed devices should use this driver they
     87      1.26  augustss  * may need to be increased, but this is good enough for normal modems.
     88      1.26  augustss  */
     89      1.26  augustss #define UMODEMIBUFSIZE 64
     90      1.26  augustss #define UMODEMOBUFSIZE 256
     91      1.26  augustss 
     92       1.1  augustss struct umodem_softc {
     93      1.13  augustss 	USBBASEDEVICE		sc_dev;		/* base device */
     94       1.9  augustss 
     95       1.9  augustss 	usbd_device_handle	sc_udev;	/* USB device */
     96       1.9  augustss 
     97       1.9  augustss 	int			sc_ctl_iface_no;
     98       1.9  augustss 	usbd_interface_handle	sc_ctl_iface;	/* control interface */
     99       1.9  augustss 	int			sc_data_iface_no;
    100       1.9  augustss 	usbd_interface_handle	sc_data_iface;	/* data interface */
    101       1.9  augustss 
    102       1.9  augustss 	int			sc_cm_cap;	/* CM capabilities */
    103       1.9  augustss 	int			sc_acm_cap;	/* ACM capabilities */
    104       1.9  augustss 
    105       1.9  augustss 	int			sc_cm_over_data;
    106       1.9  augustss 
    107       1.9  augustss 	usb_cdc_line_state_t	sc_line_state;	/* current line state */
    108       1.9  augustss 	u_char			sc_dtr;		/* current DTR state */
    109      1.20  augustss 	u_char			sc_rts;		/* current RTS state */
    110      1.20  augustss 
    111      1.20  augustss 	device_ptr_t		sc_subdev;	/* ucom device */
    112       1.9  augustss 
    113       1.9  augustss 	u_char			sc_opening;	/* lock during open */
    114       1.9  augustss 	u_char			sc_dying;	/* disconnecting */
    115       1.1  augustss };
    116       1.1  augustss 
    117      1.29  augustss Static void	*umodem_get_desc(usbd_device_handle dev, int type, int subtype);
    118      1.29  augustss Static usbd_status umodem_set_comm_feature(struct umodem_softc *sc,
    119      1.29  augustss 					   int feature, int state);
    120      1.29  augustss Static usbd_status umodem_set_line_coding(struct umodem_softc *sc,
    121      1.29  augustss 					  usb_cdc_line_state_t *state);
    122      1.29  augustss 
    123      1.29  augustss Static void	umodem_get_caps(usbd_device_handle, int *, int *);
    124      1.29  augustss 
    125      1.29  augustss Static void	umodem_get_status(void *, int portno, u_char *lsr, u_char *msr);
    126      1.29  augustss Static void	umodem_set(void *, int, int, int);
    127      1.29  augustss Static void	umodem_dtr(struct umodem_softc *, int);
    128      1.29  augustss Static void	umodem_rts(struct umodem_softc *, int);
    129      1.29  augustss Static void	umodem_break(struct umodem_softc *, int);
    130      1.29  augustss Static void	umodem_set_line_state(struct umodem_softc *);
    131      1.29  augustss Static int	umodem_param(void *, int, struct termios *);
    132      1.29  augustss Static int	umodem_ioctl(void *, int, u_long, caddr_t, int, struct proc *);
    133      1.20  augustss 
    134      1.25  augustss Static struct ucom_methods umodem_methods = {
    135      1.20  augustss 	umodem_get_status,
    136      1.20  augustss 	umodem_set,
    137      1.20  augustss 	umodem_param,
    138      1.20  augustss 	umodem_ioctl,
    139      1.22  augustss 	NULL,
    140      1.22  augustss 	NULL,
    141      1.27  augustss 	NULL,
    142      1.27  augustss 	NULL,
    143      1.20  augustss };
    144       1.1  augustss 
    145       1.3  augustss USB_DECLARE_DRIVER(umodem);
    146       1.1  augustss 
    147       1.3  augustss USB_MATCH(umodem)
    148       1.3  augustss {
    149       1.3  augustss 	USB_MATCH_START(umodem, uaa);
    150       1.1  augustss 	usb_interface_descriptor_t *id;
    151       1.9  augustss 	int cm, acm;
    152       1.1  augustss 
    153      1.20  augustss 	if (uaa->iface == NULL)
    154       1.1  augustss 		return (UMATCH_NONE);
    155       1.9  augustss 
    156       1.1  augustss 	id = usbd_get_interface_descriptor(uaa->iface);
    157      1.20  augustss 	if (id == NULL ||
    158      1.23  augustss 	    id->bInterfaceClass != UICLASS_CDC ||
    159      1.23  augustss 	    id->bInterfaceSubClass != UISUBCLASS_ABSTRACT_CONTROL_MODEL ||
    160      1.23  augustss 	    id->bInterfaceProtocol != UIPROTO_CDC_AT)
    161       1.1  augustss 		return (UMATCH_NONE);
    162       1.9  augustss 
    163       1.9  augustss 	umodem_get_caps(uaa->device, &cm, &acm);
    164       1.9  augustss 	if (!(cm & USB_CDC_CM_DOES_CM) ||
    165       1.9  augustss 	    !(cm & USB_CDC_CM_OVER_DATA) ||
    166       1.9  augustss 	    !(acm & USB_CDC_ACM_HAS_LINE))
    167       1.9  augustss 		return (UMATCH_NONE);
    168       1.9  augustss 
    169       1.2  augustss 	return (UMATCH_IFACECLASS_IFACESUBCLASS_IFACEPROTO);
    170       1.1  augustss }
    171       1.1  augustss 
    172       1.3  augustss USB_ATTACH(umodem)
    173       1.1  augustss {
    174       1.3  augustss 	USB_ATTACH_START(umodem, sc, uaa);
    175       1.9  augustss 	usbd_device_handle dev = uaa->device;
    176       1.1  augustss 	usb_interface_descriptor_t *id;
    177       1.9  augustss 	usb_endpoint_descriptor_t *ed;
    178       1.9  augustss 	usb_cdc_cm_descriptor_t *cmd;
    179       1.1  augustss 	char devinfo[1024];
    180      1.18  augustss 	usbd_status err;
    181      1.20  augustss 	int data_ifcno;
    182       1.9  augustss 	int i;
    183      1.20  augustss 	struct ucom_attach_args uca;
    184       1.9  augustss 
    185       1.1  augustss 	usbd_devinfo(uaa->device, 0, devinfo);
    186       1.3  augustss 	USB_ATTACH_SETUP;
    187       1.9  augustss 
    188       1.9  augustss 	sc->sc_udev = dev;
    189      1.20  augustss 	sc->sc_ctl_iface = uaa->iface;
    190       1.9  augustss 
    191       1.9  augustss 	id = usbd_get_interface_descriptor(sc->sc_ctl_iface);
    192       1.3  augustss 	printf("%s: %s, iclass %d/%d\n", USBDEVNAME(sc->sc_dev),
    193       1.1  augustss 	       devinfo, id->bInterfaceClass, id->bInterfaceSubClass);
    194       1.9  augustss 	sc->sc_ctl_iface_no = id->bInterfaceNumber;
    195       1.9  augustss 
    196       1.9  augustss 	umodem_get_caps(dev, &sc->sc_cm_cap, &sc->sc_acm_cap);
    197       1.9  augustss 
    198       1.9  augustss 	/* Get the data interface no. */
    199       1.9  augustss 	cmd = umodem_get_desc(dev, UDESC_CS_INTERFACE, UDESCSUB_CDC_CM);
    200      1.18  augustss 	if (cmd == NULL) {
    201      1.20  augustss 		printf("%s: no CM descriptor\n", USBDEVNAME(sc->sc_dev));
    202       1.9  augustss 		goto bad;
    203       1.9  augustss 	}
    204      1.20  augustss 	sc->sc_data_iface_no = data_ifcno = cmd->bDataInterface;
    205       1.9  augustss 
    206       1.9  augustss 	printf("%s: data interface %d, has %sCM over data, has %sbreak\n",
    207      1.20  augustss 	       USBDEVNAME(sc->sc_dev), data_ifcno,
    208       1.9  augustss 	       sc->sc_cm_cap & USB_CDC_CM_OVER_DATA ? "" : "no ",
    209       1.9  augustss 	       sc->sc_acm_cap & USB_CDC_ACM_HAS_BREAK ? "" : "no ");
    210       1.9  augustss 
    211       1.9  augustss 
    212       1.9  augustss 	/* Get the data interface too. */
    213       1.9  augustss 	for (i = 0; i < uaa->nifaces; i++) {
    214      1.20  augustss 		if (uaa->ifaces[i] != NULL) {
    215       1.9  augustss 			id = usbd_get_interface_descriptor(uaa->ifaces[i]);
    216      1.20  augustss 			if (id != NULL && id->bInterfaceNumber == data_ifcno) {
    217       1.9  augustss 				sc->sc_data_iface = uaa->ifaces[i];
    218      1.20  augustss 				uaa->ifaces[i] = NULL;
    219       1.9  augustss 			}
    220       1.9  augustss 		}
    221       1.9  augustss 	}
    222      1.18  augustss 	if (sc->sc_data_iface == NULL) {
    223       1.9  augustss 		printf("%s: no data interface\n", USBDEVNAME(sc->sc_dev));
    224       1.9  augustss 		goto bad;
    225       1.9  augustss 	}
    226       1.9  augustss 
    227       1.9  augustss 	/*
    228       1.9  augustss 	 * Find the bulk endpoints.
    229       1.9  augustss 	 * Iterate over all endpoints in the data interface and take note.
    230       1.9  augustss 	 */
    231      1.20  augustss 	uca.bulkin = uca.bulkout = -1;
    232       1.9  augustss 
    233       1.9  augustss 	id = usbd_get_interface_descriptor(sc->sc_data_iface);
    234       1.9  augustss 	for (i = 0; i < id->bNumEndpoints; i++) {
    235       1.9  augustss 		ed = usbd_interface2endpoint_descriptor(sc->sc_data_iface, i);
    236      1.18  augustss 		if (ed == NULL) {
    237       1.9  augustss 			printf("%s: no endpoint descriptor for %d\n",
    238       1.9  augustss 				USBDEVNAME(sc->sc_dev), i);
    239       1.9  augustss 			goto bad;
    240       1.9  augustss 		}
    241      1.12  augustss 		if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
    242       1.9  augustss 		    (ed->bmAttributes & UE_XFERTYPE) == UE_BULK) {
    243      1.20  augustss                         uca.bulkin = ed->bEndpointAddress;
    244      1.12  augustss                 } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
    245       1.9  augustss 			   (ed->bmAttributes & UE_XFERTYPE) == UE_BULK) {
    246      1.20  augustss                         uca.bulkout = ed->bEndpointAddress;
    247       1.9  augustss                 }
    248       1.9  augustss         }
    249       1.9  augustss 
    250      1.20  augustss 	if (uca.bulkin == -1) {
    251      1.20  augustss 		printf("%s: Could not find data bulk in\n",
    252      1.20  augustss 		       USBDEVNAME(sc->sc_dev));
    253       1.9  augustss 		goto bad;
    254       1.9  augustss 	}
    255      1.20  augustss 	if (uca.bulkout == -1) {
    256      1.20  augustss 		printf("%s: Could not find data bulk out\n",
    257      1.20  augustss 			USBDEVNAME(sc->sc_dev));
    258       1.9  augustss 		goto bad;
    259       1.9  augustss 	}
    260       1.9  augustss 
    261       1.9  augustss 	if (sc->sc_cm_cap & USB_CDC_CM_OVER_DATA) {
    262      1.18  augustss 		err = umodem_set_comm_feature(sc, UCDC_ABSTRACT_STATE,
    263      1.20  augustss 					      UCDC_DATA_MULTIPLEXED);
    264      1.20  augustss 		if (err) {
    265      1.20  augustss 			printf("%s: could not set data multiplex mode\n",
    266      1.20  augustss 			       USBDEVNAME(sc->sc_dev));
    267       1.9  augustss 			goto bad;
    268      1.20  augustss 		}
    269       1.9  augustss 		sc->sc_cm_over_data = 1;
    270       1.9  augustss 	}
    271       1.9  augustss 
    272      1.20  augustss 	sc->sc_dtr = -1;
    273       1.9  augustss 
    274      1.20  augustss 	uca.portno = UCOM_UNK_PORTNO;
    275      1.20  augustss 	/* bulkin, bulkout set above */
    276      1.26  augustss 	uca.ibufsize = UMODEMIBUFSIZE;
    277      1.26  augustss 	uca.obufsize = UMODEMOBUFSIZE;
    278      1.27  augustss 	uca.ibufsizepad = UMODEMIBUFSIZE;
    279  1.29.2.1  augustss 	uca.opkthdrlen = 0;
    280      1.20  augustss 	uca.device = sc->sc_udev;
    281      1.20  augustss 	uca.iface = sc->sc_data_iface;
    282      1.20  augustss 	uca.methods = &umodem_methods;
    283      1.20  augustss 	uca.arg = sc;
    284      1.20  augustss 
    285      1.20  augustss 	DPRINTF(("umodem_attach: sc=%p\n", sc));
    286      1.20  augustss 	sc->sc_subdev = config_found_sm(self, &uca, ucomprint, ucomsubmatch);
    287       1.3  augustss 
    288      1.21  augustss 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
    289      1.21  augustss 			   USBDEV(sc->sc_dev));
    290      1.21  augustss 
    291       1.3  augustss 	USB_ATTACH_SUCCESS_RETURN;
    292       1.9  augustss 
    293       1.9  augustss  bad:
    294       1.9  augustss 	sc->sc_dying = 1;
    295       1.9  augustss 	USB_ATTACH_ERROR_RETURN;
    296       1.1  augustss }
    297       1.3  augustss 
    298       1.9  augustss void
    299      1.29  augustss umodem_get_caps(usbd_device_handle dev, int *cm, int *acm)
    300       1.9  augustss {
    301       1.9  augustss 	usb_cdc_cm_descriptor_t *cmd;
    302       1.9  augustss 	usb_cdc_acm_descriptor_t *cad;
    303       1.9  augustss 
    304       1.9  augustss 	*cm = *acm = 0;
    305       1.9  augustss 
    306       1.9  augustss 	cmd = umodem_get_desc(dev, UDESC_CS_INTERFACE, UDESCSUB_CDC_CM);
    307      1.20  augustss 	if (cmd == NULL) {
    308       1.9  augustss 		DPRINTF(("umodem_get_desc: no CM desc\n"));
    309       1.9  augustss 		return;
    310       1.9  augustss 	}
    311       1.9  augustss 	*cm = cmd->bmCapabilities;
    312       1.9  augustss 
    313       1.9  augustss 	cad = umodem_get_desc(dev, UDESC_CS_INTERFACE, UDESCSUB_CDC_ACM);
    314      1.20  augustss 	if (cad == NULL) {
    315       1.9  augustss 		DPRINTF(("umodem_get_desc: no ACM desc\n"));
    316       1.9  augustss 		return;
    317       1.9  augustss 	}
    318       1.9  augustss 	*acm = cad->bmCapabilities;
    319       1.9  augustss }
    320       1.9  augustss 
    321       1.9  augustss void
    322      1.29  augustss umodem_get_status(void *addr, int portno, u_char *lsr, u_char *msr)
    323      1.20  augustss {
    324      1.20  augustss 	DPRINTF(("umodem_get_status:\n"));
    325      1.20  augustss 
    326      1.20  augustss 	if (lsr != NULL)
    327      1.20  augustss 		*lsr = 0;	/* XXX */
    328      1.20  augustss 	if (msr != NULL)
    329      1.20  augustss 		*msr = 0;	/* XXX */
    330       1.9  augustss }
    331       1.9  augustss 
    332       1.9  augustss int
    333      1.29  augustss umodem_param(void *addr, int portno, struct termios *t)
    334       1.9  augustss {
    335      1.20  augustss 	struct umodem_softc *sc = addr;
    336      1.20  augustss 	usbd_status err;
    337       1.9  augustss 	usb_cdc_line_state_t ls;
    338       1.9  augustss 
    339      1.20  augustss 	DPRINTF(("umodem_param: sc=%p\n", sc));
    340       1.9  augustss 
    341       1.9  augustss 	USETDW(ls.dwDTERate, t->c_ospeed);
    342       1.9  augustss 	if (ISSET(t->c_cflag, CSTOPB))
    343       1.9  augustss 		ls.bCharFormat = UCDC_STOP_BIT_2;
    344       1.9  augustss 	else
    345       1.9  augustss 		ls.bCharFormat = UCDC_STOP_BIT_1;
    346       1.9  augustss 	if (ISSET(t->c_cflag, PARENB)) {
    347       1.9  augustss 		if (ISSET(t->c_cflag, PARODD))
    348       1.9  augustss 			ls.bParityType = UCDC_PARITY_ODD;
    349       1.9  augustss 		else
    350       1.9  augustss 			ls.bParityType = UCDC_PARITY_EVEN;
    351       1.9  augustss 	} else
    352       1.9  augustss 		ls.bParityType = UCDC_PARITY_NONE;
    353       1.9  augustss 	switch (ISSET(t->c_cflag, CSIZE)) {
    354       1.9  augustss 	case CS5:
    355       1.9  augustss 		ls.bDataBits = 5;
    356       1.9  augustss 		break;
    357       1.9  augustss 	case CS6:
    358       1.9  augustss 		ls.bDataBits = 6;
    359       1.9  augustss 		break;
    360       1.9  augustss 	case CS7:
    361       1.9  augustss 		ls.bDataBits = 7;
    362       1.9  augustss 		break;
    363       1.9  augustss 	case CS8:
    364       1.9  augustss 		ls.bDataBits = 8;
    365       1.9  augustss 		break;
    366       1.9  augustss 	}
    367       1.9  augustss 
    368      1.20  augustss 	err = umodem_set_line_coding(sc, &ls);
    369      1.20  augustss 	if (err) {
    370      1.20  augustss 		DPRINTF(("umodem_param: err=%s\n", usbd_errstr(err)));
    371      1.20  augustss 		return (1);
    372       1.9  augustss 	}
    373       1.9  augustss 	return (0);
    374       1.9  augustss }
    375       1.9  augustss 
    376       1.9  augustss int
    377      1.29  augustss umodem_ioctl(void *addr, int portno, u_long cmd, caddr_t data, int flag,
    378      1.29  augustss 	     struct proc *p)
    379       1.9  augustss {
    380      1.20  augustss 	struct umodem_softc *sc = addr;
    381      1.24  augustss 	int error = 0;
    382       1.9  augustss 
    383       1.9  augustss 	if (sc->sc_dying)
    384       1.9  augustss 		return (EIO);
    385       1.9  augustss 
    386       1.9  augustss 	DPRINTF(("umodemioctl: cmd=0x%08lx\n", cmd));
    387       1.9  augustss 
    388       1.9  augustss 	switch (cmd) {
    389       1.9  augustss 	case USB_GET_CM_OVER_DATA:
    390       1.9  augustss 		*(int *)data = sc->sc_cm_over_data;
    391       1.9  augustss 		break;
    392       1.9  augustss 
    393       1.9  augustss 	case USB_SET_CM_OVER_DATA:
    394       1.9  augustss 		if (*(int *)data != sc->sc_cm_over_data) {
    395       1.9  augustss 			/* XXX change it */
    396       1.9  augustss 		}
    397       1.9  augustss 		break;
    398       1.9  augustss 
    399       1.9  augustss 	default:
    400       1.9  augustss 		DPRINTF(("umodemioctl: unknown\n"));
    401       1.9  augustss 		error = ENOTTY;
    402       1.9  augustss 		break;
    403       1.9  augustss 	}
    404       1.9  augustss 
    405       1.9  augustss 	return (error);
    406       1.9  augustss }
    407       1.9  augustss 
    408       1.9  augustss void
    409      1.29  augustss umodem_dtr(struct umodem_softc *sc, int onoff)
    410       1.9  augustss {
    411      1.20  augustss 	DPRINTF(("umodem_modem: onoff=%d\n", onoff));
    412       1.9  augustss 
    413      1.20  augustss 	if (sc->sc_dtr == onoff)
    414      1.20  augustss 		return;
    415      1.20  augustss 	sc->sc_dtr = onoff;
    416      1.20  augustss 
    417      1.20  augustss 	umodem_set_line_state(sc);
    418       1.9  augustss }
    419       1.9  augustss 
    420       1.9  augustss void
    421      1.29  augustss umodem_rts(struct umodem_softc *sc, int onoff)
    422       1.9  augustss {
    423       1.9  augustss 	DPRINTF(("umodem_modem: onoff=%d\n", onoff));
    424       1.9  augustss 
    425      1.20  augustss 	if (sc->sc_rts == onoff)
    426       1.9  augustss 		return;
    427      1.20  augustss 	sc->sc_rts = onoff;
    428      1.20  augustss 
    429      1.20  augustss 	umodem_set_line_state(sc);
    430      1.20  augustss }
    431       1.9  augustss 
    432      1.20  augustss void
    433      1.29  augustss umodem_set_line_state(struct umodem_softc *sc)
    434      1.20  augustss {
    435      1.20  augustss 	usb_device_request_t req;
    436      1.20  augustss 	int ls;
    437      1.20  augustss 
    438      1.20  augustss 	ls = (sc->sc_dtr ? UCDC_LINE_DTR : 0) |
    439      1.20  augustss 	     (sc->sc_rts ? UCDC_LINE_RTS : 0);
    440       1.9  augustss 	req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
    441       1.9  augustss 	req.bRequest = UCDC_SET_CONTROL_LINE_STATE;
    442      1.20  augustss 	USETW(req.wValue, ls);
    443       1.9  augustss 	USETW(req.wIndex, sc->sc_ctl_iface_no);
    444       1.9  augustss 	USETW(req.wLength, 0);
    445       1.9  augustss 
    446       1.9  augustss 	(void)usbd_do_request(sc->sc_udev, &req, 0);
    447       1.9  augustss 
    448       1.9  augustss }
    449       1.9  augustss 
    450       1.9  augustss void
    451      1.29  augustss umodem_break(struct umodem_softc *sc, int onoff)
    452       1.9  augustss {
    453       1.9  augustss 	usb_device_request_t req;
    454       1.9  augustss 
    455       1.9  augustss 	DPRINTF(("umodem_break: onoff=%d\n", onoff));
    456       1.9  augustss 
    457       1.9  augustss 	if (!(sc->sc_acm_cap & USB_CDC_ACM_HAS_BREAK))
    458       1.9  augustss 		return;
    459       1.9  augustss 
    460       1.9  augustss 	req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
    461       1.9  augustss 	req.bRequest = UCDC_SEND_BREAK;
    462       1.9  augustss 	USETW(req.wValue, onoff ? UCDC_BREAK_ON : UCDC_BREAK_OFF);
    463       1.9  augustss 	USETW(req.wIndex, sc->sc_ctl_iface_no);
    464       1.9  augustss 	USETW(req.wLength, 0);
    465       1.9  augustss 
    466       1.9  augustss 	(void)usbd_do_request(sc->sc_udev, &req, 0);
    467       1.9  augustss }
    468       1.9  augustss 
    469      1.20  augustss void
    470      1.29  augustss umodem_set(void *addr, int portno, int reg, int onoff)
    471      1.20  augustss {
    472      1.20  augustss 	struct umodem_softc *sc = addr;
    473      1.20  augustss 
    474      1.20  augustss 	switch (reg) {
    475      1.20  augustss 	case UCOM_SET_DTR:
    476      1.20  augustss 		umodem_dtr(sc, onoff);
    477      1.20  augustss 		break;
    478      1.20  augustss 	case UCOM_SET_RTS:
    479      1.20  augustss 		umodem_rts(sc, onoff);
    480      1.20  augustss 		break;
    481      1.20  augustss 	case UCOM_SET_BREAK:
    482      1.20  augustss 		umodem_break(sc, onoff);
    483      1.20  augustss 		break;
    484      1.20  augustss 	default:
    485      1.20  augustss 		break;
    486      1.20  augustss 	}
    487      1.20  augustss }
    488      1.20  augustss 
    489      1.20  augustss usbd_status
    490      1.29  augustss umodem_set_line_coding(struct umodem_softc *sc, usb_cdc_line_state_t *state)
    491      1.20  augustss {
    492      1.20  augustss 	usb_device_request_t req;
    493      1.20  augustss 	usbd_status err;
    494      1.20  augustss 
    495      1.20  augustss 	DPRINTF(("umodem_set_line_coding: rate=%d fmt=%d parity=%d bits=%d\n",
    496      1.20  augustss 		 UGETDW(state->dwDTERate), state->bCharFormat,
    497      1.20  augustss 		 state->bParityType, state->bDataBits));
    498      1.20  augustss 
    499      1.20  augustss 	if (memcmp(state, &sc->sc_line_state, UCDC_LINE_STATE_LENGTH) == 0) {
    500      1.20  augustss 		DPRINTF(("umodem_set_line_coding: already set\n"));
    501      1.20  augustss 		return (USBD_NORMAL_COMPLETION);
    502      1.20  augustss 	}
    503      1.20  augustss 
    504      1.20  augustss 	req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
    505      1.20  augustss 	req.bRequest = UCDC_SET_LINE_CODING;
    506      1.20  augustss 	USETW(req.wValue, 0);
    507      1.20  augustss 	USETW(req.wIndex, sc->sc_ctl_iface_no);
    508      1.20  augustss 	USETW(req.wLength, UCDC_LINE_STATE_LENGTH);
    509      1.20  augustss 
    510      1.20  augustss 	err = usbd_do_request(sc->sc_udev, &req, state);
    511      1.20  augustss 	if (err) {
    512      1.20  augustss 		DPRINTF(("umodem_set_line_coding: failed, err=%s\n",
    513      1.20  augustss 			 usbd_errstr(err)));
    514      1.20  augustss 		return (err);
    515      1.20  augustss 	}
    516      1.20  augustss 
    517      1.20  augustss 	sc->sc_line_state = *state;
    518      1.20  augustss 
    519      1.20  augustss 	return (USBD_NORMAL_COMPLETION);
    520      1.20  augustss }
    521      1.20  augustss 
    522       1.9  augustss void *
    523      1.29  augustss umodem_get_desc(usbd_device_handle dev, int type, int subtype)
    524       1.9  augustss {
    525       1.9  augustss 	usb_descriptor_t *desc;
    526       1.9  augustss 	usb_config_descriptor_t *cd = usbd_get_config_descriptor(dev);
    527       1.9  augustss         uByte *p = (uByte *)cd;
    528       1.9  augustss         uByte *end = p + UGETW(cd->wTotalLength);
    529       1.9  augustss 
    530       1.9  augustss 	while (p < end) {
    531       1.9  augustss 		desc = (usb_descriptor_t *)p;
    532       1.9  augustss 		if (desc->bDescriptorType == type &&
    533       1.9  augustss 		    desc->bDescriptorSubtype == subtype)
    534       1.9  augustss 			return (desc);
    535       1.9  augustss 		p += desc->bLength;
    536       1.9  augustss 	}
    537       1.9  augustss 
    538       1.9  augustss 	return (0);
    539       1.9  augustss }
    540       1.9  augustss 
    541       1.9  augustss usbd_status
    542      1.29  augustss umodem_set_comm_feature(struct umodem_softc *sc, int feature, int state)
    543       1.9  augustss {
    544       1.9  augustss 	usb_device_request_t req;
    545      1.18  augustss 	usbd_status err;
    546       1.9  augustss 	usb_cdc_abstract_state_t ast;
    547       1.9  augustss 
    548      1.20  augustss 	DPRINTF(("umodem_set_comm_feature: feature=%d state=%d\n", feature,
    549      1.20  augustss 		 state));
    550      1.20  augustss 
    551       1.9  augustss 	req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
    552       1.9  augustss 	req.bRequest = UCDC_SET_COMM_FEATURE;
    553       1.9  augustss 	USETW(req.wValue, feature);
    554       1.9  augustss 	USETW(req.wIndex, sc->sc_ctl_iface_no);
    555       1.9  augustss 	USETW(req.wLength, UCDC_ABSTRACT_STATE_LENGTH);
    556       1.9  augustss 	USETW(ast.wState, state);
    557       1.9  augustss 
    558      1.18  augustss 	err = usbd_do_request(sc->sc_udev, &req, &ast);
    559      1.18  augustss 	if (err) {
    560      1.20  augustss 		DPRINTF(("umodem_set_comm_feature: feature=%d, err=%s\n",
    561      1.20  augustss 			 feature, usbd_errstr(err)));
    562      1.18  augustss 		return (err);
    563       1.9  augustss 	}
    564       1.9  augustss 
    565       1.9  augustss 	return (USBD_NORMAL_COMPLETION);
    566       1.9  augustss }
    567       1.9  augustss 
    568       1.9  augustss int
    569      1.29  augustss umodem_activate(device_ptr_t self, enum devact act)
    570       1.9  augustss {
    571       1.9  augustss 	struct umodem_softc *sc = (struct umodem_softc *)self;
    572      1.20  augustss 	int rv = 0;
    573       1.9  augustss 
    574       1.9  augustss 	switch (act) {
    575       1.9  augustss 	case DVACT_ACTIVATE:
    576       1.9  augustss 		return (EOPNOTSUPP);
    577       1.9  augustss 		break;
    578       1.9  augustss 
    579       1.9  augustss 	case DVACT_DEACTIVATE:
    580       1.9  augustss 		sc->sc_dying = 1;
    581      1.20  augustss 		if (sc->sc_subdev)
    582      1.20  augustss 			rv = config_deactivate(sc->sc_subdev);
    583       1.9  augustss 		break;
    584       1.9  augustss 	}
    585      1.20  augustss 	return (rv);
    586       1.9  augustss }
    587       1.9  augustss 
    588      1.21  augustss USB_DETACH(umodem)
    589       1.9  augustss {
    590      1.21  augustss 	USB_DETACH_START(umodem, sc);
    591      1.20  augustss 	int rv = 0;
    592       1.9  augustss 
    593      1.20  augustss 	DPRINTF(("umodem_detach: sc=%p flags=%d\n", sc, flags));
    594       1.9  augustss 
    595       1.9  augustss 	sc->sc_dying = 1;
    596       1.9  augustss 
    597      1.20  augustss 	if (sc->sc_subdev != NULL)
    598      1.20  augustss 		rv = config_detach(sc->sc_subdev, flags);
    599      1.21  augustss 
    600      1.21  augustss 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
    601      1.21  augustss 			   USBDEV(sc->sc_dev));
    602       1.9  augustss 
    603      1.20  augustss 	return (rv);
    604       1.9  augustss }
    605