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