Root/
Source at commit 64e0322abad52f9ca6566603e5df0f8e49c6a27d created 12 years 8 months ago. By Werner Almesberger, atusb: added interrupt URB removal on cleanup | |
---|---|
1 | /* |
2 | * atusb - SPI host look-alike for ATSUB |
3 | * |
4 | * Copyright (c) 2011 Richard Sharpe <realrichardsharpe@gmail.com> |
5 | * Copyright (c) 2011 Stefan Schmidt <stefan@datenfreihafen.org> |
6 | * |
7 | * This program is free software; you can redistribute it and/or |
8 | * modify it under the terms of the GNU General Public License as |
9 | * published by the Free Software Foundation, version 2 |
10 | * |
11 | */ |
12 | |
13 | /* |
14 | * - Implement buffer and sram read write |
15 | * - Implement IRQ handling |
16 | */ |
17 | |
18 | #include <linux/kernel.h> |
19 | #include <linux/module.h> |
20 | #include <linux/platform_device.h> |
21 | #include <linux/interrupt.h> |
22 | #include <linux/usb.h> |
23 | #include <linux/spi/spi.h> |
24 | #include <linux/spi/at86rf230.h> |
25 | |
26 | #include "../ieee802154/at86rf230.h" /* dirty */ |
27 | |
28 | #define VENDOR_ID 0x20b7 |
29 | #define PRODUCT_ID 0x1540 |
30 | |
31 | /* The devices we work with */ |
32 | static const struct usb_device_id atusb_device_table[] = { |
33 | { USB_DEVICE(VENDOR_ID, PRODUCT_ID) }, |
34 | { }, |
35 | }; |
36 | MODULE_DEVICE_TABLE(usb, atusb_device_table); |
37 | |
38 | #define ATUSB_BUILD_SIZE 256 |
39 | struct atusb_local { |
40 | struct usb_device * udev; |
41 | /* The interface to the RF part info, if applicable */ |
42 | uint8_t ep0_atusb_major; |
43 | uint8_t ep0_atusb_minor; |
44 | uint8_t atusb_hw_type; |
45 | struct spi_master *master; |
46 | int slave_irq; |
47 | struct urb *irq_urb; |
48 | uint8_t irq_buf; /* scratch space */ |
49 | struct tasklet_struct task; /* interrupt delivery tasklet */ |
50 | struct at86rf230_platform_data platform_data; |
51 | /* copy platform_data so that we can adapt .reset_data */ |
52 | struct spi_device *spi; |
53 | // unsigned char buffer[3]; |
54 | unsigned char buffer[260]; /* XXL, just in case */ |
55 | struct spi_message *msg; |
56 | }; |
57 | |
58 | /* Commands to our device. Make sure this is synced with the firmware */ |
59 | enum atspi_requests { |
60 | ATUSB_ID = 0x00, /* system status/control grp */ |
61 | ATUSB_BUILD, |
62 | ATUSB_RESET, |
63 | ATUSB_RF_RESET = 0x10, /* debug/test group */ |
64 | ATUSB_POLL_INT, |
65 | ATUSB_TEST, /* atusb-sil only */ |
66 | ATUSB_TIMER, |
67 | ATUSB_GPIO, |
68 | ATUSB_SLP_TR, |
69 | ATUSB_GPIO_CLEANUP, |
70 | ATUSB_REG_WRITE = 0x20, /* transceiver group */ |
71 | ATUSB_REG_READ, |
72 | ATUSB_BUF_WRITE, |
73 | ATUSB_BUF_READ, |
74 | ATUSB_SRAM_WRITE, |
75 | ATUSB_SRAM_READ, |
76 | ATUSB_SPI_WRITE = 0x30, /* SPI group */ |
77 | ATUSB_SPI_READ1, |
78 | ATUSB_SPI_READ2, |
79 | }; |
80 | |
81 | /* |
82 | * Direction bRequest wValue wIndex wLength |
83 | * |
84 | * ->host ATUSB_ID - - 3 |
85 | * ->host ATUSB_BUILD - - #bytes |
86 | * host-> ATUSB_RESET - - 0 |
87 | * |
88 | * host-> ATUSB_RF_RESET - - 0 |
89 | * ->host ATUSB_POLL_INT - - 1 |
90 | * host-> ATUSB_TEST - - 0 |
91 | * ->host ATUSB_TIMER - - #bytes (6) |
92 | * ->host ATUSB_GPIO dir+data mask+p# 3 |
93 | * host-> ATUSB_SLP_TR - - 0 |
94 | * host-> ATUSB_GPIO_CLEANUP - - 0 |
95 | * |
96 | * host-> ATUSB_REG_WRITE value addr 0 |
97 | * ->host ATUSB_REG_READ - addr 1 |
98 | * host-> ATUSB_BUF_WRITE - - #bytes |
99 | * ->host ATUSB_BUF_READ - - #bytes |
100 | * host-> ATUSB_SRAM_WRITE - addr #bytes |
101 | * ->host ATUSB_SRAM_READ - addr #bytes |
102 | * |
103 | * host-> ATUSB_SPI_WRITE byte0 byte1 #bytes |
104 | * ->host ATUSB_SPI_READ1 byte0 - #bytes |
105 | * ->host ATUSB_SPI_READ2 byte0 byte1 #bytes |
106 | */ |
107 | |
108 | #define ATUSB_FROM_DEV (USB_TYPE_VENDOR | USB_DIR_IN) |
109 | #define ATUSB_TO_DEV (USB_TYPE_VENDOR | USB_DIR_OUT) |
110 | |
111 | |
112 | /* ----- Control transfers ------------------------------------------------- */ |
113 | |
114 | |
115 | static int atusb_async_errchk(struct urb *urb) |
116 | { |
117 | struct atusb_local *atusb = urb->context; |
118 | struct spi_message *msg = atusb->msg; |
119 | struct usb_device *dev = atusb->udev; |
120 | |
121 | if (!urb->status) { |
122 | dev_dbg(&dev->dev, "atusb_async_errchk OK len %d\n", |
123 | urb->actual_length); |
124 | return 0; |
125 | } |
126 | |
127 | if (urb->status != -ENOENT && urb->status != -ECONNRESET && |
128 | urb->status != -ESHUTDOWN) |
129 | dev_info(&dev->dev, "atusb_async_errchk FAIL error %d\n", |
130 | urb->status); |
131 | |
132 | msg->actual_length = 0; |
133 | |
134 | return urb->status; |
135 | } |
136 | |
137 | static void atusb_async_finish(struct urb *urb) |
138 | { |
139 | struct atusb_local *atusb = urb->context; |
140 | struct spi_message *msg = atusb->msg; |
141 | |
142 | msg->status = urb->status; |
143 | msg->complete(msg->context); |
144 | |
145 | kfree(urb->setup_packet); |
146 | usb_free_urb(urb); |
147 | } |
148 | |
149 | static void atusb_ctrl_cb(struct urb *urb) |
150 | { |
151 | atusb_async_errchk(urb); |
152 | atusb_async_finish(urb); |
153 | } |
154 | |
155 | static void atusb_read_fb_cb(struct urb *urb) |
156 | { |
157 | struct atusb_local *atusb = urb->context; |
158 | struct spi_message *msg = atusb->msg; |
159 | const struct spi_transfer *xfer; |
160 | uint8_t *rx; |
161 | |
162 | if (!atusb_async_errchk(urb)) { |
163 | BUG_ON(!urb->actual_length); |
164 | |
165 | xfer = list_first_entry(&msg->transfers, struct spi_transfer, |
166 | transfer_list); |
167 | rx = xfer->rx_buf; |
168 | rx[1] = atusb->buffer[0]; |
169 | |
170 | xfer = list_entry(xfer->transfer_list.next, |
171 | struct spi_transfer, transfer_list); |
172 | memcpy(xfer->rx_buf, atusb->buffer+1, urb->actual_length-1); |
173 | } |
174 | |
175 | atusb_async_finish(urb); |
176 | } |
177 | |
178 | static int submit_control_msg(struct atusb_local *atusb, |
179 | __u8 request, __u8 requesttype, __u16 value, __u16 index, |
180 | void *data, __u16 size, usb_complete_t complete_fn, void *context) |
181 | { |
182 | struct usb_device *dev = atusb->udev; |
183 | struct usb_ctrlrequest *req; |
184 | struct urb *urb; |
185 | int retval = -ENOMEM; |
186 | |
187 | req = kmalloc(sizeof(struct usb_ctrlrequest), GFP_KERNEL); |
188 | if (!req) |
189 | return -ENOMEM; |
190 | |
191 | req->bRequest = request; |
192 | req->bRequestType = requesttype; |
193 | req->wValue = cpu_to_le16(value); |
194 | req->wIndex = cpu_to_le16(index); |
195 | req->wLength = cpu_to_le16(size); |
196 | |
197 | urb = usb_alloc_urb(0, GFP_KERNEL); |
198 | if (!urb) |
199 | goto out_nourb; |
200 | |
201 | usb_fill_control_urb(urb, dev, |
202 | requesttype == ATUSB_FROM_DEV ? |
203 | usb_rcvctrlpipe(dev, 0) : usb_sndctrlpipe(dev, 0), |
204 | (unsigned char *) req, data, size, complete_fn, context); |
205 | |
206 | retval = usb_submit_urb(urb, GFP_KERNEL); |
207 | if (!retval) |
208 | return 0; |
209 | dev_info(&dev->dev, "failed submitting read urb, error %d", |
210 | retval); |
211 | retval = retval == -ENOMEM ? retval : -EIO; |
212 | |
213 | usb_free_urb(urb); |
214 | out_nourb: |
215 | kfree(req); |
216 | |
217 | return retval; |
218 | } |
219 | |
220 | |
221 | /* ----- SPI transfers ----------------------------------------------------- */ |
222 | |
223 | |
224 | static int atusb_read1(struct atusb_local *atusb, |
225 | uint8_t tx, uint8_t *rx, int len) |
226 | { |
227 | dev_info(&atusb->udev->dev, "atusb_read1: tx = 0x%x\n", tx); |
228 | return submit_control_msg(atusb, |
229 | ATUSB_SPI_READ1, ATUSB_FROM_DEV, tx, 0, |
230 | rx, 1, atusb_ctrl_cb, atusb); |
231 | } |
232 | |
233 | static int atusb_read_fb(struct atusb_local *atusb, |
234 | uint8_t tx, uint8_t *rx0, uint8_t *rx, int len) |
235 | { |
236 | dev_info(&atusb->udev->dev, "atusb_read_fb: tx = 0x%x\n", tx); |
237 | return submit_control_msg(atusb, |
238 | ATUSB_SPI_READ1, ATUSB_FROM_DEV, tx, 0, |
239 | atusb->buffer, len+1, atusb_read_fb_cb, atusb); |
240 | } |
241 | |
242 | static int atusb_write(struct atusb_local *atusb, |
243 | uint8_t tx0, uint8_t tx1, const uint8_t *tx, int len) |
244 | { |
245 | dev_info(&atusb->udev->dev, "atusb_write: tx[0] = 0x%x\n", tx0); |
246 | dev_info(&atusb->udev->dev, "atusb_write: tx[1] = 0x%x\n", tx1); |
247 | return submit_control_msg(atusb, |
248 | ATUSB_SPI_WRITE, ATUSB_TO_DEV, tx0, tx1, |
249 | (uint8_t *) tx, len, atusb_ctrl_cb, atusb); |
250 | } |
251 | |
252 | static int atusb_transfer(struct spi_device *spi, struct spi_message *msg) |
253 | { |
254 | struct atusb_local *atusb = spi_master_get_devdata(spi->master); |
255 | struct spi_transfer *xfer; |
256 | struct spi_transfer *x[2]; |
257 | int n; |
258 | const uint8_t *tx; |
259 | uint8_t *rx; |
260 | int len; |
261 | int retval = 0; |
262 | |
263 | if (unlikely(list_empty(&msg->transfers))) { |
264 | dev_err(&atusb->udev->dev, "transfer is empty\n"); |
265 | return -EINVAL; |
266 | } |
267 | |
268 | atusb->msg = msg; |
269 | |
270 | /* Classify the request */ |
271 | n = 0; |
272 | list_for_each_entry(xfer, &msg->transfers, transfer_list) { |
273 | if (n == ARRAY_SIZE(x)) { |
274 | dev_info(&atusb->udev->dev, "too many transfers\n"); |
275 | return -EINVAL; |
276 | } |
277 | x[n] = xfer; |
278 | n++; |
279 | } |
280 | |
281 | tx = x[0]->tx_buf; |
282 | rx = x[0]->rx_buf; |
283 | len = x[0]->len; |
284 | |
285 | msg->actual_length = len; |
286 | |
287 | if (!tx || len != 2) |
288 | goto bad_req; |
289 | if (n == 1) { |
290 | if (rx) { |
291 | dev_info(&atusb->udev->dev, "read 1\n"); |
292 | retval = atusb_read1(atusb, tx[0], rx+1, len-1); |
293 | } else { |
294 | dev_info(&atusb->udev->dev, "write 2\n"); |
295 | /* |
296 | * Don't take our clock away !! ;-) |
297 | */ |
298 | if (tx[0] == (CMD_REG | CMD_WRITE | RG_TRX_CTRL_0)) { |
299 | msg->status = 0; |
300 | msg->complete(msg->context); |
301 | } else { |
302 | retval = atusb_write(atusb, |
303 | tx[0], tx[1], NULL, 0); |
304 | } |
305 | } |
306 | } else { |
307 | if (x[0]->rx_buf) { |
308 | if (x[1]->tx_buf || !x[1]->rx_buf) |
309 | goto bad_req; |
310 | dev_info(&atusb->udev->dev, "read 1+\n"); |
311 | retval = atusb_read_fb(atusb, tx[0], rx+1, |
312 | x[1]->rx_buf, x[1]->len); |
313 | } else { |
314 | if (!x[1]->tx_buf ||x[1]->rx_buf) |
315 | goto bad_req; |
316 | dev_info(&atusb->udev->dev, "write 2+n\n"); |
317 | retval = atusb_write(atusb, tx[0], tx[1], |
318 | x[1]->tx_buf, x[1]->len); |
319 | } |
320 | } |
321 | #if 0 |
322 | /* |
323 | * The AT86RF230 driver sometimes requires a transceiver state |
324 | * transition to be an interrupt barrier. This is the case after |
325 | * writing FORCE_TX_ON to the TRX_CMD field in the TRX_STATE register. |
326 | * |
327 | * Since there is no other means of notification, we just decode the |
328 | * transfer and do a bit of pattern matching. |
329 | */ |
330 | xfer = list_first_entry(&msg->transfers, struct spi_transfer, |
331 | transfer_list); |
332 | tx = xfer->tx_buf; |
333 | if (tx && xfer->len == 2 && |
334 | tx[0] == (CMD_REG | CMD_WRITE | RG_TRX_STATE) && |
335 | (tx[1] & 0x1f) == STATE_FORCE_TX_ON) |
336 | synchronize_irq(atusb->gpio_irq); |
337 | #endif |
338 | return retval; |
339 | |
340 | bad_req: |
341 | dev_info(&atusb->udev->dev, "unrecognized request:\n"); |
342 | list_for_each_entry(xfer, &msg->transfers, transfer_list) |
343 | dev_info(&atusb->udev->dev, "%stx %srx len %u\n", |
344 | xfer->tx_buf ? "" : "!", xfer->rx_buf ? " " : "!", |
345 | xfer->len); |
346 | return -EINVAL; |
347 | } |
348 | |
349 | static int atusb_setup(struct spi_device *spi) |
350 | { |
351 | return 0; |
352 | } |
353 | |
354 | |
355 | /* ----- Interrupt handling ------------------------------------------------ */ |
356 | |
357 | |
358 | static void atusb_tasklet(unsigned long data) |
359 | { |
360 | struct atusb_local *atusb = (void *) data; |
361 | |
362 | generic_handle_irq(atusb->slave_irq); |
363 | } |
364 | |
365 | static void atusb_irq(struct urb *urb) |
366 | { |
367 | struct atusb_local *atusb = urb->context; |
368 | |
369 | printk(KERN_INFO "atusb_irq (%d)\n", urb->status); |
370 | usb_free_urb(urb); |
371 | atusb->irq_urb = NULL; |
372 | tasklet_schedule(&atusb->task); |
373 | } |
374 | |
375 | static int atusb_arm_interrupt(struct atusb_local *atusb) |
376 | { |
377 | struct usb_device *dev = atusb->udev; |
378 | struct urb *urb; |
379 | int retval = -ENOMEM; |
380 | |
381 | BUG_ON(atusb->irq_urb); |
382 | |
383 | printk(KERN_INFO "atusb_arm_interrupt\n"); |
384 | urb = usb_alloc_urb(0, GFP_KERNEL); |
385 | if (!urb) { |
386 | dev_err(&dev->dev, |
387 | "atusb_arm_interrupt: usb_alloc_urb failed\n"); |
388 | return -ENOMEM; |
389 | } |
390 | |
391 | usb_fill_bulk_urb(urb, dev, usb_rcvbulkpipe(dev, 1), |
392 | &atusb->irq_buf, 1, atusb_irq, atusb); |
393 | atusb->irq_urb = urb; |
394 | retval = usb_submit_urb(urb, GFP_KERNEL); |
395 | if (!retval) |
396 | return 0; |
397 | |
398 | dev_err(&dev->dev, "failed submitting bulk urb, error %d", retval); |
399 | retval = retval == -ENOMEM ? retval : -EIO; |
400 | |
401 | usb_free_urb(urb); |
402 | |
403 | return retval; |
404 | } |
405 | |
406 | static void atusb_irq_ack(struct irq_data *data) |
407 | { |
408 | struct atusb_local *atusb = irq_data_get_irq_chip_data(data); |
409 | |
410 | printk(KERN_INFO "atusb_irq_ack\n"); |
411 | atusb_arm_interrupt(atusb); |
412 | } |
413 | |
414 | static void atusb_irq_mask(struct irq_data *data) |
415 | { |
416 | struct atusb_local *atusb = irq_data_get_irq_chip_data(data); |
417 | |
418 | printk(KERN_INFO "atusb_irq_mask\n"); |
419 | tasklet_disable_nosync(&atusb->task); |
420 | } |
421 | |
422 | static void atusb_irq_unmask(struct irq_data *data) |
423 | { |
424 | struct atusb_local *atusb = irq_data_get_irq_chip_data(data); |
425 | |
426 | printk(KERN_INFO "atusb_irq_unmask\n"); |
427 | tasklet_enable(&atusb->task); |
428 | } |
429 | |
430 | static struct irq_chip atusb_irq_chip = { |
431 | .name = "atusb-slave", |
432 | .irq_mask = atusb_irq_mask, |
433 | .irq_unmask = atusb_irq_unmask, |
434 | .irq_ack = atusb_irq_ack, |
435 | }; |
436 | |
437 | |
438 | /* ----- Transceiver reset ------------------------------------------------- */ |
439 | |
440 | |
441 | static void atusb_reset(void *reset_data) |
442 | { |
443 | int retval; |
444 | struct atusb_local *atusb = reset_data; |
445 | |
446 | retval = usb_control_msg(atusb->udev, |
447 | usb_rcvctrlpipe(atusb->udev, 0), |
448 | ATUSB_RF_RESET, ATUSB_TO_DEV, 0, 0, |
449 | NULL, 0, 1000); |
450 | if (retval < 0) { |
451 | dev_info(&atusb->udev->dev, |
452 | "%s: error doing reset retval = %d\n", |
453 | __func__, retval); |
454 | } |
455 | } |
456 | |
457 | |
458 | /* ----- Firmware version information -------------------------------------- */ |
459 | |
460 | |
461 | static int atusb_get_and_show_revision(struct atusb_local *atusb) |
462 | { |
463 | struct usb_device *dev = atusb->udev; |
464 | int retval; |
465 | |
466 | /* Get a couple of the ATMega Firmware values */ |
467 | retval = usb_control_msg(dev, |
468 | usb_rcvctrlpipe(dev, 0), |
469 | ATUSB_ID, ATUSB_FROM_DEV, 0, 0, |
470 | atusb->buffer, 3, 1000); |
471 | if (retval < 0) { |
472 | dev_info(&dev->dev, |
473 | "failed submitting urb for ATUSB_ID, error %d", retval); |
474 | return retval == -ENOMEM ? retval : -EIO; |
475 | } |
476 | |
477 | atusb->ep0_atusb_major = atusb->buffer[0]; |
478 | atusb->ep0_atusb_minor = atusb->buffer[1]; |
479 | atusb->atusb_hw_type = atusb->buffer[2]; |
480 | dev_info(&dev->dev, |
481 | "Firmware: major: %u, minor: %u, hardware type: %u\n", |
482 | atusb->ep0_atusb_major, atusb->ep0_atusb_minor, |
483 | atusb->atusb_hw_type); |
484 | |
485 | return 0; |
486 | } |
487 | |
488 | static int atusb_get_and_show_build(struct atusb_local *atusb) |
489 | { |
490 | struct usb_device *dev = atusb->udev; |
491 | char build[ATUSB_BUILD_SIZE+1]; |
492 | int retval; |
493 | |
494 | retval = usb_control_msg(dev, |
495 | usb_rcvctrlpipe(atusb->udev, 0), |
496 | ATUSB_BUILD, ATUSB_FROM_DEV, 0, 0, |
497 | build, ATUSB_BUILD_SIZE+1, 1000); |
498 | if (retval < 0) { |
499 | dev_info(&dev->dev, |
500 | "failed submitting urb for ATUSB_BUILD, error %d", retval); |
501 | return retval == -ENOMEM ? retval : -EIO; |
502 | } |
503 | |
504 | dev_info(&dev->dev, "Firmware: build %s\n", build); |
505 | |
506 | return 0; |
507 | } |
508 | |
509 | |
510 | /* ----- Setup ------------------------------------------------------------- */ |
511 | |
512 | |
513 | struct at86rf230_platform_data at86rf230_platform_data = { |
514 | .rstn = -1, |
515 | .slp_tr = -1, |
516 | .dig2 = -1, |
517 | .reset = atusb_reset, |
518 | /* set .reset_data later */ |
519 | }; |
520 | |
521 | static int atusb_probe(struct usb_interface *interface, |
522 | const struct usb_device_id *id) |
523 | { |
524 | struct spi_board_info board_info = { |
525 | .modalias = "at86rf230", |
526 | /* set .irq later */ |
527 | .chip_select = 0, |
528 | .bus_num = -1, |
529 | .max_speed_hz = 8 * 1000 * 1000, |
530 | }; |
531 | |
532 | struct usb_device *udev = interface_to_usbdev(interface); |
533 | struct atusb_local *atusb = NULL; |
534 | struct spi_master *master; |
535 | int retval; |
536 | |
537 | /* |
538 | * Ignore all interfaces used for DFU, i.e., everything while in the |
539 | * boot loader, and interface #1 when in the application. |
540 | */ |
541 | if (interface->cur_altsetting->desc.bInterfaceClass != |
542 | USB_CLASS_VENDOR_SPEC) { |
543 | dev_info(&udev->dev, |
544 | "Ignoring interface with class 0x%02x\n", |
545 | interface->cur_altsetting->desc.bInterfaceClass); |
546 | return -ENODEV; |
547 | } |
548 | |
549 | master = spi_alloc_master(&udev->dev, sizeof(*atusb)); |
550 | if (!master) |
551 | return -ENOMEM; |
552 | |
553 | atusb = spi_master_get_devdata(master); |
554 | |
555 | atusb->udev = usb_get_dev(udev); |
556 | usb_set_intfdata(interface, atusb); |
557 | |
558 | atusb->master = spi_master_get(master); |
559 | |
560 | master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH; |
561 | master->bus_num = -1; |
562 | master->num_chipselect = 1; |
563 | master->setup = atusb_setup; |
564 | master->transfer = atusb_transfer; |
565 | |
566 | atusb->slave_irq = irq_alloc_desc(numa_node_id()); |
567 | if (atusb->slave_irq < 0) { |
568 | dev_info(&udev->dev, "can't allocate slave irq\n"); |
569 | retval = -ENXIO; |
570 | goto err_free; |
571 | } |
572 | |
573 | set_irq_chip_data(atusb->slave_irq, atusb); |
574 | set_irq_chip_and_handler(atusb->slave_irq, &atusb_irq_chip, |
575 | handle_level_irq); |
576 | |
577 | /* FIXME prepare USB IRQ */ |
578 | |
579 | retval = spi_register_master(master); |
580 | if (retval < 0) { |
581 | dev_info(&udev->dev, "can't register spi master\n"); |
582 | goto err_slave_irq; |
583 | } |
584 | |
585 | atusb->platform_data = at86rf230_platform_data; |
586 | atusb->platform_data.reset_data = atusb; |
587 | board_info.platform_data = &atusb->platform_data; |
588 | board_info.irq = atusb->slave_irq; |
589 | |
590 | tasklet_init(&atusb->task, atusb_tasklet, (unsigned long) atusb); |
591 | atusb_arm_interrupt(atusb); |
592 | |
593 | atusb->spi = spi_new_device(master, &board_info); |
594 | if (!atusb->spi) { |
595 | dev_info(&udev->dev, "can't create new device for %s\n", |
596 | board_info.modalias); |
597 | goto err_master; |
598 | } |
599 | |
600 | dev_info(&atusb->spi->dev, |
601 | "ATUSB ready for mischief (IRQ %d)\n", board_info.irq); |
602 | |
603 | if (atusb_get_and_show_revision(atusb) < 0) |
604 | goto err_master; |
605 | if (atusb_get_and_show_build(atusb) < 0) |
606 | goto err_master; |
607 | |
608 | return 0; |
609 | |
610 | err_master: |
611 | /* |
612 | * If we come here from a partially successful driver initialization, |
613 | * we don't really know how much it has done. In particular, it may |
614 | * have triggered an interrupt and thus removed the interrupt URB and |
615 | * maybe scheduled the tasklet. |
616 | */ |
617 | tasklet_disable(&atusb->task); |
618 | if (atusb->irq_urb) |
619 | usb_kill_urb(atusb->irq_urb); |
620 | spi_master_put(atusb->master); |
621 | err_slave_irq: |
622 | set_irq_chained_handler(atusb->slave_irq, NULL); |
623 | set_irq_chip_data(atusb->slave_irq, NULL); |
624 | irq_free_desc(atusb->slave_irq); |
625 | err_free: |
626 | return retval; |
627 | } |
628 | |
629 | static void atusb_disconnect(struct usb_interface *interface) |
630 | { |
631 | struct atusb_local *atusb = usb_get_intfdata(interface); |
632 | struct spi_master *master = atusb->master; |
633 | |
634 | tasklet_disable(&atusb->task); |
635 | /* @@@ this needs some extra protecion - wa */ |
636 | if (atusb->irq_urb) |
637 | usb_kill_urb(atusb->irq_urb); |
638 | |
639 | usb_set_intfdata(interface, NULL); |
640 | usb_put_dev(atusb->udev); |
641 | |
642 | spi_dev_put(atusb->spi); |
643 | |
644 | spi_unregister_master(master); |
645 | |
646 | set_irq_chained_handler(atusb->slave_irq, NULL); |
647 | set_irq_chip_data(atusb->slave_irq, NULL); |
648 | irq_free_desc(atusb->slave_irq); |
649 | |
650 | spi_master_put(master); |
651 | } |
652 | |
653 | void atusb_release(struct device *dev) |
654 | { |
655 | return; |
656 | } |
657 | |
658 | static struct usb_driver atusb_driver = { |
659 | .name = "atusb_ben-wpan", |
660 | .probe = atusb_probe, |
661 | .disconnect = atusb_disconnect, |
662 | .id_table = atusb_device_table, |
663 | }; |
664 | |
665 | static struct platform_device atusb_device = { |
666 | .name = "spi_atusb", |
667 | .id = -1, |
668 | .dev.release = atusb_release, |
669 | }; |
670 | |
671 | static int __init atusb_init(void) |
672 | { |
673 | int retval; |
674 | |
675 | retval = platform_device_register(&atusb_device); |
676 | if (retval) |
677 | return retval; |
678 | |
679 | return usb_register(&atusb_driver); |
680 | } |
681 | |
682 | static void __exit atusb_exit(void) |
683 | { |
684 | usb_deregister(&atusb_driver); |
685 | platform_device_unregister(&atusb_device); |
686 | } |
687 | |
688 | module_init (atusb_init); |
689 | module_exit (atusb_exit); |
690 | |
691 | MODULE_AUTHOR("Richard Sharpe <realrichardsharpe@gmail.com>, Stefan Schmidt \ |
692 | <stefan@datenfreihafen.org>"); |
693 | MODULE_DESCRIPTION("ATUSB ben-wpan Driver"); |
694 | MODULE_LICENSE("GPL"); |
695 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9