Home | History | Annotate | Line # | Download | only in usb
stuirda.c revision 1.16.2.5
      1  1.16.2.5   skrll /*	$NetBSD: stuirda.c,v 1.16.2.5 2015/03/19 17:26:43 skrll 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.16.2.5   skrll __KERNEL_RCSID(0, "$NetBSD: stuirda.c,v 1.16.2.5 2015/03/19 17:26:43 skrll 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.16.2.1   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.11  dyoung int             stuirda_match(device_t, cfdata_t, void *);
    100      1.11  dyoung void            stuirda_attach(device_t, device_t, void *);
    101      1.11  dyoung int             stuirda_detach(device_t, int);
    102      1.11  dyoung int             stuirda_activate(device_t, enum devact);
    103      1.11  dyoung extern struct cfdriver stuirda_cd;
    104      1.11  dyoung CFATTACH_DECL_NEW(stuirda, sizeof(struct stuirda_softc), stuirda_match, stuirda_attach, stuirda_detach, stuirda_activate);
    105       1.1      is 
    106  1.16.2.1   skrll int
    107      1.11  dyoung stuirda_match(device_t parent, cfdata_t match, void *aux)
    108       1.1      is {
    109      1.11  dyoung 	struct usbif_attach_arg *uaa = aux;
    110       1.1      is 
    111       1.1      is 	DPRINTFN(50,("stuirda_match\n"));
    112       1.1      is 
    113       1.1      is 	if (stuirda_lookup(uaa->vendor, uaa->product) != NULL)
    114  1.16.2.4   skrll 		return UMATCH_VENDOR_PRODUCT;
    115       1.1      is 
    116  1.16.2.4   skrll 	return UMATCH_NONE;
    117       1.1      is }
    118       1.1      is 
    119       1.8    cube void uirda_attach(device_t, device_t, void *);
    120       1.1      is 
    121  1.16.2.1   skrll void
    122      1.11  dyoung stuirda_attach(device_t parent, device_t self, void *aux)
    123       1.1      is {
    124      1.11  dyoung 	struct stuirda_softc *sc = device_private(self);
    125       1.1      is 
    126       1.1      is 	sc->sc_uirda.sc_loadfw = stuirda_fwload;
    127       1.1      is 	sc->sc_uirda.sc_irm = &stuirda_methods;
    128       1.1      is 	sc->sc_uirda.sc_hdszi = STUIRDA_HEADER_SIZE;
    129       1.1      is 
    130       1.1      is 	uirda_attach(parent,self,aux);
    131       1.1      is }
    132       1.1      is 
    133       1.1      is int
    134       1.1      is stuirda_fwload(struct uirda_softc *sc) {
    135       1.1      is 
    136       1.1      is 
    137       1.1      is 	int rc;
    138       1.1      is 	firmware_handle_t fh;
    139       1.1      is 	off_t fwsize;
    140       1.1      is 	usb_device_descriptor_t usbddsc;
    141  1.16.2.5   skrll 	struct usbd_xfer *	fwxfer;
    142  1.16.2.5   skrll 	struct usbd_pipe *	fwpipe;
    143       1.1      is 	usbd_status status;
    144       1.1      is 	usb_device_request_t req;
    145       1.1      is 	char *buffer;
    146       1.1      is 	char *p;
    147       1.1      is 	char fwname[12];
    148       1.1      is 	int n;
    149  1.16.2.1   skrll 	uint8_t *usbbuf;
    150       1.1      is 	/* size_t bsize; */
    151       1.1      is 
    152       1.1      is 	printf("%s: needing to download firmware\n",
    153      1.11  dyoung 		device_xname(sc->sc_dev));
    154       1.1      is 
    155       1.1      is 	status = usbd_get_device_desc(sc->sc_udev, &usbddsc);
    156       1.1      is 	if (status) {
    157       1.1      is 		printf("%s: can't get device descriptor, status %d\n",
    158      1.11  dyoung 		    device_xname(sc->sc_dev), status);
    159       1.1      is 		return status;
    160       1.1      is 	}
    161       1.1      is 
    162       1.1      is 	rc = usbd_get_class_desc(sc->sc_udev, UDESC_IRDA, 0,
    163       1.1      is 		USB_IRDA_DESCRIPTOR_SIZE, &sc->sc_irdadesc);
    164       1.1      is 	printf("error %d reading class desc\n", rc);
    165       1.1      is 
    166       1.6  cegger 	snprintf(fwname, sizeof(fwname), "4210%02x%02x.sb",
    167       1.1      is 		usbddsc.bcdDevice[1],
    168       1.1      is 		usbddsc.bcdDevice[0]);
    169       1.1      is 
    170       1.1      is 	printf("%s: Attempting to load firmware %s\n",
    171      1.11  dyoung 		device_xname(sc->sc_dev), fwname);
    172  1.16.2.1   skrll 
    173       1.9      is 	rc = firmware_open("stuirda", fwname, &fh);
    174       1.1      is 
    175       1.1      is 	if (rc) {
    176       1.1      is 		printf("%s: Cannot load firmware\n",
    177      1.11  dyoung 			device_xname(sc->sc_dev));
    178       1.1      is 		return rc;
    179       1.1      is 	}
    180       1.1      is 	fwsize = firmware_get_size(fh);
    181       1.1      is 
    182       1.1      is 	printf("%s: Firmware size %lld\n",
    183      1.11  dyoung 		device_xname(sc->sc_dev), (long long)fwsize);
    184       1.1      is 
    185       1.1      is 	buffer = firmware_malloc(fwsize);
    186       1.1      is 	if (buffer == NULL) {
    187       1.1      is 		printf("%s: Cannot load firmware: out of memory\n",
    188      1.11  dyoung 			device_xname(sc->sc_dev));
    189       1.1      is 		goto giveup2;
    190       1.1      is 	}
    191       1.1      is 
    192       1.1      is 	rc = firmware_read(fh, 0, buffer, (size_t)fwsize);
    193       1.1      is 
    194       1.1      is 	if (rc) {
    195      1.11  dyoung 		printf("%s: Cannot read firmware\n", device_xname(sc->sc_dev));
    196       1.1      is 		goto giveup3;
    197       1.1      is 	}
    198       1.1      is 
    199       1.1      is 	for (p = buffer + sizeof("Product Version:");
    200       1.1      is 	    p < buffer + fwsize - 5; p++) {
    201       1.1      is 
    202       1.1      is 		if (0x1A == *p)
    203       1.1      is 			break;
    204       1.1      is 	}
    205       1.1      is 	if (0x1a != *p || memcmp(p+1, "STMP", 4) != 0) {
    206       1.1      is 		/* firmware bad */
    207      1.11  dyoung 		printf("%s: Bad firmware\n", device_xname(sc->sc_dev));
    208       1.1      is 		goto giveup3;
    209       1.1      is 	}
    210       1.1      is 
    211       1.1      is 	p += 5;
    212       1.1      is 
    213       1.1      is 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    214       1.1      is 	req.bRequest = 2 /* XXX magic */;
    215       1.1      is 	USETW(req.wValue, 0);
    216       1.1      is 	USETW(req.wIndex, 0);
    217       1.1      is 	USETW(req.wLength, 0);
    218       1.1      is 	rc = usbd_do_request(sc->sc_udev, &req, 0);
    219       1.1      is 	if (rc) {
    220       1.1      is 		printf("%s: Cannot switch to f/w d/l mode, error %d\n",
    221      1.11  dyoung 			device_xname(sc->sc_dev), rc);
    222      1.15   joerg 		goto giveup3;
    223       1.1      is 	}
    224       1.1      is 
    225       1.1      is 	delay(100000);
    226       1.1      is 
    227       1.1      is 	rc = usbd_open_pipe(sc->sc_iface, sc->sc_wr_addr, 0, &fwpipe);
    228       1.1      is 	if (rc) {
    229       1.1      is 		printf("%s: Cannot open pipe, rc=%d\n",
    230      1.11  dyoung 		    device_xname(sc->sc_dev), rc);
    231       1.1      is 		goto giveup3;
    232       1.1      is 	}
    233       1.1      is 	fwxfer = usbd_alloc_xfer(sc->sc_udev);
    234       1.1      is 	if (fwxfer == NULL) {
    235      1.11  dyoung 		printf("%s: Cannot alloc xfer\n", device_xname(sc->sc_dev));
    236       1.1      is 		goto giveup4;
    237       1.1      is 	}
    238       1.1      is 	usbbuf = usbd_alloc_buffer(fwxfer, 1024);
    239       1.1      is 	if (usbbuf == NULL) {
    240      1.11  dyoung 		printf("%s: Cannot alloc usb buf\n", device_xname(sc->sc_dev));
    241       1.1      is 		goto giveup5;
    242       1.1      is 	}
    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.1      is 		rc = usbd_bulk_transfer(fwxfer, fwpipe,
    249       1.1      is 		    USBD_SYNCHRONOUS|USBD_FORCE_SHORT_XFER,
    250  1.16.2.2   skrll 		    5000, usbbuf, &n);
    251       1.1      is 		printf("%s: write: rc=%d, %d left\n",
    252      1.11  dyoung 		    device_xname(sc->sc_dev), rc, n);
    253       1.1      is 		if (rc) {
    254       1.1      is 			printf("%s: write: rc=%d, %d bytes written\n",
    255      1.11  dyoung 			    device_xname(sc->sc_dev), rc, n);
    256       1.1      is 			goto giveup4;
    257       1.1      is 		}
    258      1.11  dyoung 		printf("%s: written %d\n", device_xname(sc->sc_dev), n);
    259  1.16.2.1   skrll 		p += n;
    260       1.1      is 		n = (buffer + fwsize - p);
    261       1.1      is 	}
    262       1.1      is 	delay(100000);
    263       1.1      is 	/* TODO: more code here */
    264       1.1      is 	rc = 0;
    265       1.1      is 	usbd_free_buffer(fwxfer);
    266       1.1      is 
    267  1.16.2.1   skrll 	giveup5: usbd_free_xfer(fwxfer);
    268       1.1      is 	giveup4: usbd_close_pipe(fwpipe);
    269       1.1      is 	giveup3: firmware_free(buffer, fwsize);
    270       1.1      is 	giveup2: firmware_close(fh);
    271       1.1      is 
    272       1.1      is 	return rc;
    273  1.16.2.1   skrll 
    274       1.1      is }
    275       1.1      is 
    276       1.1      is int
    277       1.1      is stuirda_write(void *h, struct uio *uio, int flag)
    278       1.1      is {
    279       1.1      is 	struct uirda_softc *sc = h;
    280       1.1      is 	usbd_status err;
    281  1.16.2.1   skrll 	uint32_t n;
    282       1.1      is 	int error = 0;
    283       1.1      is 
    284       1.1      is 	DPRINTFN(1,("%s: sc=%p\n", __func__, sc));
    285       1.1      is 
    286       1.1      is 	if (sc->sc_dying)
    287  1.16.2.4   skrll 		return EIO;
    288       1.1      is 
    289       1.1      is #ifdef DIAGNOSTIC
    290       1.1      is 	if (sc->sc_wr_buf == NULL)
    291  1.16.2.4   skrll 		return EINVAL;
    292       1.1      is #endif
    293       1.1      is 
    294       1.1      is 	n = uio->uio_resid;
    295       1.1      is 	if (n > sc->sc_params.maxsize)
    296  1.16.2.4   skrll 		return EINVAL;
    297       1.1      is 
    298       1.1      is 	sc->sc_refcnt++;
    299       1.3      ad 	mutex_enter(&sc->sc_wr_buf_lk);
    300       1.1      is 
    301       1.1      is 	sc->sc_wr_buf[0] = UIRDA_EB_NO_CHANGE | UIRDA_NO_SPEED;
    302       1.1      is 
    303       1.1      is 	sc->sc_wr_buf[1] = 0;
    304       1.1      is 	sc->sc_wr_buf[2] = 7; /* XXX turnaround - maximum for now */
    305       1.1      is 	if ((n > 0 && (n % 128) == 0 && (n % 512) != 0)) {
    306       1.1      is 		sc->sc_wr_buf[1] = 1;
    307       1.1      is 	}
    308       1.1      is 
    309       1.1      is 	error = uiomove(sc->sc_wr_buf + STUIRDA_HEADER_SIZE, n, uio);
    310       1.1      is 	if (!error) {
    311       1.1      is 		DPRINTFN(1, ("uirdawrite: transfer %d bytes\n", n));
    312       1.1      is 
    313       1.1      is 		n += STUIRDA_HEADER_SIZE + sc->sc_wr_buf[1];
    314       1.1      is 		err = usbd_bulk_transfer(sc->sc_wr_xfer, sc->sc_wr_pipe,
    315  1.16.2.3   skrll 			  USBD_FORCE_SHORT_XFER,
    316       1.1      is 			  UIRDA_WR_TIMEOUT,
    317  1.16.2.2   skrll 			  sc->sc_wr_buf, &n);
    318       1.1      is 		DPRINTFN(2, ("uirdawrite: err=%d\n", err));
    319       1.1      is 		if (err) {
    320       1.1      is 			if (err == USBD_INTERRUPTED)
    321       1.1      is 				error = EINTR;
    322       1.1      is 			else if (err == USBD_TIMEOUT)
    323       1.1      is 				error = ETIMEDOUT;
    324       1.1      is 			else
    325       1.1      is 				error = EIO;
    326       1.1      is 		}
    327       1.1      is 	}
    328       1.1      is 
    329       1.3      ad 	mutex_exit(&sc->sc_wr_buf_lk);
    330       1.1      is 	if (--sc->sc_refcnt < 0)
    331      1.14     mrg 		usb_detach_wakeupold(sc->sc_dev);
    332       1.1      is 
    333       1.1      is 	DPRINTFN(1,("%s: sc=%p done\n", __func__, sc));
    334  1.16.2.4   skrll 	return error;
    335       1.1      is }
    336