Home | History | Annotate | Line # | Download | only in usb
stuirda.c revision 1.6.2.1
      1  1.6.2.1    yamt /*	$NetBSD: stuirda.c,v 1.6.2.1 2008/05/18 12:34:50 yamt 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.6.2.1    yamt __KERNEL_RCSID(0, "$NetBSD: stuirda.c,v 1.6.2.1 2008/05/18 12:34:50 yamt 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 #include <dev/usb/usb_port.h>
     55      1.1      is 
     56      1.1      is #include <dev/ir/ir.h>
     57      1.1      is #include <dev/ir/irdaio.h>
     58      1.1      is #include <dev/ir/irframevar.h>
     59      1.1      is 
     60      1.1      is #include <dev/usb/uirdavar.h>
     61      1.1      is 
     62      1.1      is #ifdef UIRDA_DEBUG
     63      1.1      is #define DPRINTF(x)	if (stuirdadebug) logprintf x
     64      1.1      is #define DPRINTFN(n,x)	if (stuirdadebug>(n)) logprintf x
     65      1.1      is int	stuirdadebug = 1;
     66      1.1      is #else
     67      1.1      is #define DPRINTF(x)
     68      1.1      is #define DPRINTFN(n,x)
     69      1.1      is #endif
     70      1.1      is 
     71      1.1      is struct stuirda_softc {
     72      1.1      is 	struct uirda_softc sc_uirda;
     73      1.1      is };
     74      1.1      is 
     75      1.1      is int stuirda_fwload(struct uirda_softc *sc);
     76      1.1      is 
     77      1.1      is /*
     78      1.1      is  * These devices need firmware download.
     79      1.1      is  */
     80      1.1      is Static const struct usb_devno stuirda_devs[] = {
     81      1.1      is 	{ USB_VENDOR_SIGMATEL, USB_PRODUCT_SIGMATEL_SIR4116 },
     82      1.1      is 	{ USB_VENDOR_SIGMATEL, USB_PRODUCT_SIGMATEL_FIR4210 },
     83      1.1      is 	{ USB_VENDOR_SIGMATEL, USB_PRODUCT_SIGMATEL_VFIR4220 },
     84      1.1      is };
     85      1.1      is #define stuirda_lookup(v, p) (usb_lookup(stuirda_devs, v, p))
     86      1.1      is 
     87      1.1      is int stuirda_write(void *h, struct uio *uio, int flag);
     88      1.1      is 
     89      1.1      is struct irframe_methods stuirda_methods = {
     90      1.1      is 	uirda_open, uirda_close, uirda_read, stuirda_write, uirda_poll,
     91      1.1      is 	uirda_kqfilter, uirda_set_params, uirda_get_speeds,
     92      1.1      is 	uirda_get_turnarounds
     93      1.1      is };
     94      1.1      is 
     95      1.1      is #define STUIRDA_HEADER_SIZE 3
     96      1.1      is 
     97      1.1      is #define stuirda_activate uirda_activate
     98      1.1      is #define stuirda_detach uirda_detach
     99      1.1      is 
    100      1.1      is USB_DECLARE_DRIVER(stuirda);
    101      1.1      is 
    102      1.1      is USB_MATCH(stuirda)
    103      1.1      is {
    104      1.2      is 	USB_IFMATCH_START(stuirda, uaa);
    105      1.1      is 
    106      1.1      is 	DPRINTFN(50,("stuirda_match\n"));
    107      1.1      is 
    108      1.1      is 	if (stuirda_lookup(uaa->vendor, uaa->product) != NULL)
    109      1.1      is 		return (UMATCH_VENDOR_PRODUCT);
    110      1.1      is 
    111      1.1      is 	return (UMATCH_NONE);
    112      1.1      is }
    113      1.1      is 
    114      1.1      is void uirda_attach(struct device *,struct device *,void *);
    115      1.1      is 
    116      1.1      is USB_ATTACH(stuirda)
    117      1.1      is {
    118      1.2      is 	USB_IFATTACH_START(stuirda, sc, uaa);
    119      1.1      is 
    120      1.1      is 	(void)uaa;
    121      1.1      is 
    122      1.1      is 	sc->sc_uirda.sc_loadfw = stuirda_fwload;
    123      1.1      is 	sc->sc_uirda.sc_irm = &stuirda_methods;
    124      1.1      is 	sc->sc_uirda.sc_hdszi = STUIRDA_HEADER_SIZE;
    125      1.1      is 
    126      1.1      is 	uirda_attach(parent,self,aux);
    127      1.1      is }
    128      1.1      is 
    129      1.1      is int
    130      1.1      is stuirda_fwload(struct uirda_softc *sc) {
    131      1.1      is 
    132      1.1      is 
    133      1.1      is 	int rc;
    134      1.1      is 	firmware_handle_t fh;
    135      1.1      is 	off_t fwsize;
    136      1.1      is 	usb_device_descriptor_t usbddsc;
    137      1.1      is 	usbd_xfer_handle	fwxfer;
    138      1.1      is 	usbd_pipe_handle	fwpipe;
    139      1.1      is 	usbd_status status;
    140      1.1      is 	usb_device_request_t req;
    141      1.1      is 	char *buffer;
    142      1.1      is 	char *p;
    143      1.1      is 	char fwname[12];
    144      1.1      is 	int n;
    145      1.1      is 	u_int8_t *usbbuf;
    146      1.1      is 	/* size_t bsize; */
    147      1.1      is 
    148      1.1      is 	printf("%s: needing to download firmware\n",
    149      1.1      is 		USBDEVNAME(sc->sc_dev));
    150      1.1      is 
    151      1.1      is 	status = usbd_get_device_desc(sc->sc_udev, &usbddsc);
    152      1.1      is 	if (status) {
    153      1.1      is 		printf("%s: can't get device descriptor, status %d\n",
    154      1.1      is 		    USBDEVNAME(sc->sc_dev), status);
    155      1.1      is 		return status;
    156      1.1      is 	}
    157      1.1      is 
    158      1.1      is 	rc = usbd_get_class_desc(sc->sc_udev, UDESC_IRDA, 0,
    159      1.1      is 		USB_IRDA_DESCRIPTOR_SIZE, &sc->sc_irdadesc);
    160      1.1      is 	printf("error %d reading class desc\n", rc);
    161      1.1      is 
    162      1.6  cegger 	snprintf(fwname, sizeof(fwname), "4210%02x%02x.sb",
    163      1.1      is 		usbddsc.bcdDevice[1],
    164      1.1      is 		usbddsc.bcdDevice[0]);
    165      1.1      is 
    166      1.1      is 	printf("%s: Attempting to load firmware %s\n",
    167      1.1      is 		USBDEVNAME(sc->sc_dev), fwname);
    168      1.1      is 
    169      1.1      is 	rc = firmware_open("uirda", fwname, &fh);
    170      1.1      is 
    171      1.1      is 	if (rc) {
    172      1.1      is 		printf("%s: Cannot load firmware\n",
    173      1.1      is 			USBDEVNAME(sc->sc_dev));
    174      1.1      is 		return 0;
    175      1.1      is 		return rc;
    176      1.1      is 	}
    177      1.1      is 	fwsize = firmware_get_size(fh);
    178      1.1      is 
    179      1.1      is 	printf("%s: Firmware size %lld\n",
    180      1.1      is 		USBDEVNAME(sc->sc_dev), (long long)fwsize);
    181      1.1      is 
    182      1.1      is 	buffer = firmware_malloc(fwsize);
    183      1.1      is 	if (buffer == NULL) {
    184      1.1      is 		printf("%s: Cannot load firmware: out of memory\n",
    185      1.1      is 			USBDEVNAME(sc->sc_dev));
    186      1.1      is 		goto giveup2;
    187      1.1      is 	}
    188      1.1      is 
    189      1.1      is 	rc = firmware_read(fh, 0, buffer, (size_t)fwsize);
    190      1.1      is 
    191      1.1      is 	if (rc) {
    192      1.1      is 		printf("%s: Cannot read firmware\n", USBDEVNAME(sc->sc_dev));
    193      1.1      is 		goto giveup3;
    194      1.1      is 	}
    195      1.1      is 
    196      1.1      is 	for (p = buffer + sizeof("Product Version:");
    197      1.1      is 	    p < buffer + fwsize - 5; p++) {
    198      1.1      is 
    199      1.1      is 		if (0x1A == *p)
    200      1.1      is 			break;
    201      1.1      is 	}
    202      1.1      is 	if (0x1a != *p || memcmp(p+1, "STMP", 4) != 0) {
    203      1.1      is 		/* firmware bad */
    204      1.1      is 		printf("%s: Bad firmware\n", USBDEVNAME(sc->sc_dev));
    205      1.1      is 		goto giveup3;
    206      1.1      is 	}
    207      1.1      is 
    208      1.1      is 	p += 5;
    209      1.1      is 
    210      1.1      is 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    211      1.1      is 	req.bRequest = 2 /* XXX magic */;
    212      1.1      is 	USETW(req.wValue, 0);
    213      1.1      is 	USETW(req.wIndex, 0);
    214      1.1      is 	USETW(req.wLength, 0);
    215      1.1      is 	rc = usbd_do_request(sc->sc_udev, &req, 0);
    216      1.1      is 	if (rc) {
    217      1.1      is 		printf("%s: Cannot switch to f/w d/l mode, error %d\n",
    218      1.1      is 			USBDEVNAME(sc->sc_dev), rc);
    219      1.1      is 		goto giveup4;
    220      1.1      is 	}
    221      1.1      is 
    222      1.1      is 	delay(100000);
    223      1.1      is 
    224      1.1      is 	rc = usbd_open_pipe(sc->sc_iface, sc->sc_wr_addr, 0, &fwpipe);
    225      1.1      is 	if (rc) {
    226      1.1      is 		printf("%s: Cannot open pipe, rc=%d\n",
    227      1.1      is 		    USBDEVNAME(sc->sc_dev), rc);
    228      1.1      is 		goto giveup3;
    229      1.1      is 	}
    230      1.1      is 	fwxfer = usbd_alloc_xfer(sc->sc_udev);
    231      1.1      is 	if (fwxfer == NULL) {
    232      1.1      is 		printf("%s: Cannot alloc xfer\n", USBDEVNAME(sc->sc_dev));
    233      1.1      is 		goto giveup4;
    234      1.1      is 	}
    235      1.1      is 	usbbuf = usbd_alloc_buffer(fwxfer, 1024);
    236      1.1      is 	if (usbbuf == NULL) {
    237      1.1      is 		printf("%s: Cannot alloc usb buf\n", USBDEVNAME(sc->sc_dev));
    238      1.1      is 		goto giveup5;
    239      1.1      is 	}
    240      1.1      is 	n = (buffer + fwsize - p);
    241      1.1      is 	while (n > 0) {
    242      1.1      is 		if (n > 1023)
    243      1.1      is 			n = 1023;
    244      1.1      is 		memcpy(usbbuf, p, n);
    245      1.1      is 		rc = usbd_bulk_transfer(fwxfer, fwpipe,
    246      1.1      is 		    USBD_SYNCHRONOUS|USBD_FORCE_SHORT_XFER,
    247      1.1      is 		    5000, usbbuf, &n, "uirda-fw-wr");
    248      1.1      is 		printf("%s: write: rc=%d, %d left\n",
    249      1.1      is 		    USBDEVNAME(sc->sc_dev), rc, n);
    250      1.1      is 		if (rc) {
    251      1.1      is 			printf("%s: write: rc=%d, %d bytes written\n",
    252      1.1      is 			    USBDEVNAME(sc->sc_dev), rc, n);
    253      1.1      is 			goto giveup4;
    254      1.1      is 		}
    255      1.1      is 		printf("%s: written %d\n", USBDEVNAME(sc->sc_dev), n);
    256      1.1      is 		p += n;
    257      1.1      is 		n = (buffer + fwsize - p);
    258      1.1      is 	}
    259      1.1      is 	delay(100000);
    260      1.1      is 	/* TODO: more code here */
    261      1.1      is 	rc = 0;
    262      1.1      is 	usbd_free_buffer(fwxfer);
    263      1.1      is 
    264      1.1      is 	giveup5: usbd_free_xfer(fwxfer);
    265      1.1      is 	giveup4: usbd_close_pipe(fwpipe);
    266      1.1      is 	giveup3: firmware_free(buffer, fwsize);
    267      1.1      is 	giveup2: firmware_close(fh);
    268      1.1      is 
    269      1.1      is 	return rc;
    270      1.1      is 
    271      1.1      is }
    272      1.1      is 
    273      1.1      is int
    274      1.1      is stuirda_write(void *h, struct uio *uio, int flag)
    275      1.1      is {
    276      1.1      is 	struct uirda_softc *sc = h;
    277      1.1      is 	usbd_status err;
    278      1.1      is 	u_int32_t n;
    279      1.1      is 	int error = 0;
    280      1.1      is 
    281      1.1      is 	DPRINTFN(1,("%s: sc=%p\n", __func__, sc));
    282      1.1      is 
    283      1.1      is 	if (sc->sc_dying)
    284      1.1      is 		return (EIO);
    285      1.1      is 
    286      1.1      is #ifdef DIAGNOSTIC
    287      1.1      is 	if (sc->sc_wr_buf == NULL)
    288      1.1      is 		return (EINVAL);
    289      1.1      is #endif
    290      1.1      is 
    291      1.1      is 	n = uio->uio_resid;
    292      1.1      is 	if (n > sc->sc_params.maxsize)
    293      1.1      is 		return (EINVAL);
    294      1.1      is 
    295      1.1      is 	sc->sc_refcnt++;
    296      1.3      ad 	mutex_enter(&sc->sc_wr_buf_lk);
    297      1.1      is 
    298      1.1      is 	sc->sc_wr_buf[0] = UIRDA_EB_NO_CHANGE | UIRDA_NO_SPEED;
    299      1.1      is 
    300      1.1      is 	sc->sc_wr_buf[1] = 0;
    301      1.1      is 	sc->sc_wr_buf[2] = 7; /* XXX turnaround - maximum for now */
    302      1.1      is 	if ((n > 0 && (n % 128) == 0 && (n % 512) != 0)) {
    303      1.1      is 		sc->sc_wr_buf[1] = 1;
    304      1.1      is 	}
    305      1.1      is 
    306      1.1      is 	error = uiomove(sc->sc_wr_buf + STUIRDA_HEADER_SIZE, n, uio);
    307      1.1      is 	if (!error) {
    308      1.1      is 		DPRINTFN(1, ("uirdawrite: transfer %d bytes\n", n));
    309      1.1      is 
    310      1.1      is 		n += STUIRDA_HEADER_SIZE + sc->sc_wr_buf[1];
    311      1.1      is 		err = usbd_bulk_transfer(sc->sc_wr_xfer, sc->sc_wr_pipe,
    312      1.1      is 			  USBD_FORCE_SHORT_XFER|USBD_NO_COPY,
    313      1.1      is 			  UIRDA_WR_TIMEOUT,
    314      1.1      is 			  sc->sc_wr_buf, &n, "uirdawr");
    315      1.1      is 		DPRINTFN(2, ("uirdawrite: err=%d\n", err));
    316      1.1      is 		if (err) {
    317      1.1      is 			if (err == USBD_INTERRUPTED)
    318      1.1      is 				error = EINTR;
    319      1.1      is 			else if (err == USBD_TIMEOUT)
    320      1.1      is 				error = ETIMEDOUT;
    321      1.1      is 			else
    322      1.1      is 				error = EIO;
    323      1.1      is 		}
    324      1.1      is 	}
    325      1.1      is 
    326      1.3      ad 	mutex_exit(&sc->sc_wr_buf_lk);
    327      1.1      is 	if (--sc->sc_refcnt < 0)
    328      1.1      is 		usb_detach_wakeup(USBDEV(sc->sc_dev));
    329      1.1      is 
    330      1.1      is 	DPRINTFN(1,("%s: sc=%p done\n", __func__, sc));
    331      1.1      is 	return (error);
    332      1.1      is }
    333