diff options
-rw-r--r-- | drivers/staging/line6/midi.c | 102 |
1 files changed, 59 insertions, 43 deletions
diff --git a/drivers/staging/line6/midi.c b/drivers/staging/line6/midi.c index f72681963e44..89a2b17e9caf 100644 --- a/drivers/staging/line6/midi.c +++ b/drivers/staging/line6/midi.c | |||
@@ -26,19 +26,23 @@ | |||
26 | #define OUTPUT_DUMP_ONLY 0 | 26 | #define OUTPUT_DUMP_ONLY 0 |
27 | 27 | ||
28 | 28 | ||
29 | #define line6_rawmidi_substream_midi(substream) ((struct snd_line6_midi *)((substream)->rmidi->private_data)) | 29 | #define line6_rawmidi_substream_midi(substream) \ |
30 | ((struct snd_line6_midi *)((substream)->rmidi->private_data)) | ||
30 | 31 | ||
31 | 32 | ||
32 | static int send_midi_async(struct usb_line6 *line6, unsigned char *data, int length); | 33 | static int send_midi_async(struct usb_line6 *line6, unsigned char *data, |
34 | int length); | ||
33 | 35 | ||
34 | 36 | ||
35 | /* | 37 | /* |
36 | Pass data received via USB to MIDI. | 38 | Pass data received via USB to MIDI. |
37 | */ | 39 | */ |
38 | void line6_midi_receive(struct usb_line6 *line6, unsigned char *data, int length) | 40 | void line6_midi_receive(struct usb_line6 *line6, unsigned char *data, |
41 | int length) | ||
39 | { | 42 | { |
40 | if(line6->line6midi->substream_receive) | 43 | if (line6->line6midi->substream_receive) |
41 | snd_rawmidi_receive(line6->line6midi->substream_receive, data, length); | 44 | snd_rawmidi_receive(line6->line6midi->substream_receive, |
45 | data, length); | ||
42 | } | 46 | } |
43 | 47 | ||
44 | /* | 48 | /* |
@@ -55,11 +59,11 @@ static void line6_midi_transmit(struct snd_rawmidi_substream *substream) | |||
55 | 59 | ||
56 | spin_lock_irqsave(&line6->line6midi->midi_transmit_lock, flags); | 60 | spin_lock_irqsave(&line6->line6midi->midi_transmit_lock, flags); |
57 | 61 | ||
58 | for(;;) { | 62 | for (;;) { |
59 | req = min(midibuf_bytes_free(mb), line6->max_packet_size); | 63 | req = min(midibuf_bytes_free(mb), line6->max_packet_size); |
60 | done = snd_rawmidi_transmit_peek(substream, chunk, req); | 64 | done = snd_rawmidi_transmit_peek(substream, chunk, req); |
61 | 65 | ||
62 | if(done == 0) | 66 | if (done == 0) |
63 | break; | 67 | break; |
64 | 68 | ||
65 | #if DO_DUMP_MIDI_SEND | 69 | #if DO_DUMP_MIDI_SEND |
@@ -69,13 +73,13 @@ static void line6_midi_transmit(struct snd_rawmidi_substream *substream) | |||
69 | snd_rawmidi_transmit_ack(substream, done); | 73 | snd_rawmidi_transmit_ack(substream, done); |
70 | } | 74 | } |
71 | 75 | ||
72 | for(;;) { | 76 | for (;;) { |
73 | done = midibuf_read(mb, chunk, line6->max_packet_size); | 77 | done = midibuf_read(mb, chunk, line6->max_packet_size); |
74 | 78 | ||
75 | if(done == 0) | 79 | if (done == 0) |
76 | break; | 80 | break; |
77 | 81 | ||
78 | if(midibuf_skip_message(mb, line6midi->midi_mask_transmit)) | 82 | if (midibuf_skip_message(mb, line6midi->midi_mask_transmit)) |
79 | continue; | 83 | continue; |
80 | 84 | ||
81 | send_midi_async(line6, chunk, done); | 85 | send_midi_async(line6, chunk, done); |
@@ -98,18 +102,18 @@ static void midi_sent(struct urb *urb) | |||
98 | kfree(urb->transfer_buffer); | 102 | kfree(urb->transfer_buffer); |
99 | usb_free_urb(urb); | 103 | usb_free_urb(urb); |
100 | 104 | ||
101 | if(status == -ESHUTDOWN) | 105 | if (status == -ESHUTDOWN) |
102 | return; | 106 | return; |
103 | 107 | ||
104 | spin_lock_irqsave(&line6->line6midi->send_urb_lock, flags); | 108 | spin_lock_irqsave(&line6->line6midi->send_urb_lock, flags); |
105 | num = --line6->line6midi->num_active_send_urbs; | 109 | num = --line6->line6midi->num_active_send_urbs; |
106 | 110 | ||
107 | if(num == 0) { | 111 | if (num == 0) { |
108 | line6_midi_transmit(line6->line6midi->substream_transmit); | 112 | line6_midi_transmit(line6->line6midi->substream_transmit); |
109 | num = line6->line6midi->num_active_send_urbs; | 113 | num = line6->line6midi->num_active_send_urbs; |
110 | } | 114 | } |
111 | 115 | ||
112 | if(num == 0) | 116 | if (num == 0) |
113 | wake_up_interruptible(&line6->line6midi->send_wait); | 117 | wake_up_interruptible(&line6->line6midi->send_wait); |
114 | 118 | ||
115 | spin_unlock_irqrestore(&line6->line6midi->send_urb_lock, flags); | 119 | spin_unlock_irqrestore(&line6->line6midi->send_urb_lock, flags); |
@@ -120,7 +124,8 @@ static void midi_sent(struct urb *urb) | |||
120 | Assumes that line6->line6midi->send_urb_lock is held | 124 | Assumes that line6->line6midi->send_urb_lock is held |
121 | (i.e., this function is serialized). | 125 | (i.e., this function is serialized). |
122 | */ | 126 | */ |
123 | static int send_midi_async(struct usb_line6 *line6, unsigned char *data, int length) | 127 | static int send_midi_async(struct usb_line6 *line6, unsigned char *data, |
128 | int length) | ||
124 | { | 129 | { |
125 | struct urb *urb; | 130 | struct urb *urb; |
126 | int retval; | 131 | int retval; |
@@ -128,7 +133,7 @@ static int send_midi_async(struct usb_line6 *line6, unsigned char *data, int len | |||
128 | 133 | ||
129 | urb = usb_alloc_urb(0, GFP_ATOMIC); | 134 | urb = usb_alloc_urb(0, GFP_ATOMIC); |
130 | 135 | ||
131 | if(urb == 0) { | 136 | if (urb == 0) { |
132 | dev_err(line6->ifcdev, "Out of memory\n"); | 137 | dev_err(line6->ifcdev, "Out of memory\n"); |
133 | return -ENOMEM; | 138 | return -ENOMEM; |
134 | } | 139 | } |
@@ -137,23 +142,24 @@ static int send_midi_async(struct usb_line6 *line6, unsigned char *data, int len | |||
137 | line6_write_hexdump(line6, 'S', data, length); | 142 | line6_write_hexdump(line6, 'S', data, length); |
138 | #endif | 143 | #endif |
139 | 144 | ||
140 | transfer_buffer = (unsigned char *)kmalloc(length, GFP_ATOMIC); | 145 | transfer_buffer = kmalloc(length, GFP_ATOMIC); |
141 | 146 | ||
142 | if(transfer_buffer == 0) { | 147 | if (transfer_buffer == 0) { |
143 | usb_free_urb(urb); | 148 | usb_free_urb(urb); |
144 | dev_err(line6->ifcdev, "Out of memory\n"); | 149 | dev_err(line6->ifcdev, "Out of memory\n"); |
145 | return -ENOMEM; | 150 | return -ENOMEM; |
146 | } | 151 | } |
147 | 152 | ||
148 | memcpy(transfer_buffer, data, length); | 153 | memcpy(transfer_buffer, data, length); |
149 | usb_fill_int_urb(urb, | 154 | usb_fill_int_urb(urb, line6->usbdev, |
150 | line6->usbdev, | 155 | usb_sndbulkpipe(line6->usbdev, |
151 | usb_sndbulkpipe(line6->usbdev, line6->ep_control_write), | 156 | line6->ep_control_write), |
152 | transfer_buffer, length, midi_sent, line6, line6->interval); | 157 | transfer_buffer, length, midi_sent, line6, |
158 | line6->interval); | ||
153 | urb->actual_length = 0; | 159 | urb->actual_length = 0; |
154 | retval = usb_submit_urb(urb, GFP_ATOMIC); | 160 | retval = usb_submit_urb(urb, GFP_ATOMIC); |
155 | 161 | ||
156 | if(retval < 0) { | 162 | if (retval < 0) { |
157 | dev_err(line6->ifcdev, "usb_submit_urb failed\n"); | 163 | dev_err(line6->ifcdev, "usb_submit_urb failed\n"); |
158 | usb_free_urb(urb); | 164 | usb_free_urb(urb); |
159 | return -EINVAL; | 165 | return -EINVAL; |
@@ -161,7 +167,7 @@ static int send_midi_async(struct usb_line6 *line6, unsigned char *data, int len | |||
161 | 167 | ||
162 | ++line6->line6midi->num_active_send_urbs; | 168 | ++line6->line6midi->num_active_send_urbs; |
163 | 169 | ||
164 | switch(line6->usbdev->descriptor.idProduct) { | 170 | switch (line6->usbdev->descriptor.idProduct) { |
165 | case LINE6_DEVID_BASSPODXT: | 171 | case LINE6_DEVID_BASSPODXT: |
166 | case LINE6_DEVID_BASSPODXTLIVE: | 172 | case LINE6_DEVID_BASSPODXTLIVE: |
167 | case LINE6_DEVID_BASSPODXTPRO: | 173 | case LINE6_DEVID_BASSPODXTPRO: |
@@ -169,7 +175,8 @@ static int send_midi_async(struct usb_line6 *line6, unsigned char *data, int len | |||
169 | case LINE6_DEVID_PODXTLIVE: | 175 | case LINE6_DEVID_PODXTLIVE: |
170 | case LINE6_DEVID_PODXTPRO: | 176 | case LINE6_DEVID_PODXTPRO: |
171 | case LINE6_DEVID_POCKETPOD: | 177 | case LINE6_DEVID_POCKETPOD: |
172 | pod_midi_postprocess((struct usb_line6_pod *)line6, data, length); | 178 | pod_midi_postprocess((struct usb_line6_pod *)line6, data, |
179 | length); | ||
173 | break; | 180 | break; |
174 | 181 | ||
175 | default: | 182 | default: |
@@ -189,7 +196,8 @@ static int line6_midi_output_close(struct snd_rawmidi_substream *substream) | |||
189 | return 0; | 196 | return 0; |
190 | } | 197 | } |
191 | 198 | ||
192 | static void line6_midi_output_trigger(struct snd_rawmidi_substream *substream, int up) | 199 | static void line6_midi_output_trigger(struct snd_rawmidi_substream *substream, |
200 | int up) | ||
193 | { | 201 | { |
194 | unsigned long flags; | 202 | unsigned long flags; |
195 | struct usb_line6 *line6 = line6_rawmidi_substream_midi(substream)->line6; | 203 | struct usb_line6 *line6 = line6_rawmidi_substream_midi(substream)->line6; |
@@ -197,7 +205,7 @@ static void line6_midi_output_trigger(struct snd_rawmidi_substream *substream, i | |||
197 | line6->line6midi->substream_transmit = substream; | 205 | line6->line6midi->substream_transmit = substream; |
198 | spin_lock_irqsave(&line6->line6midi->send_urb_lock, flags); | 206 | spin_lock_irqsave(&line6->line6midi->send_urb_lock, flags); |
199 | 207 | ||
200 | if(line6->line6midi->num_active_send_urbs == 0) | 208 | if (line6->line6midi->num_active_send_urbs == 0) |
201 | line6_midi_transmit(substream); | 209 | line6_midi_transmit(substream); |
202 | 210 | ||
203 | spin_unlock_irqrestore(&line6->line6midi->send_urb_lock, flags); | 211 | spin_unlock_irqrestore(&line6->line6midi->send_urb_lock, flags); |
@@ -211,8 +219,8 @@ static void line6_midi_output_drain(struct snd_rawmidi_substream *substream) | |||
211 | add_wait_queue(head, &wait); | 219 | add_wait_queue(head, &wait); |
212 | current->state = TASK_INTERRUPTIBLE; | 220 | current->state = TASK_INTERRUPTIBLE; |
213 | 221 | ||
214 | while(line6->line6midi->num_active_send_urbs > 0) | 222 | while (line6->line6midi->num_active_send_urbs > 0) |
215 | if(signal_pending(current)) | 223 | if (signal_pending(current)) |
216 | break; | 224 | break; |
217 | else | 225 | else |
218 | schedule(); | 226 | schedule(); |
@@ -231,11 +239,12 @@ static int line6_midi_input_close(struct snd_rawmidi_substream *substream) | |||
231 | return 0; | 239 | return 0; |
232 | } | 240 | } |
233 | 241 | ||
234 | static void line6_midi_input_trigger(struct snd_rawmidi_substream *substream, int up) | 242 | static void line6_midi_input_trigger(struct snd_rawmidi_substream *substream, |
243 | int up) | ||
235 | { | 244 | { |
236 | struct usb_line6 *line6 = line6_rawmidi_substream_midi(substream)->line6; | 245 | struct usb_line6 *line6 = line6_rawmidi_substream_midi(substream)->line6; |
237 | 246 | ||
238 | if(up) | 247 | if (up) |
239 | line6->line6midi->substream_receive = substream; | 248 | line6->line6midi->substream_receive = substream; |
240 | else | 249 | else |
241 | line6->line6midi->substream_receive = 0; | 250 | line6->line6midi->substream_receive = 0; |
@@ -267,7 +276,9 @@ static int snd_line6_new_midi(struct snd_line6_midi *line6midi) | |||
267 | struct snd_rawmidi *rmidi; | 276 | struct snd_rawmidi *rmidi; |
268 | int err; | 277 | int err; |
269 | 278 | ||
270 | if((err = snd_rawmidi_new(line6midi->line6->card, "Line6 MIDI", 0, 1, 1, &rmidi)) < 0) | 279 | err = snd_rawmidi_new(line6midi->line6->card, "Line6 MIDI", 0, 1, 1, |
280 | &rmidi); | ||
281 | if (err < 0) | ||
271 | return err; | 282 | return err; |
272 | 283 | ||
273 | rmidi->private_data = line6midi; | 284 | rmidi->private_data = line6midi; |
@@ -279,8 +290,10 @@ static int snd_line6_new_midi(struct snd_line6_midi *line6midi) | |||
279 | SNDRV_RAWMIDI_INFO_INPUT | | 290 | SNDRV_RAWMIDI_INFO_INPUT | |
280 | SNDRV_RAWMIDI_INFO_DUPLEX; | 291 | SNDRV_RAWMIDI_INFO_DUPLEX; |
281 | 292 | ||
282 | snd_rawmidi_set_ops(rmidi, SNDRV_RAWMIDI_STREAM_OUTPUT, &line6_midi_output_ops); | 293 | snd_rawmidi_set_ops(rmidi, SNDRV_RAWMIDI_STREAM_OUTPUT, |
283 | snd_rawmidi_set_ops(rmidi, SNDRV_RAWMIDI_STREAM_INPUT, &line6_midi_input_ops); | 294 | &line6_midi_output_ops); |
295 | snd_rawmidi_set_ops(rmidi, SNDRV_RAWMIDI_STREAM_INPUT, | ||
296 | &line6_midi_input_ops); | ||
284 | return 0; | 297 | return 0; |
285 | } | 298 | } |
286 | 299 | ||
@@ -362,22 +375,20 @@ int line6_init_midi(struct usb_line6 *line6) | |||
362 | int err; | 375 | int err; |
363 | struct snd_line6_midi *line6midi; | 376 | struct snd_line6_midi *line6midi; |
364 | 377 | ||
365 | if(!(line6->properties->capabilities & LINE6_BIT_CONTROL)) | 378 | if (!(line6->properties->capabilities & LINE6_BIT_CONTROL)) |
366 | return 0; /* skip MIDI initialization and report success */ | 379 | return 0; /* skip MIDI initialization and report success */ |
367 | 380 | ||
368 | line6midi = kzalloc(sizeof(struct snd_line6_midi), GFP_KERNEL); | 381 | line6midi = kzalloc(sizeof(struct snd_line6_midi), GFP_KERNEL); |
369 | 382 | ||
370 | if(line6midi == NULL) | 383 | if (line6midi == NULL) |
371 | return -ENOMEM; | 384 | return -ENOMEM; |
372 | 385 | ||
373 | err = midibuf_init(&line6midi->midibuf_in, MIDI_BUFFER_SIZE, 0); | 386 | err = midibuf_init(&line6midi->midibuf_in, MIDI_BUFFER_SIZE, 0); |
374 | 387 | if (err < 0) | |
375 | if(err < 0) | ||
376 | return err; | 388 | return err; |
377 | 389 | ||
378 | err = midibuf_init(&line6midi->midibuf_out, MIDI_BUFFER_SIZE, 1); | 390 | err = midibuf_init(&line6midi->midibuf_out, MIDI_BUFFER_SIZE, 1); |
379 | 391 | if (err < 0) | |
380 | if(err < 0) | ||
381 | return err; | 392 | return err; |
382 | 393 | ||
383 | line6midi->line6 = line6; | 394 | line6midi->line6 = line6; |
@@ -385,18 +396,23 @@ int line6_init_midi(struct usb_line6 *line6) | |||
385 | line6midi->midi_mask_receive = 4; | 396 | line6midi->midi_mask_receive = 4; |
386 | line6->line6midi = line6midi; | 397 | line6->line6midi = line6midi; |
387 | 398 | ||
388 | if((err = snd_device_new(line6->card, SNDRV_DEV_RAWMIDI, line6midi, &midi_ops)) < 0) | 399 | err = snd_device_new(line6->card, SNDRV_DEV_RAWMIDI, line6midi, |
400 | &midi_ops); | ||
401 | if (err < 0) | ||
389 | return err; | 402 | return err; |
390 | 403 | ||
391 | snd_card_set_dev(line6->card, line6->ifcdev); | 404 | snd_card_set_dev(line6->card, line6->ifcdev); |
392 | 405 | ||
393 | if((err = snd_line6_new_midi(line6midi)) < 0) | 406 | err = snd_line6_new_midi(line6midi); |
407 | if (err < 0) | ||
394 | return err; | 408 | return err; |
395 | 409 | ||
396 | if((err = device_create_file(line6->ifcdev, &dev_attr_midi_mask_transmit)) < 0) | 410 | err = device_create_file(line6->ifcdev, &dev_attr_midi_mask_transmit); |
411 | if (err < 0) | ||
397 | return err; | 412 | return err; |
398 | 413 | ||
399 | if((err = device_create_file(line6->ifcdev, &dev_attr_midi_mask_receive)) < 0) | 414 | err = device_create_file(line6->ifcdev, &dev_attr_midi_mask_receive); |
415 | if (err < 0) | ||
400 | return err; | 416 | return err; |
401 | 417 | ||
402 | init_waitqueue_head(&line6midi->send_wait); | 418 | init_waitqueue_head(&line6midi->send_wait); |