Home | History | Annotate | Line # | Download | only in usb
stuirda.c revision 1.18
      1  1.18  msaitoh /*	$NetBSD: stuirda.c,v 1.18 2016/07/07 06:55:42 msaitoh Exp $	*/
      2   1.1       is 
      3   1.1       is /*
      4   1.1       is  * Copyright (c) 2001,2007 The NetBSD Foundation, Inc.
      5   1.1       is  * All rights reserved.
      6   1.1       is  *
      7   1.1       is  * This code is derived from software contributed to The NetBSD Foundation
      8   1.1       is  * by Lennart Augustsson (lennart (at) augustsson.net).
      9   1.1       is  *
     10   1.1       is  * Redistribution and use in source and binary forms, with or without
     11   1.1       is  * modification, are permitted provided that the following conditions
     12   1.1       is  * are met:
     13   1.1       is  * 1. Redistributions of source code must retain the above copyright
     14   1.1       is  *    notice, this list of conditions and the following disclaimer.
     15   1.1       is  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1       is  *    notice, this list of conditions and the following disclaimer in the
     17   1.1       is  *    documentation and/or other materials provided with the distribution.
     18   1.1       is  *
     19   1.1       is  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.1       is  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.1       is  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.1       is  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.1       is  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.1       is  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.1       is  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.1       is  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.1       is  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.1       is  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.1       is  * POSSIBILITY OF SUCH DAMAGE.
     30   1.1       is  */
     31   1.4    lukem 
     32   1.1       is #include <sys/cdefs.h>
     33  1.18  msaitoh __KERNEL_RCSID(0, "$NetBSD: stuirda.c,v 1.18 2016/07/07 06:55:42 msaitoh Exp $");
     34   1.4    lukem 
     35   1.1       is #include <sys/param.h>
     36   1.1       is 
     37   1.1       is #include <sys/device.h>
     38   1.1       is #include <sys/systm.h>
     39   1.1       is #include <sys/kernel.h>
     40   1.1       is #include <sys/device.h>
     41   1.1       is #include <sys/ioctl.h>
     42   1.1       is #include <sys/conf.h>
     43   1.1       is #include <sys/file.h>
     44   1.1       is #include <sys/poll.h>
     45   1.1       is #include <sys/select.h>
     46   1.1       is #include <sys/proc.h>
     47   1.1       is 
     48   1.1       is 
     49   1.1       is #include <dev/firmload.h>
     50   1.1       is #include <dev/usb/usb.h>
     51   1.1       is #include <dev/usb/usbdi.h>
     52   1.1       is #include <dev/usb/usbdi_util.h>
     53   1.1       is #include <dev/usb/usbdevs.h>
     54   1.1       is 
     55   1.1       is #include <dev/ir/ir.h>
     56   1.1       is #include <dev/ir/irdaio.h>
     57   1.1       is #include <dev/ir/irframevar.h>
     58   1.1       is 
     59   1.1       is #include <dev/usb/uirdavar.h>
     60   1.1       is 
     61   1.1       is #ifdef UIRDA_DEBUG
     62  1.11   dyoung #define DPRINTF(x)	if (stuirdadebug) printf x
     63  1.11   dyoung #define DPRINTFN(n,x)	if (stuirdadebug>(n)) printf x
     64   1.1       is int	stuirdadebug = 1;
     65   1.1       is #else
     66   1.1       is #define DPRINTF(x)
     67   1.1       is #define DPRINTFN(n,x)
     68   1.1       is #endif
     69   1.1       is 
     70   1.1       is struct stuirda_softc {
     71   1.1       is 	struct uirda_softc sc_uirda;
     72   1.1       is };
     73   1.1       is 
     74   1.1       is int stuirda_fwload(struct uirda_softc *sc);
     75   1.1       is 
     76  1.17    skrll /*
     77   1.1       is  * These devices need firmware download.
     78   1.1       is  */
     79   1.1       is Static const struct usb_devno stuirda_devs[] = {
     80   1.1       is 	{ USB_VENDOR_SIGMATEL, USB_PRODUCT_SIGMATEL_SIR4116 },
     81   1.1       is 	{ USB_VENDOR_SIGMATEL, USB_PRODUCT_SIGMATEL_FIR4210 },
     82   1.1       is 	{ USB_VENDOR_SIGMATEL, USB_PRODUCT_SIGMATEL_VFIR4220 },
     83   1.1       is };
     84   1.1       is #define stuirda_lookup(v, p) (usb_lookup(stuirda_devs, v, p))
     85   1.1       is 
     86   1.1       is int stuirda_write(void *h, struct uio *uio, int flag);
     87   1.1       is 
     88   1.1       is struct irframe_methods stuirda_methods = {
     89   1.1       is 	uirda_open, uirda_close, uirda_read, stuirda_write, uirda_poll,
     90   1.1       is 	uirda_kqfilter, uirda_set_params, uirda_get_speeds,
     91   1.1       is 	uirda_get_turnarounds
     92   1.1       is };
     93   1.1       is 
     94   1.1       is #define STUIRDA_HEADER_SIZE 3
     95   1.1       is 
     96   1.1       is #define stuirda_activate uirda_activate
     97   1.1       is #define stuirda_detach uirda_detach
     98   1.1       is 
     99  1.18  msaitoh int	stuirda_match(device_t, cfdata_t, void *);
    100  1.18  msaitoh void	stuirda_attach(device_t, device_t, void *);
    101  1.18  msaitoh int	stuirda_detach(device_t, int);
    102  1.18  msaitoh int	stuirda_activate(device_t, enum devact);
    103  1.11   dyoung extern struct cfdriver stuirda_cd;
    104  1.18  msaitoh CFATTACH_DECL_NEW(stuirda, sizeof(struct stuirda_softc), stuirda_match,
    105  1.18  msaitoh     stuirda_attach, stuirda_detach, stuirda_activate);
    106   1.1       is 
    107  1.17    skrll int
    108  1.11   dyoung stuirda_match(device_t parent, cfdata_t match, void *aux)
    109   1.1       is {
    110  1.17    skrll 	struct usbif_attach_arg *uiaa = aux;
    111   1.1       is 
    112   1.1       is 	DPRINTFN(50,("stuirda_match\n"));
    113   1.1       is 
    114  1.17    skrll 	if (stuirda_lookup(uiaa->uiaa_vendor, uiaa->uiaa_product) != NULL)
    115  1.17    skrll 		return UMATCH_VENDOR_PRODUCT;
    116   1.1       is 
    117  1.17    skrll 	return UMATCH_NONE;
    118   1.1       is }
    119   1.1       is 
    120   1.8     cube void uirda_attach(device_t, device_t, void *);
    121   1.1       is 
    122  1.17    skrll void
    123  1.11   dyoung stuirda_attach(device_t parent, device_t self, void *aux)
    124   1.1       is {
    125  1.11   dyoung 	struct stuirda_softc *sc = device_private(self);
    126   1.1       is 
    127   1.1       is 	sc->sc_uirda.sc_loadfw = stuirda_fwload;
    128   1.1       is 	sc->sc_uirda.sc_irm = &stuirda_methods;
    129   1.1       is 	sc->sc_uirda.sc_hdszi = STUIRDA_HEADER_SIZE;
    130   1.1       is 
    131   1.1       is 	uirda_attach(parent,self,aux);
    132   1.1       is }
    133   1.1       is 
    134   1.1       is int
    135  1.18  msaitoh stuirda_fwload(struct uirda_softc *sc)
    136  1.18  msaitoh {
    137   1.1       is 
    138   1.1       is 
    139   1.1       is 	int rc;
    140   1.1       is 	firmware_handle_t fh;
    141   1.1       is 	off_t fwsize;
    142   1.1       is 	usb_device_descriptor_t usbddsc;
    143  1.17    skrll 	struct usbd_xfer *	fwxfer;
    144  1.17    skrll 	struct usbd_pipe *	fwpipe;
    145   1.1       is 	usbd_status status;
    146   1.1       is 	usb_device_request_t req;
    147   1.1       is 	char *buffer;
    148   1.1       is 	char *p;
    149   1.1       is 	char fwname[12];
    150   1.1       is 	int n;
    151  1.17    skrll 	uint8_t *usbbuf;
    152   1.1       is 	/* size_t bsize; */
    153   1.1       is 
    154   1.1       is 	printf("%s: needing to download firmware\n",
    155  1.11   dyoung 		device_xname(sc->sc_dev));
    156   1.1       is 
    157   1.1       is 	status = usbd_get_device_desc(sc->sc_udev, &usbddsc);
    158   1.1       is 	if (status) {
    159   1.1       is 		printf("%s: can't get device descriptor, status %d\n",
    160  1.11   dyoung 		    device_xname(sc->sc_dev), status);
    161   1.1       is 		return status;
    162   1.1       is 	}
    163   1.1       is 
    164   1.1       is 	rc = usbd_get_class_desc(sc->sc_udev, UDESC_IRDA, 0,
    165   1.1       is 		USB_IRDA_DESCRIPTOR_SIZE, &sc->sc_irdadesc);
    166   1.1       is 	printf("error %d reading class desc\n", rc);
    167   1.1       is 
    168   1.6   cegger 	snprintf(fwname, sizeof(fwname), "4210%02x%02x.sb",
    169   1.1       is 		usbddsc.bcdDevice[1],
    170   1.1       is 		usbddsc.bcdDevice[0]);
    171   1.1       is 
    172   1.1       is 	printf("%s: Attempting to load firmware %s\n",
    173  1.11   dyoung 		device_xname(sc->sc_dev), fwname);
    174  1.17    skrll 
    175   1.9       is 	rc = firmware_open("stuirda", fwname, &fh);
    176   1.1       is 
    177   1.1       is 	if (rc) {
    178   1.1       is 		printf("%s: Cannot load firmware\n",
    179  1.11   dyoung 			device_xname(sc->sc_dev));
    180   1.1       is 		return rc;
    181   1.1       is 	}
    182   1.1       is 	fwsize = firmware_get_size(fh);
    183   1.1       is 
    184   1.1       is 	printf("%s: Firmware size %lld\n",
    185  1.11   dyoung 		device_xname(sc->sc_dev), (long long)fwsize);
    186   1.1       is 
    187   1.1       is 	buffer = firmware_malloc(fwsize);
    188   1.1       is 	if (buffer == NULL) {
    189   1.1       is 		printf("%s: Cannot load firmware: out of memory\n",
    190  1.11   dyoung 			device_xname(sc->sc_dev));
    191   1.1       is 		goto giveup2;
    192   1.1       is 	}
    193   1.1       is 
    194   1.1       is 	rc = firmware_read(fh, 0, buffer, (size_t)fwsize);
    195   1.1       is 
    196   1.1       is 	if (rc) {
    197  1.11   dyoung 		printf("%s: Cannot read firmware\n", device_xname(sc->sc_dev));
    198   1.1       is 		goto giveup3;
    199   1.1       is 	}
    200   1.1       is 
    201   1.1       is 	for (p = buffer + sizeof("Product Version:");
    202   1.1       is 	    p < buffer + fwsize - 5; p++) {
    203   1.1       is 
    204   1.1       is 		if (0x1A == *p)
    205   1.1       is 			break;
    206   1.1       is 	}
    207   1.1       is 	if (0x1a != *p || memcmp(p+1, "STMP", 4) != 0) {
    208   1.1       is 		/* firmware bad */
    209  1.11   dyoung 		printf("%s: Bad firmware\n", device_xname(sc->sc_dev));
    210   1.1       is 		goto giveup3;
    211   1.1       is 	}
    212   1.1       is 
    213   1.1       is 	p += 5;
    214   1.1       is 
    215   1.1       is 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    216   1.1       is 	req.bRequest = 2 /* XXX magic */;
    217   1.1       is 	USETW(req.wValue, 0);
    218   1.1       is 	USETW(req.wIndex, 0);
    219   1.1       is 	USETW(req.wLength, 0);
    220   1.1       is 	rc = usbd_do_request(sc->sc_udev, &req, 0);
    221   1.1       is 	if (rc) {
    222   1.1       is 		printf("%s: Cannot switch to f/w d/l mode, error %d\n",
    223  1.11   dyoung 			device_xname(sc->sc_dev), rc);
    224  1.15    joerg 		goto giveup3;
    225   1.1       is 	}
    226   1.1       is 
    227   1.1       is 	delay(100000);
    228   1.1       is 
    229   1.1       is 	rc = usbd_open_pipe(sc->sc_iface, sc->sc_wr_addr, 0, &fwpipe);
    230   1.1       is 	if (rc) {
    231   1.1       is 		printf("%s: Cannot open pipe, rc=%d\n",
    232  1.11   dyoung 		    device_xname(sc->sc_dev), rc);
    233   1.1       is 		goto giveup3;
    234   1.1       is 	}
    235  1.17    skrll 
    236  1.17    skrll 	int err = usbd_create_xfer(fwpipe, 1024, USBD_FORCE_SHORT_XFER, 0,
    237  1.17    skrll 	    &fwxfer);
    238  1.17    skrll 	if (err) {
    239  1.11   dyoung 		printf("%s: Cannot alloc xfer\n", device_xname(sc->sc_dev));
    240   1.1       is 		goto giveup4;
    241   1.1       is 	}
    242  1.17    skrll 	usbbuf = usbd_get_buffer(fwxfer);
    243   1.1       is 	n = (buffer + fwsize - p);
    244   1.1       is 	while (n > 0) {
    245   1.1       is 		if (n > 1023)
    246   1.1       is 			n = 1023;
    247   1.1       is 		memcpy(usbbuf, p, n);
    248  1.17    skrll 		rc = usbd_bulk_transfer(fwxfer, fwpipe, USBD_FORCE_SHORT_XFER,
    249  1.17    skrll 		    5000, usbbuf, &n);
    250   1.1       is 		printf("%s: write: rc=%d, %d left\n",
    251  1.11   dyoung 		    device_xname(sc->sc_dev), rc, n);
    252   1.1       is 		if (rc) {
    253   1.1       is 			printf("%s: write: rc=%d, %d bytes written\n",
    254  1.11   dyoung 			    device_xname(sc->sc_dev), rc, n);
    255   1.1       is 			goto giveup4;
    256   1.1       is 		}
    257  1.11   dyoung 		printf("%s: written %d\n", device_xname(sc->sc_dev), n);
    258  1.17    skrll 		p += n;
    259   1.1       is 		n = (buffer + fwsize - p);
    260   1.1       is 	}
    261   1.1       is 	delay(100000);
    262   1.1       is 	/* TODO: more code here */
    263   1.1       is 	rc = 0;
    264  1.17    skrll 	usbd_destroy_xfer(fwxfer);
    265   1.1       is 
    266   1.1       is 	giveup4: usbd_close_pipe(fwpipe);
    267   1.1       is 	giveup3: firmware_free(buffer, fwsize);
    268   1.1       is 	giveup2: firmware_close(fh);
    269   1.1       is 
    270   1.1       is 	return rc;
    271  1.17    skrll 
    272   1.1       is }
    273   1.1       is 
    274   1.1       is int
    275   1.1       is stuirda_write(void *h, struct uio *uio, int flag)
    276   1.1       is {
    277   1.1       is 	struct uirda_softc *sc = h;
    278   1.1       is 	usbd_status err;
    279  1.17    skrll 	uint32_t n;
    280   1.1       is 	int error = 0;
    281   1.1       is 
    282   1.1       is 	DPRINTFN(1,("%s: sc=%p\n", __func__, sc));
    283   1.1       is 
    284   1.1       is 	if (sc->sc_dying)
    285  1.17    skrll 		return EIO;
    286   1.1       is 
    287   1.1       is #ifdef DIAGNOSTIC
    288   1.1       is 	if (sc->sc_wr_buf == NULL)
    289  1.17    skrll 		return EINVAL;
    290   1.1       is #endif
    291   1.1       is 
    292   1.1       is 	n = uio->uio_resid;
    293   1.1       is 	if (n > sc->sc_params.maxsize)
    294  1.17    skrll 		return EINVAL;
    295   1.1       is 
    296   1.1       is 	sc->sc_refcnt++;
    297   1.3       ad 	mutex_enter(&sc->sc_wr_buf_lk);
    298   1.1       is 
    299   1.1       is 	sc->sc_wr_buf[0] = UIRDA_EB_NO_CHANGE | UIRDA_NO_SPEED;
    300   1.1       is 
    301   1.1       is 	sc->sc_wr_buf[1] = 0;
    302   1.1       is 	sc->sc_wr_buf[2] = 7; /* XXX turnaround - maximum for now */
    303   1.1       is 	if ((n > 0 && (n % 128) == 0 && (n % 512) != 0)) {
    304   1.1       is 		sc->sc_wr_buf[1] = 1;
    305   1.1       is 	}
    306   1.1       is 
    307   1.1       is 	error = uiomove(sc->sc_wr_buf + STUIRDA_HEADER_SIZE, n, uio);
    308  1.17    skrll 	if (error)
    309  1.17    skrll 		goto done;
    310  1.17    skrll 
    311  1.17    skrll 	DPRINTFN(1, ("uirdawrite: transfer %d bytes\n", n));
    312  1.17    skrll 
    313  1.17    skrll 	n += STUIRDA_HEADER_SIZE + sc->sc_wr_buf[1];
    314   1.1       is 
    315  1.17    skrll 	err = usbd_bulk_transfer(sc->sc_wr_xfer, sc->sc_wr_pipe,
    316  1.17    skrll 	    USBD_FORCE_SHORT_XFER, UIRDA_WR_TIMEOUT, sc->sc_wr_buf, &n);
    317  1.17    skrll 	DPRINTFN(2, ("uirdawrite: err=%d\n", err));
    318  1.17    skrll 	if (err) {
    319  1.17    skrll 		if (err == USBD_INTERRUPTED)
    320  1.17    skrll 			error = EINTR;
    321  1.17    skrll 		else if (err == USBD_TIMEOUT)
    322  1.17    skrll 			error = ETIMEDOUT;
    323  1.17    skrll 		else
    324  1.17    skrll 			error = EIO;
    325   1.1       is 	}
    326  1.17    skrll done:
    327   1.3       ad 	mutex_exit(&sc->sc_wr_buf_lk);
    328   1.1       is 	if (--sc->sc_refcnt < 0)
    329  1.14      mrg 		usb_detach_wakeupold(sc->sc_dev);
    330   1.1       is 
    331   1.1       is 	DPRINTFN(1,("%s: sc=%p done\n", __func__, sc));
    332  1.17    skrll 	return error;
    333   1.1       is }
    334