Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 1 | /* |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 2 | * Line6 Linux USB driver - 0.9.1beta |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 3 | * |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 4 | * Copyright (C) 2004-2010 Markus Grabner (grabner@icg.tugraz.at) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 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 | |
Stefan Hajnoczi | 140e28b | 2011-11-23 08:20:45 +0000 | [diff] [blame] | 12 | #include <linux/slab.h> |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 13 | #include <sound/core.h> |
| 14 | #include <sound/pcm.h> |
| 15 | #include <sound/pcm_params.h> |
| 16 | |
| 17 | #include "audio.h" |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 18 | #include "capture.h" |
| 19 | #include "driver.h" |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 20 | #include "pcm.h" |
| 21 | #include "pod.h" |
Greg Kroah-Hartman | b702ed25 | 2009-02-27 20:45:03 -0800 | [diff] [blame] | 22 | #include "playback.h" |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 23 | |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 24 | /* |
| 25 | Software stereo volume control. |
| 26 | */ |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 27 | static void change_volume(struct urb *urb_out, int volume[], |
| 28 | int bytes_per_frame) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 29 | { |
| 30 | int chn = 0; |
| 31 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 32 | if (volume[0] == 256 && volume[1] == 256) |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 33 | return; /* maximum volume - no change */ |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 34 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 35 | if (bytes_per_frame == 4) { |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 36 | short *p, *buf_end; |
| 37 | p = (short *)urb_out->transfer_buffer; |
| 38 | buf_end = p + urb_out->transfer_buffer_length / sizeof(*p); |
| 39 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 40 | for (; p < buf_end; ++p) { |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 41 | *p = (*p * volume[chn & 1]) >> 8; |
| 42 | ++chn; |
| 43 | } |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 44 | } else if (bytes_per_frame == 6) { |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 45 | unsigned char *p, *buf_end; |
| 46 | p = (unsigned char *)urb_out->transfer_buffer; |
| 47 | buf_end = p + urb_out->transfer_buffer_length; |
| 48 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 49 | for (; p < buf_end; p += 3) { |
| 50 | int val; |
| 51 | val = p[0] + (p[1] << 8) + ((signed char)p[2] << 16); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 52 | val = (val * volume[chn & 1]) >> 8; |
| 53 | p[0] = val; |
| 54 | p[1] = val >> 8; |
| 55 | p[2] = val >> 16; |
| 56 | ++chn; |
| 57 | } |
| 58 | } |
| 59 | } |
| 60 | |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 61 | #ifdef CONFIG_LINE6_USB_IMPULSE_RESPONSE |
| 62 | |
| 63 | /* |
| 64 | Create signal for impulse response test. |
| 65 | */ |
| 66 | static void create_impulse_test_signal(struct snd_line6_pcm *line6pcm, |
| 67 | struct urb *urb_out, int bytes_per_frame) |
| 68 | { |
| 69 | int frames = urb_out->transfer_buffer_length / bytes_per_frame; |
| 70 | |
| 71 | if (bytes_per_frame == 4) { |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 72 | int i; |
| 73 | short *pi = (short *)line6pcm->prev_fbuf; |
| 74 | short *po = (short *)urb_out->transfer_buffer; |
| 75 | |
| 76 | for (i = 0; i < frames; ++i) { |
| 77 | po[0] = pi[0]; |
| 78 | po[1] = 0; |
| 79 | pi += 2; |
| 80 | po += 2; |
| 81 | } |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 82 | } else if (bytes_per_frame == 6) { |
| 83 | int i, j; |
| 84 | unsigned char *pi = line6pcm->prev_fbuf; |
| 85 | unsigned char *po = urb_out->transfer_buffer; |
| 86 | |
| 87 | for (i = 0; i < frames; ++i) { |
| 88 | for (j = 0; j < bytes_per_frame / 2; ++j) |
| 89 | po[j] = pi[j]; |
| 90 | |
| 91 | for (; j < bytes_per_frame; ++j) |
| 92 | po[j] = 0; |
| 93 | |
| 94 | pi += bytes_per_frame; |
| 95 | po += bytes_per_frame; |
| 96 | } |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 97 | } |
| 98 | if (--line6pcm->impulse_count <= 0) { |
| 99 | ((unsigned char *)(urb_out->transfer_buffer))[bytes_per_frame - |
| 100 | 1] = |
| 101 | line6pcm->impulse_volume; |
| 102 | line6pcm->impulse_count = line6pcm->impulse_period; |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 103 | } |
| 104 | } |
| 105 | |
| 106 | #endif |
| 107 | |
| 108 | /* |
| 109 | Add signal to buffer for software monitoring. |
| 110 | */ |
| 111 | static void add_monitor_signal(struct urb *urb_out, unsigned char *signal, |
| 112 | int volume, int bytes_per_frame) |
| 113 | { |
| 114 | if (volume == 0) |
| 115 | return; /* zero volume - no change */ |
| 116 | |
| 117 | if (bytes_per_frame == 4) { |
| 118 | short *pi, *po, *buf_end; |
| 119 | pi = (short *)signal; |
| 120 | po = (short *)urb_out->transfer_buffer; |
| 121 | buf_end = po + urb_out->transfer_buffer_length / sizeof(*po); |
| 122 | |
| 123 | for (; po < buf_end; ++pi, ++po) |
| 124 | *po += (*pi * volume) >> 8; |
| 125 | } |
| 126 | |
| 127 | /* |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 128 | We don't need to handle devices with 6 bytes per frame here |
| 129 | since they all support hardware monitoring. |
| 130 | */ |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 131 | } |
| 132 | |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 133 | /* |
| 134 | Find a free URB, prepare audio data, and submit URB. |
| 135 | */ |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 136 | static int submit_audio_out_urb(struct snd_line6_pcm *line6pcm) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 137 | { |
| 138 | int index; |
| 139 | unsigned long flags; |
| 140 | int i, urb_size, urb_frames; |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 141 | int ret; |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 142 | const int bytes_per_frame = line6pcm->properties->bytes_per_frame; |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 143 | const int frame_increment = |
| 144 | line6pcm->properties->snd_line6_rates.rats[0].num_min; |
| 145 | const int frame_factor = |
| 146 | line6pcm->properties->snd_line6_rates.rats[0].den * |
| 147 | (USB_INTERVALS_PER_SECOND / LINE6_ISO_INTERVAL); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 148 | struct urb *urb_out; |
| 149 | |
| 150 | spin_lock_irqsave(&line6pcm->lock_audio_out, flags); |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 151 | index = |
| 152 | find_first_zero_bit(&line6pcm->active_urb_out, LINE6_ISO_BUFFERS); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 153 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 154 | if (index < 0 || index >= LINE6_ISO_BUFFERS) { |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 155 | spin_unlock_irqrestore(&line6pcm->lock_audio_out, flags); |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 156 | dev_err(line6pcm->line6->ifcdev, "no free URB found\n"); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 157 | return -EINVAL; |
| 158 | } |
| 159 | |
| 160 | urb_out = line6pcm->urb_audio_out[index]; |
| 161 | urb_size = 0; |
| 162 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 163 | for (i = 0; i < LINE6_ISO_PACKETS; ++i) { |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 164 | /* compute frame size for given sampling rate */ |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 165 | int fsize = 0; |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 166 | struct usb_iso_packet_descriptor *fout = |
| 167 | &urb_out->iso_frame_desc[i]; |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 168 | |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 169 | if (line6pcm->flags & LINE6_BITS_CAPTURE_STREAM) |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 170 | fsize = line6pcm->prev_fsize; |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 171 | |
| 172 | if (fsize == 0) { |
| 173 | int n; |
| 174 | line6pcm->count_out += frame_increment; |
| 175 | n = line6pcm->count_out / frame_factor; |
| 176 | line6pcm->count_out -= n * frame_factor; |
| 177 | fsize = n * bytes_per_frame; |
| 178 | } |
| 179 | |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 180 | fout->offset = urb_size; |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 181 | fout->length = fsize; |
| 182 | urb_size += fsize; |
| 183 | } |
| 184 | |
| 185 | if (urb_size == 0) { |
| 186 | /* can't determine URB size */ |
| 187 | spin_unlock_irqrestore(&line6pcm->lock_audio_out, flags); |
| 188 | dev_err(line6pcm->line6->ifcdev, "driver bug: urb_size = 0\n"); /* this is somewhat paranoid */ |
| 189 | return -EINVAL; |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 190 | } |
| 191 | |
| 192 | urb_frames = urb_size / bytes_per_frame; |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 193 | urb_out->transfer_buffer = |
| 194 | line6pcm->buffer_out + |
Stefan Hajnoczi | 153e387 | 2011-12-10 02:12:29 +0100 | [diff] [blame] | 195 | index * LINE6_ISO_PACKETS * line6pcm->max_packet_size; |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 196 | urb_out->transfer_buffer_length = urb_size; |
| 197 | urb_out->context = line6pcm; |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 198 | |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 199 | if (test_bit(LINE6_INDEX_PCM_ALSA_PLAYBACK_STREAM, &line6pcm->flags) && |
| 200 | !test_bit(LINE6_INDEX_PAUSE_PLAYBACK, &line6pcm->flags)) { |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 201 | struct snd_pcm_runtime *runtime = |
| 202 | get_substream(line6pcm, SNDRV_PCM_STREAM_PLAYBACK)->runtime; |
| 203 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 204 | if (line6pcm->pos_out + urb_frames > runtime->buffer_size) { |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 205 | /* |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 206 | The transferred area goes over buffer boundary, |
| 207 | copy the data to the temp buffer. |
| 208 | */ |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 209 | int len; |
| 210 | len = runtime->buffer_size - line6pcm->pos_out; |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 211 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 212 | if (len > 0) { |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 213 | memcpy(urb_out->transfer_buffer, |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 214 | runtime->dma_area + |
| 215 | line6pcm->pos_out * bytes_per_frame, |
| 216 | len * bytes_per_frame); |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 217 | memcpy(urb_out->transfer_buffer + |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 218 | len * bytes_per_frame, runtime->dma_area, |
| 219 | (urb_frames - len) * bytes_per_frame); |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 220 | } else |
| 221 | dev_err(line6pcm->line6->ifcdev, "driver bug: len = %d\n", len); /* this is somewhat paranoid */ |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 222 | } else { |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 223 | memcpy(urb_out->transfer_buffer, |
| 224 | runtime->dma_area + |
| 225 | line6pcm->pos_out * bytes_per_frame, |
| 226 | urb_out->transfer_buffer_length); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 227 | } |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 228 | |
Greg Kroah-Hartman | 027360c | 2010-09-21 16:58:00 -0700 | [diff] [blame] | 229 | line6pcm->pos_out += urb_frames; |
| 230 | if (line6pcm->pos_out >= runtime->buffer_size) |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 231 | line6pcm->pos_out -= runtime->buffer_size; |
| 232 | } else { |
| 233 | memset(urb_out->transfer_buffer, 0, |
| 234 | urb_out->transfer_buffer_length); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 235 | } |
| 236 | |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 237 | change_volume(urb_out, line6pcm->volume_playback, bytes_per_frame); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 238 | |
Peter Huewe | 597a1e7 | 2010-12-07 23:38:02 +0100 | [diff] [blame] | 239 | if (line6pcm->prev_fbuf != NULL) { |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 240 | #ifdef CONFIG_LINE6_USB_IMPULSE_RESPONSE |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 241 | if (line6pcm->flags & LINE6_BITS_PCM_IMPULSE) { |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 242 | create_impulse_test_signal(line6pcm, urb_out, |
| 243 | bytes_per_frame); |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 244 | if (line6pcm->flags & LINE6_BIT_PCM_ALSA_CAPTURE_STREAM) { |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 245 | line6_capture_copy(line6pcm, |
| 246 | urb_out->transfer_buffer, |
| 247 | urb_out-> |
| 248 | transfer_buffer_length); |
| 249 | line6_capture_check_period(line6pcm, |
| 250 | urb_out->transfer_buffer_length); |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 251 | } |
| 252 | } else { |
| 253 | #endif |
| 254 | if (! |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 255 | (line6pcm->line6-> |
| 256 | properties->capabilities & LINE6_BIT_HWMON) |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 257 | && (line6pcm->flags & LINE6_BITS_PLAYBACK_STREAM) |
| 258 | && (line6pcm->flags & LINE6_BITS_CAPTURE_STREAM)) |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 259 | add_monitor_signal(urb_out, line6pcm->prev_fbuf, |
| 260 | line6pcm->volume_monitor, |
| 261 | bytes_per_frame); |
| 262 | #ifdef CONFIG_LINE6_USB_IMPULSE_RESPONSE |
| 263 | } |
| 264 | #endif |
| 265 | } |
| 266 | #ifdef CONFIG_LINE6_USB_DUMP_PCM |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 267 | for (i = 0; i < LINE6_ISO_PACKETS; ++i) { |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 268 | struct usb_iso_packet_descriptor *fout = |
| 269 | &urb_out->iso_frame_desc[i]; |
| 270 | line6_write_hexdump(line6pcm->line6, 'P', |
| 271 | urb_out->transfer_buffer + fout->offset, |
| 272 | fout->length); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 273 | } |
| 274 | #endif |
| 275 | |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 276 | ret = usb_submit_urb(urb_out, GFP_ATOMIC); |
| 277 | |
| 278 | if (ret == 0) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 279 | set_bit(index, &line6pcm->active_urb_out); |
| 280 | else |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 281 | dev_err(line6pcm->line6->ifcdev, |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 282 | "URB out #%d submission failed (%d)\n", index, ret); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 283 | |
| 284 | spin_unlock_irqrestore(&line6pcm->lock_audio_out, flags); |
| 285 | return 0; |
| 286 | } |
| 287 | |
| 288 | /* |
| 289 | Submit all currently available playback URBs. |
| 290 | */ |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 291 | int line6_submit_audio_out_all_urbs(struct snd_line6_pcm *line6pcm) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 292 | { |
| 293 | int ret, i; |
| 294 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 295 | for (i = 0; i < LINE6_ISO_BUFFERS; ++i) { |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 296 | ret = submit_audio_out_urb(line6pcm); |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 297 | if (ret < 0) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 298 | return ret; |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 299 | } |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 300 | |
| 301 | return 0; |
| 302 | } |
| 303 | |
| 304 | /* |
| 305 | Unlink all currently active playback URBs. |
| 306 | */ |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 307 | void line6_unlink_audio_out_urbs(struct snd_line6_pcm *line6pcm) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 308 | { |
| 309 | unsigned int i; |
| 310 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 311 | for (i = LINE6_ISO_BUFFERS; i--;) { |
| 312 | if (test_bit(i, &line6pcm->active_urb_out)) { |
| 313 | if (!test_and_set_bit(i, &line6pcm->unlink_urb_out)) { |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 314 | struct urb *u = line6pcm->urb_audio_out[i]; |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 315 | usb_unlink_urb(u); |
| 316 | } |
| 317 | } |
| 318 | } |
| 319 | } |
| 320 | |
| 321 | /* |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 322 | Wait until unlinking of all currently active playback URBs has been finished. |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 323 | */ |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 324 | void line6_wait_clear_audio_out_urbs(struct snd_line6_pcm *line6pcm) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 325 | { |
| 326 | int timeout = HZ; |
| 327 | unsigned int i; |
| 328 | int alive; |
| 329 | |
| 330 | do { |
| 331 | alive = 0; |
| 332 | for (i = LINE6_ISO_BUFFERS; i--;) { |
| 333 | if (test_bit(i, &line6pcm->active_urb_out)) |
| 334 | alive++; |
| 335 | } |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 336 | if (!alive) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 337 | break; |
| 338 | set_current_state(TASK_UNINTERRUPTIBLE); |
| 339 | schedule_timeout(1); |
| 340 | } while (--timeout > 0); |
| 341 | if (alive) |
| 342 | snd_printk(KERN_ERR "timeout: still %d active urbs..\n", alive); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 343 | } |
| 344 | |
| 345 | /* |
| 346 | Unlink all currently active playback URBs, and wait for finishing. |
| 347 | */ |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 348 | void line6_unlink_wait_clear_audio_out_urbs(struct snd_line6_pcm *line6pcm) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 349 | { |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 350 | line6_unlink_audio_out_urbs(line6pcm); |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 351 | line6_wait_clear_audio_out_urbs(line6pcm); |
Markus Grabner | 6b02a17e | 2011-12-10 02:12:32 +0100 | [diff] [blame] | 352 | } |
| 353 | |
| 354 | void line6_free_playback_buffer(struct snd_line6_pcm *line6pcm) |
| 355 | { |
| 356 | kfree(line6pcm->buffer_out); |
| 357 | line6pcm->buffer_out = NULL; |
| 358 | } |
| 359 | |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 360 | /* |
| 361 | Callback for completed playback URB. |
| 362 | */ |
Greg Kroah-Hartman | 0c7ab15 | 2009-02-27 20:28:04 -0800 | [diff] [blame] | 363 | static void audio_out_callback(struct urb *urb) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 364 | { |
| 365 | int i, index, length = 0, shutdown = 0; |
| 366 | unsigned long flags; |
| 367 | |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 368 | struct snd_line6_pcm *line6pcm = (struct snd_line6_pcm *)urb->context; |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 369 | struct snd_pcm_substream *substream = |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 370 | get_substream(line6pcm, SNDRV_PCM_STREAM_PLAYBACK); |
| 371 | |
| 372 | #if USE_CLEAR_BUFFER_WORKAROUND |
| 373 | memset(urb->transfer_buffer, 0, urb->transfer_buffer_length); |
| 374 | #endif |
| 375 | |
| 376 | line6pcm->last_frame_out = urb->start_frame; |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 377 | |
| 378 | /* find index of URB */ |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 379 | for (index = LINE6_ISO_BUFFERS; index--;) |
| 380 | if (urb == line6pcm->urb_audio_out[index]) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 381 | break; |
| 382 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 383 | if (index < 0) |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 384 | return; /* URB has been unlinked asynchronously */ |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 385 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 386 | for (i = LINE6_ISO_PACKETS; i--;) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 387 | length += urb->iso_frame_desc[i].length; |
| 388 | |
| 389 | spin_lock_irqsave(&line6pcm->lock_audio_out, flags); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 390 | |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 391 | if (test_bit(LINE6_INDEX_PCM_ALSA_PLAYBACK_STREAM, &line6pcm->flags)) { |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 392 | struct snd_pcm_runtime *runtime = substream->runtime; |
| 393 | line6pcm->pos_out_done += |
| 394 | length / line6pcm->properties->bytes_per_frame; |
| 395 | |
| 396 | if (line6pcm->pos_out_done >= runtime->buffer_size) |
| 397 | line6pcm->pos_out_done -= runtime->buffer_size; |
| 398 | } |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 399 | |
| 400 | clear_bit(index, &line6pcm->active_urb_out); |
| 401 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 402 | for (i = LINE6_ISO_PACKETS; i--;) |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 403 | if (urb->iso_frame_desc[i].status == -EXDEV) { |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 404 | shutdown = 1; |
| 405 | break; |
| 406 | } |
| 407 | |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 408 | if (test_and_clear_bit(index, &line6pcm->unlink_urb_out)) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 409 | shutdown = 1; |
| 410 | |
| 411 | spin_unlock_irqrestore(&line6pcm->lock_audio_out, flags); |
| 412 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 413 | if (!shutdown) { |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 414 | submit_audio_out_urb(line6pcm); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 415 | |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 416 | if (test_bit(LINE6_INDEX_PCM_ALSA_PLAYBACK_STREAM, &line6pcm->flags)) { |
Greg Kroah-Hartman | 027360c | 2010-09-21 16:58:00 -0700 | [diff] [blame] | 417 | line6pcm->bytes_out += length; |
| 418 | if (line6pcm->bytes_out >= line6pcm->period_out) { |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 419 | line6pcm->bytes_out %= line6pcm->period_out; |
| 420 | snd_pcm_period_elapsed(substream); |
| 421 | } |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 422 | } |
| 423 | } |
| 424 | } |
| 425 | |
| 426 | /* open playback callback */ |
| 427 | static int snd_line6_playback_open(struct snd_pcm_substream *substream) |
| 428 | { |
| 429 | int err; |
| 430 | struct snd_pcm_runtime *runtime = substream->runtime; |
| 431 | struct snd_line6_pcm *line6pcm = snd_pcm_substream_chip(substream); |
| 432 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 433 | err = snd_pcm_hw_constraint_ratdens(runtime, 0, SNDRV_PCM_HW_PARAM_RATE, |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 434 | (&line6pcm-> |
| 435 | properties->snd_line6_rates)); |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 436 | if (err < 0) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 437 | return err; |
| 438 | |
| 439 | runtime->hw = line6pcm->properties->snd_line6_playback_hw; |
| 440 | return 0; |
| 441 | } |
| 442 | |
| 443 | /* close playback callback */ |
| 444 | static int snd_line6_playback_close(struct snd_pcm_substream *substream) |
| 445 | { |
| 446 | return 0; |
| 447 | } |
| 448 | |
| 449 | /* hw_params playback callback */ |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 450 | static int snd_line6_playback_hw_params(struct snd_pcm_substream *substream, |
| 451 | struct snd_pcm_hw_params *hw_params) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 452 | { |
| 453 | int ret; |
| 454 | struct snd_line6_pcm *line6pcm = snd_pcm_substream_chip(substream); |
| 455 | |
| 456 | /* -- Florian Demski [FD] */ |
| 457 | /* don't ask me why, but this fixes the bug on my machine */ |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 458 | if (line6pcm == NULL) { |
| 459 | if (substream->pcm == NULL) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 460 | return -ENOMEM; |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 461 | if (substream->pcm->private_data == NULL) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 462 | return -ENOMEM; |
| 463 | substream->private_data = substream->pcm->private_data; |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 464 | line6pcm = snd_pcm_substream_chip(substream); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 465 | } |
| 466 | /* -- [FD] end */ |
| 467 | |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 468 | ret = line6_pcm_acquire(line6pcm, LINE6_BIT_PCM_ALSA_PLAYBACK_BUFFER); |
Stefan Hajnoczi | 140e28b | 2011-11-23 08:20:45 +0000 | [diff] [blame] | 469 | |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 470 | if (ret < 0) |
| 471 | return ret; |
Stefan Hajnoczi | 140e28b | 2011-11-23 08:20:45 +0000 | [diff] [blame] | 472 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 473 | ret = snd_pcm_lib_malloc_pages(substream, |
| 474 | params_buffer_bytes(hw_params)); |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 475 | if (ret < 0) { |
| 476 | line6_pcm_release(line6pcm, LINE6_BIT_PCM_ALSA_PLAYBACK_BUFFER); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 477 | return ret; |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 478 | } |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 479 | |
| 480 | line6pcm->period_out = params_period_bytes(hw_params); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 481 | return 0; |
| 482 | } |
| 483 | |
| 484 | /* hw_free playback callback */ |
| 485 | static int snd_line6_playback_hw_free(struct snd_pcm_substream *substream) |
| 486 | { |
Stefan Hajnoczi | 140e28b | 2011-11-23 08:20:45 +0000 | [diff] [blame] | 487 | struct snd_line6_pcm *line6pcm = snd_pcm_substream_chip(substream); |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 488 | line6_pcm_release(line6pcm, LINE6_BIT_PCM_ALSA_PLAYBACK_BUFFER); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 489 | return snd_pcm_lib_free_pages(substream); |
| 490 | } |
| 491 | |
| 492 | /* trigger playback callback */ |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 493 | int snd_line6_playback_trigger(struct snd_line6_pcm *line6pcm, int cmd) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 494 | { |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 495 | int err; |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 496 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 497 | switch (cmd) { |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 498 | case SNDRV_PCM_TRIGGER_START: |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 499 | #ifdef CONFIG_PM |
| 500 | case SNDRV_PCM_TRIGGER_RESUME: |
| 501 | #endif |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 502 | err = line6_pcm_acquire(line6pcm, LINE6_BIT_PCM_ALSA_PLAYBACK_STREAM); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 503 | |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 504 | if (err < 0) |
| 505 | return err; |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 506 | |
| 507 | break; |
| 508 | |
| 509 | case SNDRV_PCM_TRIGGER_STOP: |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 510 | #ifdef CONFIG_PM |
| 511 | case SNDRV_PCM_TRIGGER_SUSPEND: |
| 512 | #endif |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 513 | err = line6_pcm_release(line6pcm, LINE6_BIT_PCM_ALSA_PLAYBACK_STREAM); |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 514 | |
| 515 | if (err < 0) |
| 516 | return err; |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 517 | |
| 518 | break; |
| 519 | |
| 520 | case SNDRV_PCM_TRIGGER_PAUSE_PUSH: |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 521 | set_bit(LINE6_INDEX_PAUSE_PLAYBACK, &line6pcm->flags); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 522 | break; |
| 523 | |
| 524 | case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: |
Markus Grabner | 0ca5488 | 2012-01-20 00:09:09 +0100 | [diff] [blame^] | 525 | clear_bit(LINE6_INDEX_PAUSE_PLAYBACK, &line6pcm->flags); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 526 | break; |
| 527 | |
| 528 | default: |
| 529 | return -EINVAL; |
| 530 | } |
| 531 | |
| 532 | return 0; |
| 533 | } |
| 534 | |
| 535 | /* playback pointer callback */ |
| 536 | static snd_pcm_uframes_t |
| 537 | snd_line6_playback_pointer(struct snd_pcm_substream *substream) |
| 538 | { |
| 539 | struct snd_line6_pcm *line6pcm = snd_pcm_substream_chip(substream); |
| 540 | return line6pcm->pos_out_done; |
| 541 | } |
| 542 | |
| 543 | /* playback operators */ |
| 544 | struct snd_pcm_ops snd_line6_playback_ops = { |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 545 | .open = snd_line6_playback_open, |
| 546 | .close = snd_line6_playback_close, |
| 547 | .ioctl = snd_pcm_lib_ioctl, |
| 548 | .hw_params = snd_line6_playback_hw_params, |
| 549 | .hw_free = snd_line6_playback_hw_free, |
| 550 | .prepare = snd_line6_prepare, |
| 551 | .trigger = snd_line6_trigger, |
| 552 | .pointer = snd_line6_playback_pointer, |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 553 | }; |
| 554 | |
Markus Grabner | 1027f476 | 2010-08-12 01:35:30 +0200 | [diff] [blame] | 555 | int line6_create_audio_out_urbs(struct snd_line6_pcm *line6pcm) |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 556 | { |
| 557 | int i; |
| 558 | |
| 559 | /* create audio URBs and fill in constant values: */ |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 560 | for (i = 0; i < LINE6_ISO_BUFFERS; ++i) { |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 561 | struct urb *urb; |
| 562 | |
| 563 | /* URB for audio out: */ |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 564 | urb = line6pcm->urb_audio_out[i] = |
| 565 | usb_alloc_urb(LINE6_ISO_PACKETS, GFP_KERNEL); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 566 | |
Greg Kroah-Hartman | 010f378 | 2009-02-27 22:41:12 -0800 | [diff] [blame] | 567 | if (urb == NULL) { |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 568 | dev_err(line6pcm->line6->ifcdev, "Out of memory\n"); |
| 569 | return -ENOMEM; |
| 570 | } |
| 571 | |
| 572 | urb->dev = line6pcm->line6->usbdev; |
Shawn Bohrer | 45af497 | 2009-11-15 22:17:50 -0600 | [diff] [blame] | 573 | urb->pipe = |
| 574 | usb_sndisocpipe(line6pcm->line6->usbdev, |
Markus Grabner | e1a164d | 2010-08-23 01:08:25 +0200 | [diff] [blame] | 575 | line6pcm->ep_audio_write & |
| 576 | USB_ENDPOINT_NUMBER_MASK); |
Markus Grabner | 705ecec | 2009-02-27 19:43:04 -0800 | [diff] [blame] | 577 | urb->transfer_flags = URB_ISO_ASAP; |
| 578 | urb->start_frame = -1; |
| 579 | urb->number_of_packets = LINE6_ISO_PACKETS; |
| 580 | urb->interval = LINE6_ISO_INTERVAL; |
| 581 | urb->error_count = 0; |
| 582 | urb->complete = audio_out_callback; |
| 583 | } |
| 584 | |
| 585 | return 0; |
| 586 | } |