OSDN Git Service

ALSA: line6: Add delay before reading status
[sagit-ice-cold/kernel_xiaomi_msm8998.git] / sound / usb / line6 / driver.c
1 /*
2  * Line 6 Linux USB driver
3  *
4  * Copyright (C) 2004-2010 Markus Grabner (grabner@icg.tugraz.at)
5  *
6  *      This program is free software; you can redistribute it and/or
7  *      modify it under the terms of the GNU General Public License as
8  *      published by the Free Software Foundation, version 2.
9  *
10  */
11
12 #include <linux/kernel.h>
13 #include <linux/module.h>
14 #include <linux/export.h>
15 #include <linux/slab.h>
16 #include <linux/usb.h>
17
18 #include <sound/core.h>
19 #include <sound/initval.h>
20
21 #include "capture.h"
22 #include "driver.h"
23 #include "midi.h"
24 #include "playback.h"
25
26 #define DRIVER_AUTHOR  "Markus Grabner <grabner@icg.tugraz.at>"
27 #define DRIVER_DESC    "Line 6 USB Driver"
28
29 /*
30         This is Line 6's MIDI manufacturer ID.
31 */
32 const unsigned char line6_midi_id[] = {
33         0x00, 0x01, 0x0c
34 };
35 EXPORT_SYMBOL_GPL(line6_midi_id);
36
37 /*
38         Code to request version of POD, Variax interface
39         (and maybe other devices).
40 */
41 static const char line6_request_version[] = {
42         0xf0, 0x7e, 0x7f, 0x06, 0x01, 0xf7
43 };
44
45 /*
46          Class for asynchronous messages.
47 */
48 struct message {
49         struct usb_line6 *line6;
50         const char *buffer;
51         int size;
52         int done;
53 };
54
55 /*
56         Forward declarations.
57 */
58 static void line6_data_received(struct urb *urb);
59 static int line6_send_raw_message_async_part(struct message *msg,
60                                              struct urb *urb);
61
62 /*
63         Start to listen on endpoint.
64 */
65 static int line6_start_listen(struct usb_line6 *line6)
66 {
67         int err;
68
69         usb_fill_int_urb(line6->urb_listen, line6->usbdev,
70                 usb_rcvintpipe(line6->usbdev, line6->properties->ep_ctrl_r),
71                 line6->buffer_listen, LINE6_BUFSIZE_LISTEN,
72                 line6_data_received, line6, line6->interval);
73         line6->urb_listen->actual_length = 0;
74         err = usb_submit_urb(line6->urb_listen, GFP_ATOMIC);
75         return err;
76 }
77
78 /*
79         Stop listening on endpoint.
80 */
81 static void line6_stop_listen(struct usb_line6 *line6)
82 {
83         usb_kill_urb(line6->urb_listen);
84 }
85
86 /*
87         Send raw message in pieces of wMaxPacketSize bytes.
88 */
89 static int line6_send_raw_message(struct usb_line6 *line6, const char *buffer,
90                                   int size)
91 {
92         int i, done = 0;
93
94         for (i = 0; i < size; i += line6->max_packet_size) {
95                 int partial;
96                 const char *frag_buf = buffer + i;
97                 int frag_size = min(line6->max_packet_size, size - i);
98                 int retval;
99
100                 retval = usb_interrupt_msg(line6->usbdev,
101                                         usb_sndintpipe(line6->usbdev,
102                                                 line6->properties->ep_ctrl_w),
103                                         (char *)frag_buf, frag_size,
104                                         &partial, LINE6_TIMEOUT * HZ);
105
106                 if (retval) {
107                         dev_err(line6->ifcdev,
108                                 "usb_interrupt_msg failed (%d)\n", retval);
109                         break;
110                 }
111
112                 done += frag_size;
113         }
114
115         return done;
116 }
117
118 /*
119         Notification of completion of asynchronous request transmission.
120 */
121 static void line6_async_request_sent(struct urb *urb)
122 {
123         struct message *msg = (struct message *)urb->context;
124
125         if (msg->done >= msg->size) {
126                 usb_free_urb(urb);
127                 kfree(msg);
128         } else
129                 line6_send_raw_message_async_part(msg, urb);
130 }
131
132 /*
133         Asynchronously send part of a raw message.
134 */
135 static int line6_send_raw_message_async_part(struct message *msg,
136                                              struct urb *urb)
137 {
138         int retval;
139         struct usb_line6 *line6 = msg->line6;
140         int done = msg->done;
141         int bytes = min(msg->size - done, line6->max_packet_size);
142
143         usb_fill_int_urb(urb, line6->usbdev,
144                 usb_sndintpipe(line6->usbdev, line6->properties->ep_ctrl_w),
145                 (char *)msg->buffer + done, bytes,
146                 line6_async_request_sent, msg, line6->interval);
147
148         msg->done += bytes;
149         retval = usb_submit_urb(urb, GFP_ATOMIC);
150
151         if (retval < 0) {
152                 dev_err(line6->ifcdev, "%s: usb_submit_urb failed (%d)\n",
153                         __func__, retval);
154                 usb_free_urb(urb);
155                 kfree(msg);
156                 return retval;
157         }
158
159         return 0;
160 }
161
162 /*
163         Setup and start timer.
164 */
165 void line6_start_timer(struct timer_list *timer, unsigned long msecs,
166                        void (*function)(unsigned long), unsigned long data)
167 {
168         setup_timer(timer, function, data);
169         mod_timer(timer, jiffies + msecs_to_jiffies(msecs));
170 }
171 EXPORT_SYMBOL_GPL(line6_start_timer);
172
173 /*
174         Asynchronously send raw message.
175 */
176 int line6_send_raw_message_async(struct usb_line6 *line6, const char *buffer,
177                                  int size)
178 {
179         struct message *msg;
180         struct urb *urb;
181
182         /* create message: */
183         msg = kmalloc(sizeof(struct message), GFP_ATOMIC);
184         if (msg == NULL)
185                 return -ENOMEM;
186
187         /* create URB: */
188         urb = usb_alloc_urb(0, GFP_ATOMIC);
189
190         if (urb == NULL) {
191                 kfree(msg);
192                 return -ENOMEM;
193         }
194
195         /* set message data: */
196         msg->line6 = line6;
197         msg->buffer = buffer;
198         msg->size = size;
199         msg->done = 0;
200
201         /* start sending: */
202         return line6_send_raw_message_async_part(msg, urb);
203 }
204 EXPORT_SYMBOL_GPL(line6_send_raw_message_async);
205
206 /*
207         Send asynchronous device version request.
208 */
209 int line6_version_request_async(struct usb_line6 *line6)
210 {
211         char *buffer;
212         int retval;
213
214         buffer = kmemdup(line6_request_version,
215                         sizeof(line6_request_version), GFP_ATOMIC);
216         if (buffer == NULL)
217                 return -ENOMEM;
218
219         retval = line6_send_raw_message_async(line6, buffer,
220                                               sizeof(line6_request_version));
221         kfree(buffer);
222         return retval;
223 }
224 EXPORT_SYMBOL_GPL(line6_version_request_async);
225
226 /*
227         Send sysex message in pieces of wMaxPacketSize bytes.
228 */
229 int line6_send_sysex_message(struct usb_line6 *line6, const char *buffer,
230                              int size)
231 {
232         return line6_send_raw_message(line6, buffer,
233                                       size + SYSEX_EXTRA_SIZE) -
234             SYSEX_EXTRA_SIZE;
235 }
236 EXPORT_SYMBOL_GPL(line6_send_sysex_message);
237
238 /*
239         Allocate buffer for sysex message and prepare header.
240         @param code sysex message code
241         @param size number of bytes between code and sysex end
242 */
243 char *line6_alloc_sysex_buffer(struct usb_line6 *line6, int code1, int code2,
244                                int size)
245 {
246         char *buffer = kmalloc(size + SYSEX_EXTRA_SIZE, GFP_ATOMIC);
247
248         if (!buffer)
249                 return NULL;
250
251         buffer[0] = LINE6_SYSEX_BEGIN;
252         memcpy(buffer + 1, line6_midi_id, sizeof(line6_midi_id));
253         buffer[sizeof(line6_midi_id) + 1] = code1;
254         buffer[sizeof(line6_midi_id) + 2] = code2;
255         buffer[sizeof(line6_midi_id) + 3 + size] = LINE6_SYSEX_END;
256         return buffer;
257 }
258 EXPORT_SYMBOL_GPL(line6_alloc_sysex_buffer);
259
260 /*
261         Notification of data received from the Line 6 device.
262 */
263 static void line6_data_received(struct urb *urb)
264 {
265         struct usb_line6 *line6 = (struct usb_line6 *)urb->context;
266         struct midi_buffer *mb = &line6->line6midi->midibuf_in;
267         int done;
268
269         if (urb->status == -ESHUTDOWN)
270                 return;
271
272         done =
273             line6_midibuf_write(mb, urb->transfer_buffer, urb->actual_length);
274
275         if (done < urb->actual_length) {
276                 line6_midibuf_ignore(mb, done);
277                 dev_dbg(line6->ifcdev, "%d %d buffer overflow - message skipped\n",
278                         done, urb->actual_length);
279         }
280
281         for (;;) {
282                 done =
283                     line6_midibuf_read(mb, line6->buffer_message,
284                                        LINE6_MESSAGE_MAXLEN);
285
286                 if (done == 0)
287                         break;
288
289                 line6->message_length = done;
290                 line6_midi_receive(line6, line6->buffer_message, done);
291
292                 if (line6->process_message)
293                         line6->process_message(line6);
294         }
295
296         line6_start_listen(line6);
297 }
298
299 #define LINE6_READ_WRITE_STATUS_DELAY 2  /* milliseconds */
300
301 /*
302         Read data from device.
303 */
304 int line6_read_data(struct usb_line6 *line6, int address, void *data,
305                     size_t datalen)
306 {
307         struct usb_device *usbdev = line6->usbdev;
308         int ret;
309         unsigned char len;
310
311         /* query the serial number: */
312         ret = usb_control_msg(usbdev, usb_sndctrlpipe(usbdev, 0), 0x67,
313                               USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_OUT,
314                               (datalen << 8) | 0x21, address,
315                               NULL, 0, LINE6_TIMEOUT * HZ);
316
317         if (ret < 0) {
318                 dev_err(line6->ifcdev, "read request failed (error %d)\n", ret);
319                 return ret;
320         }
321
322         /* Wait for data length. We'll get 0xff until length arrives. */
323         do {
324                 mdelay(LINE6_READ_WRITE_STATUS_DELAY);
325
326                 ret = usb_control_msg(usbdev, usb_rcvctrlpipe(usbdev, 0), 0x67,
327                                       USB_TYPE_VENDOR | USB_RECIP_DEVICE |
328                                       USB_DIR_IN,
329                                       0x0012, 0x0000, &len, 1,
330                                       LINE6_TIMEOUT * HZ);
331                 if (ret < 0) {
332                         dev_err(line6->ifcdev,
333                                 "receive length failed (error %d)\n", ret);
334                         return ret;
335                 }
336         } while (len == 0xff);
337
338         if (len != datalen) {
339                 /* should be equal or something went wrong */
340                 dev_err(line6->ifcdev,
341                         "length mismatch (expected %d, got %d)\n",
342                         (int)datalen, (int)len);
343                 return -EINVAL;
344         }
345
346         /* receive the result: */
347         ret = usb_control_msg(usbdev, usb_rcvctrlpipe(usbdev, 0), 0x67,
348                               USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
349                               0x0013, 0x0000, data, datalen,
350                               LINE6_TIMEOUT * HZ);
351
352         if (ret < 0) {
353                 dev_err(line6->ifcdev, "read failed (error %d)\n", ret);
354                 return ret;
355         }
356
357         return 0;
358 }
359 EXPORT_SYMBOL_GPL(line6_read_data);
360
361 /*
362         Write data to device.
363 */
364 int line6_write_data(struct usb_line6 *line6, int address, void *data,
365                      size_t datalen)
366 {
367         struct usb_device *usbdev = line6->usbdev;
368         int ret;
369         unsigned char status;
370
371         ret = usb_control_msg(usbdev, usb_sndctrlpipe(usbdev, 0), 0x67,
372                               USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_OUT,
373                               0x0022, address, data, datalen,
374                               LINE6_TIMEOUT * HZ);
375
376         if (ret < 0) {
377                 dev_err(line6->ifcdev,
378                         "write request failed (error %d)\n", ret);
379                 return ret;
380         }
381
382         do {
383                 mdelay(LINE6_READ_WRITE_STATUS_DELAY);
384
385                 ret = usb_control_msg(usbdev, usb_rcvctrlpipe(usbdev, 0),
386                                       0x67,
387                                       USB_TYPE_VENDOR | USB_RECIP_DEVICE |
388                                       USB_DIR_IN,
389                                       0x0012, 0x0000,
390                                       &status, 1, LINE6_TIMEOUT * HZ);
391
392                 if (ret < 0) {
393                         dev_err(line6->ifcdev,
394                                 "receiving status failed (error %d)\n", ret);
395                         return ret;
396                 }
397         } while (status == 0xff);
398
399         if (status != 0) {
400                 dev_err(line6->ifcdev, "write failed (error %d)\n", ret);
401                 return -EINVAL;
402         }
403
404         return 0;
405 }
406 EXPORT_SYMBOL_GPL(line6_write_data);
407
408 /*
409         Read Line 6 device serial number.
410         (POD, TonePort, GuitarPort)
411 */
412 int line6_read_serial_number(struct usb_line6 *line6, int *serial_number)
413 {
414         return line6_read_data(line6, 0x80d0, serial_number,
415                                sizeof(*serial_number));
416 }
417 EXPORT_SYMBOL_GPL(line6_read_serial_number);
418
419 /*
420         Card destructor.
421 */
422 static void line6_destruct(struct snd_card *card)
423 {
424         struct usb_line6 *line6 = card->private_data;
425         struct usb_device *usbdev = line6->usbdev;
426
427         /* free buffer memory first: */
428         kfree(line6->buffer_message);
429         kfree(line6->buffer_listen);
430
431         /* then free URBs: */
432         usb_free_urb(line6->urb_listen);
433
434         /* decrement reference counters: */
435         usb_put_dev(usbdev);
436 }
437
438 /* get data from endpoint descriptor (see usb_maxpacket): */
439 static void line6_get_interval(struct usb_line6 *line6)
440 {
441         struct usb_device *usbdev = line6->usbdev;
442         struct usb_host_endpoint *ep;
443         unsigned pipe = usb_rcvintpipe(usbdev, line6->properties->ep_ctrl_r);
444         unsigned epnum = usb_pipeendpoint(pipe);
445
446         ep = usbdev->ep_in[epnum];
447         if (ep) {
448                 line6->interval = ep->desc.bInterval;
449                 line6->max_packet_size = le16_to_cpu(ep->desc.wMaxPacketSize);
450         } else {
451                 dev_err(line6->ifcdev,
452                         "endpoint not available, using fallback values");
453                 line6->interval = LINE6_FALLBACK_INTERVAL;
454                 line6->max_packet_size = LINE6_FALLBACK_MAXPACKETSIZE;
455         }
456 }
457
458 static int line6_init_cap_control(struct usb_line6 *line6)
459 {
460         int ret;
461
462         /* initialize USB buffers: */
463         line6->buffer_listen = kmalloc(LINE6_BUFSIZE_LISTEN, GFP_KERNEL);
464         if (!line6->buffer_listen)
465                 return -ENOMEM;
466
467         line6->buffer_message = kmalloc(LINE6_MESSAGE_MAXLEN, GFP_KERNEL);
468         if (!line6->buffer_message)
469                 return -ENOMEM;
470
471         line6->urb_listen = usb_alloc_urb(0, GFP_KERNEL);
472         if (!line6->urb_listen)
473                 return -ENOMEM;
474
475         ret = line6_start_listen(line6);
476         if (ret < 0) {
477                 dev_err(line6->ifcdev, "cannot start listening: %d\n", ret);
478                 return ret;
479         }
480
481         return 0;
482 }
483
484 /*
485         Probe USB device.
486 */
487 int line6_probe(struct usb_interface *interface,
488                 const struct usb_device_id *id,
489                 const char *driver_name,
490                 const struct line6_properties *properties,
491                 int (*private_init)(struct usb_line6 *, const struct usb_device_id *id),
492                 size_t data_size)
493 {
494         struct usb_device *usbdev = interface_to_usbdev(interface);
495         struct snd_card *card;
496         struct usb_line6 *line6;
497         int interface_number;
498         int ret;
499
500         if (WARN_ON(data_size < sizeof(*line6)))
501                 return -EINVAL;
502
503         /* we don't handle multiple configurations */
504         if (usbdev->descriptor.bNumConfigurations != 1)
505                 return -ENODEV;
506
507         ret = snd_card_new(&interface->dev,
508                            SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
509                            THIS_MODULE, data_size, &card);
510         if (ret < 0)
511                 return ret;
512
513         /* store basic data: */
514         line6 = card->private_data;
515         line6->card = card;
516         line6->properties = properties;
517         line6->usbdev = usbdev;
518         line6->ifcdev = &interface->dev;
519
520         strcpy(card->id, properties->id);
521         strcpy(card->driver, driver_name);
522         strcpy(card->shortname, properties->name);
523         sprintf(card->longname, "Line 6 %s at USB %s", properties->name,
524                 dev_name(line6->ifcdev));
525         card->private_free = line6_destruct;
526
527         usb_set_intfdata(interface, line6);
528
529         /* increment reference counters: */
530         usb_get_dev(usbdev);
531
532         /* initialize device info: */
533         dev_info(&interface->dev, "Line 6 %s found\n", properties->name);
534
535         /* query interface number */
536         interface_number = interface->cur_altsetting->desc.bInterfaceNumber;
537
538         ret = usb_set_interface(usbdev, interface_number,
539                                 properties->altsetting);
540         if (ret < 0) {
541                 dev_err(&interface->dev, "set_interface failed\n");
542                 goto error;
543         }
544
545         line6_get_interval(line6);
546
547         if (properties->capabilities & LINE6_CAP_CONTROL) {
548                 ret = line6_init_cap_control(line6);
549                 if (ret < 0)
550                         goto error;
551         }
552
553         /* initialize device data based on device: */
554         ret = private_init(line6, id);
555         if (ret < 0)
556                 goto error;
557
558         /* creation of additional special files should go here */
559
560         dev_info(&interface->dev, "Line 6 %s now attached\n",
561                  properties->name);
562
563         return 0;
564
565  error:
566         if (line6->disconnect)
567                 line6->disconnect(line6);
568         snd_card_free(card);
569         return ret;
570 }
571 EXPORT_SYMBOL_GPL(line6_probe);
572
573 /*
574         Line 6 device disconnected.
575 */
576 void line6_disconnect(struct usb_interface *interface)
577 {
578         struct usb_line6 *line6 = usb_get_intfdata(interface);
579         struct usb_device *usbdev = interface_to_usbdev(interface);
580
581         if (!line6)
582                 return;
583
584         if (WARN_ON(usbdev != line6->usbdev))
585                 return;
586
587         if (line6->urb_listen != NULL)
588                 line6_stop_listen(line6);
589
590         snd_card_disconnect(line6->card);
591         if (line6->line6pcm)
592                 line6_pcm_disconnect(line6->line6pcm);
593         if (line6->disconnect)
594                 line6->disconnect(line6);
595
596         dev_info(&interface->dev, "Line 6 %s now disconnected\n",
597                  line6->properties->name);
598
599         /* make sure the device isn't destructed twice: */
600         usb_set_intfdata(interface, NULL);
601
602         snd_card_free_when_closed(line6->card);
603 }
604 EXPORT_SYMBOL_GPL(line6_disconnect);
605
606 #ifdef CONFIG_PM
607
608 /*
609         Suspend Line 6 device.
610 */
611 int line6_suspend(struct usb_interface *interface, pm_message_t message)
612 {
613         struct usb_line6 *line6 = usb_get_intfdata(interface);
614         struct snd_line6_pcm *line6pcm = line6->line6pcm;
615
616         snd_power_change_state(line6->card, SNDRV_CTL_POWER_D3hot);
617
618         if (line6->properties->capabilities & LINE6_CAP_CONTROL)
619                 line6_stop_listen(line6);
620
621         if (line6pcm != NULL) {
622                 snd_pcm_suspend_all(line6pcm->pcm);
623                 line6pcm->flags = 0;
624         }
625
626         return 0;
627 }
628 EXPORT_SYMBOL_GPL(line6_suspend);
629
630 /*
631         Resume Line 6 device.
632 */
633 int line6_resume(struct usb_interface *interface)
634 {
635         struct usb_line6 *line6 = usb_get_intfdata(interface);
636
637         if (line6->properties->capabilities & LINE6_CAP_CONTROL)
638                 line6_start_listen(line6);
639
640         snd_power_change_state(line6->card, SNDRV_CTL_POWER_D0);
641         return 0;
642 }
643 EXPORT_SYMBOL_GPL(line6_resume);
644
645 #endif /* CONFIG_PM */
646
647 MODULE_AUTHOR(DRIVER_AUTHOR);
648 MODULE_DESCRIPTION(DRIVER_DESC);
649 MODULE_LICENSE("GPL");