Root/
1 | /* |
2 | * Apple iSight audio driver |
3 | * |
4 | * Copyright (c) Clemens Ladisch <clemens@ladisch.de> |
5 | * Licensed under the terms of the GNU General Public License, version 2. |
6 | */ |
7 | |
8 | #include <asm/byteorder.h> |
9 | #include <linux/delay.h> |
10 | #include <linux/device.h> |
11 | #include <linux/firewire.h> |
12 | #include <linux/firewire-constants.h> |
13 | #include <linux/module.h> |
14 | #include <linux/mod_devicetable.h> |
15 | #include <linux/mutex.h> |
16 | #include <linux/string.h> |
17 | #include <sound/control.h> |
18 | #include <sound/core.h> |
19 | #include <sound/initval.h> |
20 | #include <sound/pcm.h> |
21 | #include <sound/tlv.h> |
22 | #include "lib.h" |
23 | #include "iso-resources.h" |
24 | #include "packets-buffer.h" |
25 | |
26 | #define OUI_APPLE 0x000a27 |
27 | #define MODEL_APPLE_ISIGHT 0x000008 |
28 | #define SW_ISIGHT_AUDIO 0x000010 |
29 | |
30 | #define REG_AUDIO_ENABLE 0x000 |
31 | #define AUDIO_ENABLE 0x80000000 |
32 | #define REG_DEF_AUDIO_GAIN 0x204 |
33 | #define REG_GAIN_RAW_START 0x210 |
34 | #define REG_GAIN_RAW_END 0x214 |
35 | #define REG_GAIN_DB_START 0x218 |
36 | #define REG_GAIN_DB_END 0x21c |
37 | #define REG_SAMPLE_RATE_INQUIRY 0x280 |
38 | #define REG_ISO_TX_CONFIG 0x300 |
39 | #define SPEED_SHIFT 16 |
40 | #define REG_SAMPLE_RATE 0x400 |
41 | #define RATE_48000 0x80000000 |
42 | #define REG_GAIN 0x500 |
43 | #define REG_MUTE 0x504 |
44 | |
45 | #define MAX_FRAMES_PER_PACKET 475 |
46 | |
47 | #define QUEUE_LENGTH 20 |
48 | |
49 | struct isight { |
50 | struct snd_card *card; |
51 | struct fw_unit *unit; |
52 | struct fw_device *device; |
53 | u64 audio_base; |
54 | struct snd_pcm_substream *pcm; |
55 | struct mutex mutex; |
56 | struct iso_packets_buffer buffer; |
57 | struct fw_iso_resources resources; |
58 | struct fw_iso_context *context; |
59 | bool pcm_active; |
60 | bool pcm_running; |
61 | bool first_packet; |
62 | int packet_index; |
63 | u32 total_samples; |
64 | unsigned int buffer_pointer; |
65 | unsigned int period_counter; |
66 | s32 gain_min, gain_max; |
67 | unsigned int gain_tlv[4]; |
68 | }; |
69 | |
70 | struct audio_payload { |
71 | __be32 sample_count; |
72 | __be32 signature; |
73 | __be32 sample_total; |
74 | __be32 reserved; |
75 | __be16 samples[2 * MAX_FRAMES_PER_PACKET]; |
76 | }; |
77 | |
78 | MODULE_DESCRIPTION("iSight audio driver"); |
79 | MODULE_AUTHOR("Clemens Ladisch <clemens@ladisch.de>"); |
80 | MODULE_LICENSE("GPL v2"); |
81 | |
82 | static struct fw_iso_packet audio_packet = { |
83 | .payload_length = sizeof(struct audio_payload), |
84 | .interrupt = 1, |
85 | .header_length = 4, |
86 | }; |
87 | |
88 | static void isight_update_pointers(struct isight *isight, unsigned int count) |
89 | { |
90 | struct snd_pcm_runtime *runtime = isight->pcm->runtime; |
91 | unsigned int ptr; |
92 | |
93 | smp_wmb(); /* update buffer data before buffer pointer */ |
94 | |
95 | ptr = isight->buffer_pointer; |
96 | ptr += count; |
97 | if (ptr >= runtime->buffer_size) |
98 | ptr -= runtime->buffer_size; |
99 | ACCESS_ONCE(isight->buffer_pointer) = ptr; |
100 | |
101 | isight->period_counter += count; |
102 | if (isight->period_counter >= runtime->period_size) { |
103 | isight->period_counter -= runtime->period_size; |
104 | snd_pcm_period_elapsed(isight->pcm); |
105 | } |
106 | } |
107 | |
108 | static void isight_samples(struct isight *isight, |
109 | const __be16 *samples, unsigned int count) |
110 | { |
111 | struct snd_pcm_runtime *runtime; |
112 | unsigned int count1; |
113 | |
114 | if (!ACCESS_ONCE(isight->pcm_running)) |
115 | return; |
116 | |
117 | runtime = isight->pcm->runtime; |
118 | if (isight->buffer_pointer + count <= runtime->buffer_size) { |
119 | memcpy(runtime->dma_area + isight->buffer_pointer * 4, |
120 | samples, count * 4); |
121 | } else { |
122 | count1 = runtime->buffer_size - isight->buffer_pointer; |
123 | memcpy(runtime->dma_area + isight->buffer_pointer * 4, |
124 | samples, count1 * 4); |
125 | samples += count1 * 2; |
126 | memcpy(runtime->dma_area, samples, (count - count1) * 4); |
127 | } |
128 | |
129 | isight_update_pointers(isight, count); |
130 | } |
131 | |
132 | static void isight_pcm_abort(struct isight *isight) |
133 | { |
134 | unsigned long flags; |
135 | |
136 | if (ACCESS_ONCE(isight->pcm_active)) { |
137 | snd_pcm_stream_lock_irqsave(isight->pcm, flags); |
138 | if (snd_pcm_running(isight->pcm)) |
139 | snd_pcm_stop(isight->pcm, SNDRV_PCM_STATE_XRUN); |
140 | snd_pcm_stream_unlock_irqrestore(isight->pcm, flags); |
141 | } |
142 | } |
143 | |
144 | static void isight_dropped_samples(struct isight *isight, unsigned int total) |
145 | { |
146 | struct snd_pcm_runtime *runtime; |
147 | u32 dropped; |
148 | unsigned int count1; |
149 | |
150 | if (!ACCESS_ONCE(isight->pcm_running)) |
151 | return; |
152 | |
153 | runtime = isight->pcm->runtime; |
154 | dropped = total - isight->total_samples; |
155 | if (dropped < runtime->buffer_size) { |
156 | if (isight->buffer_pointer + dropped <= runtime->buffer_size) { |
157 | memset(runtime->dma_area + isight->buffer_pointer * 4, |
158 | 0, dropped * 4); |
159 | } else { |
160 | count1 = runtime->buffer_size - isight->buffer_pointer; |
161 | memset(runtime->dma_area + isight->buffer_pointer * 4, |
162 | 0, count1 * 4); |
163 | memset(runtime->dma_area, 0, (dropped - count1) * 4); |
164 | } |
165 | isight_update_pointers(isight, dropped); |
166 | } else { |
167 | isight_pcm_abort(isight); |
168 | } |
169 | } |
170 | |
171 | static void isight_packet(struct fw_iso_context *context, u32 cycle, |
172 | size_t header_length, void *header, void *data) |
173 | { |
174 | struct isight *isight = data; |
175 | const struct audio_payload *payload; |
176 | unsigned int index, length, count, total; |
177 | int err; |
178 | |
179 | if (isight->packet_index < 0) |
180 | return; |
181 | index = isight->packet_index; |
182 | payload = isight->buffer.packets[index].buffer; |
183 | length = be32_to_cpup(header) >> 16; |
184 | |
185 | if (likely(length >= 16 && |
186 | payload->signature == cpu_to_be32(0x73676874/*"sght"*/))) { |
187 | count = be32_to_cpu(payload->sample_count); |
188 | if (likely(count <= (length - 16) / 4)) { |
189 | total = be32_to_cpu(payload->sample_total); |
190 | if (unlikely(total != isight->total_samples)) { |
191 | if (!isight->first_packet) |
192 | isight_dropped_samples(isight, total); |
193 | isight->first_packet = false; |
194 | isight->total_samples = total; |
195 | } |
196 | |
197 | isight_samples(isight, payload->samples, count); |
198 | isight->total_samples += count; |
199 | } |
200 | } |
201 | |
202 | err = fw_iso_context_queue(isight->context, &audio_packet, |
203 | &isight->buffer.iso_buffer, |
204 | isight->buffer.packets[index].offset); |
205 | if (err < 0) { |
206 | dev_err(&isight->unit->device, "queueing error: %d\n", err); |
207 | isight_pcm_abort(isight); |
208 | isight->packet_index = -1; |
209 | return; |
210 | } |
211 | fw_iso_context_queue_flush(isight->context); |
212 | |
213 | if (++index >= QUEUE_LENGTH) |
214 | index = 0; |
215 | isight->packet_index = index; |
216 | } |
217 | |
218 | static int isight_connect(struct isight *isight) |
219 | { |
220 | int ch, err; |
221 | __be32 value; |
222 | |
223 | retry_after_bus_reset: |
224 | ch = fw_iso_resources_allocate(&isight->resources, |
225 | sizeof(struct audio_payload), |
226 | isight->device->max_speed); |
227 | if (ch < 0) { |
228 | err = ch; |
229 | goto error; |
230 | } |
231 | |
232 | value = cpu_to_be32(ch | (isight->device->max_speed << SPEED_SHIFT)); |
233 | err = snd_fw_transaction(isight->unit, TCODE_WRITE_QUADLET_REQUEST, |
234 | isight->audio_base + REG_ISO_TX_CONFIG, |
235 | &value, 4, FW_FIXED_GENERATION | |
236 | isight->resources.generation); |
237 | if (err == -EAGAIN) { |
238 | fw_iso_resources_free(&isight->resources); |
239 | goto retry_after_bus_reset; |
240 | } else if (err < 0) { |
241 | goto err_resources; |
242 | } |
243 | |
244 | return 0; |
245 | |
246 | err_resources: |
247 | fw_iso_resources_free(&isight->resources); |
248 | error: |
249 | return err; |
250 | } |
251 | |
252 | static int isight_open(struct snd_pcm_substream *substream) |
253 | { |
254 | static const struct snd_pcm_hardware hardware = { |
255 | .info = SNDRV_PCM_INFO_MMAP | |
256 | SNDRV_PCM_INFO_MMAP_VALID | |
257 | SNDRV_PCM_INFO_BATCH | |
258 | SNDRV_PCM_INFO_INTERLEAVED | |
259 | SNDRV_PCM_INFO_BLOCK_TRANSFER, |
260 | .formats = SNDRV_PCM_FMTBIT_S16_BE, |
261 | .rates = SNDRV_PCM_RATE_48000, |
262 | .rate_min = 48000, |
263 | .rate_max = 48000, |
264 | .channels_min = 2, |
265 | .channels_max = 2, |
266 | .buffer_bytes_max = 4 * 1024 * 1024, |
267 | .period_bytes_min = MAX_FRAMES_PER_PACKET * 4, |
268 | .period_bytes_max = 1024 * 1024, |
269 | .periods_min = 2, |
270 | .periods_max = UINT_MAX, |
271 | }; |
272 | struct isight *isight = substream->private_data; |
273 | |
274 | substream->runtime->hw = hardware; |
275 | |
276 | return iso_packets_buffer_init(&isight->buffer, isight->unit, |
277 | QUEUE_LENGTH, |
278 | sizeof(struct audio_payload), |
279 | DMA_FROM_DEVICE); |
280 | } |
281 | |
282 | static int isight_close(struct snd_pcm_substream *substream) |
283 | { |
284 | struct isight *isight = substream->private_data; |
285 | |
286 | iso_packets_buffer_destroy(&isight->buffer, isight->unit); |
287 | |
288 | return 0; |
289 | } |
290 | |
291 | static int isight_hw_params(struct snd_pcm_substream *substream, |
292 | struct snd_pcm_hw_params *hw_params) |
293 | { |
294 | struct isight *isight = substream->private_data; |
295 | int err; |
296 | |
297 | err = snd_pcm_lib_alloc_vmalloc_buffer(substream, |
298 | params_buffer_bytes(hw_params)); |
299 | if (err < 0) |
300 | return err; |
301 | |
302 | ACCESS_ONCE(isight->pcm_active) = true; |
303 | |
304 | return 0; |
305 | } |
306 | |
307 | static int reg_read(struct isight *isight, int offset, __be32 *value) |
308 | { |
309 | return snd_fw_transaction(isight->unit, TCODE_READ_QUADLET_REQUEST, |
310 | isight->audio_base + offset, value, 4, 0); |
311 | } |
312 | |
313 | static int reg_write(struct isight *isight, int offset, __be32 value) |
314 | { |
315 | return snd_fw_transaction(isight->unit, TCODE_WRITE_QUADLET_REQUEST, |
316 | isight->audio_base + offset, &value, 4, 0); |
317 | } |
318 | |
319 | static void isight_stop_streaming(struct isight *isight) |
320 | { |
321 | __be32 value; |
322 | |
323 | if (!isight->context) |
324 | return; |
325 | |
326 | fw_iso_context_stop(isight->context); |
327 | fw_iso_context_destroy(isight->context); |
328 | isight->context = NULL; |
329 | fw_iso_resources_free(&isight->resources); |
330 | value = 0; |
331 | snd_fw_transaction(isight->unit, TCODE_WRITE_QUADLET_REQUEST, |
332 | isight->audio_base + REG_AUDIO_ENABLE, |
333 | &value, 4, FW_QUIET); |
334 | } |
335 | |
336 | static int isight_hw_free(struct snd_pcm_substream *substream) |
337 | { |
338 | struct isight *isight = substream->private_data; |
339 | |
340 | ACCESS_ONCE(isight->pcm_active) = false; |
341 | |
342 | mutex_lock(&isight->mutex); |
343 | isight_stop_streaming(isight); |
344 | mutex_unlock(&isight->mutex); |
345 | |
346 | return snd_pcm_lib_free_vmalloc_buffer(substream); |
347 | } |
348 | |
349 | static int isight_start_streaming(struct isight *isight) |
350 | { |
351 | unsigned int i; |
352 | int err; |
353 | |
354 | if (isight->context) { |
355 | if (isight->packet_index < 0) |
356 | isight_stop_streaming(isight); |
357 | else |
358 | return 0; |
359 | } |
360 | |
361 | err = reg_write(isight, REG_SAMPLE_RATE, cpu_to_be32(RATE_48000)); |
362 | if (err < 0) |
363 | goto error; |
364 | |
365 | err = isight_connect(isight); |
366 | if (err < 0) |
367 | goto error; |
368 | |
369 | err = reg_write(isight, REG_AUDIO_ENABLE, cpu_to_be32(AUDIO_ENABLE)); |
370 | if (err < 0) |
371 | goto err_resources; |
372 | |
373 | isight->context = fw_iso_context_create(isight->device->card, |
374 | FW_ISO_CONTEXT_RECEIVE, |
375 | isight->resources.channel, |
376 | isight->device->max_speed, |
377 | 4, isight_packet, isight); |
378 | if (IS_ERR(isight->context)) { |
379 | err = PTR_ERR(isight->context); |
380 | isight->context = NULL; |
381 | goto err_resources; |
382 | } |
383 | |
384 | for (i = 0; i < QUEUE_LENGTH; ++i) { |
385 | err = fw_iso_context_queue(isight->context, &audio_packet, |
386 | &isight->buffer.iso_buffer, |
387 | isight->buffer.packets[i].offset); |
388 | if (err < 0) |
389 | goto err_context; |
390 | } |
391 | |
392 | isight->first_packet = true; |
393 | isight->packet_index = 0; |
394 | |
395 | err = fw_iso_context_start(isight->context, -1, 0, |
396 | FW_ISO_CONTEXT_MATCH_ALL_TAGS/*?*/); |
397 | if (err < 0) |
398 | goto err_context; |
399 | |
400 | return 0; |
401 | |
402 | err_context: |
403 | fw_iso_context_destroy(isight->context); |
404 | isight->context = NULL; |
405 | err_resources: |
406 | fw_iso_resources_free(&isight->resources); |
407 | reg_write(isight, REG_AUDIO_ENABLE, 0); |
408 | error: |
409 | return err; |
410 | } |
411 | |
412 | static int isight_prepare(struct snd_pcm_substream *substream) |
413 | { |
414 | struct isight *isight = substream->private_data; |
415 | int err; |
416 | |
417 | isight->buffer_pointer = 0; |
418 | isight->period_counter = 0; |
419 | |
420 | mutex_lock(&isight->mutex); |
421 | err = isight_start_streaming(isight); |
422 | mutex_unlock(&isight->mutex); |
423 | |
424 | return err; |
425 | } |
426 | |
427 | static int isight_trigger(struct snd_pcm_substream *substream, int cmd) |
428 | { |
429 | struct isight *isight = substream->private_data; |
430 | |
431 | switch (cmd) { |
432 | case SNDRV_PCM_TRIGGER_START: |
433 | ACCESS_ONCE(isight->pcm_running) = true; |
434 | break; |
435 | case SNDRV_PCM_TRIGGER_STOP: |
436 | ACCESS_ONCE(isight->pcm_running) = false; |
437 | break; |
438 | default: |
439 | return -EINVAL; |
440 | } |
441 | return 0; |
442 | } |
443 | |
444 | static snd_pcm_uframes_t isight_pointer(struct snd_pcm_substream *substream) |
445 | { |
446 | struct isight *isight = substream->private_data; |
447 | |
448 | return ACCESS_ONCE(isight->buffer_pointer); |
449 | } |
450 | |
451 | static int isight_create_pcm(struct isight *isight) |
452 | { |
453 | static struct snd_pcm_ops ops = { |
454 | .open = isight_open, |
455 | .close = isight_close, |
456 | .ioctl = snd_pcm_lib_ioctl, |
457 | .hw_params = isight_hw_params, |
458 | .hw_free = isight_hw_free, |
459 | .prepare = isight_prepare, |
460 | .trigger = isight_trigger, |
461 | .pointer = isight_pointer, |
462 | .page = snd_pcm_lib_get_vmalloc_page, |
463 | .mmap = snd_pcm_lib_mmap_vmalloc, |
464 | }; |
465 | struct snd_pcm *pcm; |
466 | int err; |
467 | |
468 | err = snd_pcm_new(isight->card, "iSight", 0, 0, 1, &pcm); |
469 | if (err < 0) |
470 | return err; |
471 | pcm->private_data = isight; |
472 | strcpy(pcm->name, "iSight"); |
473 | isight->pcm = pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream; |
474 | isight->pcm->ops = &ops; |
475 | |
476 | return 0; |
477 | } |
478 | |
479 | static int isight_gain_info(struct snd_kcontrol *ctl, |
480 | struct snd_ctl_elem_info *info) |
481 | { |
482 | struct isight *isight = ctl->private_data; |
483 | |
484 | info->type = SNDRV_CTL_ELEM_TYPE_INTEGER; |
485 | info->count = 1; |
486 | info->value.integer.min = isight->gain_min; |
487 | info->value.integer.max = isight->gain_max; |
488 | |
489 | return 0; |
490 | } |
491 | |
492 | static int isight_gain_get(struct snd_kcontrol *ctl, |
493 | struct snd_ctl_elem_value *value) |
494 | { |
495 | struct isight *isight = ctl->private_data; |
496 | __be32 gain; |
497 | int err; |
498 | |
499 | err = reg_read(isight, REG_GAIN, &gain); |
500 | if (err < 0) |
501 | return err; |
502 | |
503 | value->value.integer.value[0] = (s32)be32_to_cpu(gain); |
504 | |
505 | return 0; |
506 | } |
507 | |
508 | static int isight_gain_put(struct snd_kcontrol *ctl, |
509 | struct snd_ctl_elem_value *value) |
510 | { |
511 | struct isight *isight = ctl->private_data; |
512 | |
513 | if (value->value.integer.value[0] < isight->gain_min || |
514 | value->value.integer.value[0] > isight->gain_max) |
515 | return -EINVAL; |
516 | |
517 | return reg_write(isight, REG_GAIN, |
518 | cpu_to_be32(value->value.integer.value[0])); |
519 | } |
520 | |
521 | static int isight_mute_get(struct snd_kcontrol *ctl, |
522 | struct snd_ctl_elem_value *value) |
523 | { |
524 | struct isight *isight = ctl->private_data; |
525 | __be32 mute; |
526 | int err; |
527 | |
528 | err = reg_read(isight, REG_MUTE, &mute); |
529 | if (err < 0) |
530 | return err; |
531 | |
532 | value->value.integer.value[0] = !mute; |
533 | |
534 | return 0; |
535 | } |
536 | |
537 | static int isight_mute_put(struct snd_kcontrol *ctl, |
538 | struct snd_ctl_elem_value *value) |
539 | { |
540 | struct isight *isight = ctl->private_data; |
541 | |
542 | return reg_write(isight, REG_MUTE, |
543 | (__force __be32)!value->value.integer.value[0]); |
544 | } |
545 | |
546 | static int isight_create_mixer(struct isight *isight) |
547 | { |
548 | static const struct snd_kcontrol_new gain_control = { |
549 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, |
550 | .name = "Mic Capture Volume", |
551 | .access = SNDRV_CTL_ELEM_ACCESS_READWRITE | |
552 | SNDRV_CTL_ELEM_ACCESS_TLV_READ, |
553 | .info = isight_gain_info, |
554 | .get = isight_gain_get, |
555 | .put = isight_gain_put, |
556 | }; |
557 | static const struct snd_kcontrol_new mute_control = { |
558 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, |
559 | .name = "Mic Capture Switch", |
560 | .info = snd_ctl_boolean_mono_info, |
561 | .get = isight_mute_get, |
562 | .put = isight_mute_put, |
563 | }; |
564 | __be32 value; |
565 | struct snd_kcontrol *ctl; |
566 | int err; |
567 | |
568 | err = reg_read(isight, REG_GAIN_RAW_START, &value); |
569 | if (err < 0) |
570 | return err; |
571 | isight->gain_min = be32_to_cpu(value); |
572 | |
573 | err = reg_read(isight, REG_GAIN_RAW_END, &value); |
574 | if (err < 0) |
575 | return err; |
576 | isight->gain_max = be32_to_cpu(value); |
577 | |
578 | isight->gain_tlv[0] = SNDRV_CTL_TLVT_DB_MINMAX; |
579 | isight->gain_tlv[1] = 2 * sizeof(unsigned int); |
580 | |
581 | err = reg_read(isight, REG_GAIN_DB_START, &value); |
582 | if (err < 0) |
583 | return err; |
584 | isight->gain_tlv[2] = (s32)be32_to_cpu(value) * 100; |
585 | |
586 | err = reg_read(isight, REG_GAIN_DB_END, &value); |
587 | if (err < 0) |
588 | return err; |
589 | isight->gain_tlv[3] = (s32)be32_to_cpu(value) * 100; |
590 | |
591 | ctl = snd_ctl_new1(&gain_control, isight); |
592 | if (ctl) |
593 | ctl->tlv.p = isight->gain_tlv; |
594 | err = snd_ctl_add(isight->card, ctl); |
595 | if (err < 0) |
596 | return err; |
597 | |
598 | err = snd_ctl_add(isight->card, snd_ctl_new1(&mute_control, isight)); |
599 | if (err < 0) |
600 | return err; |
601 | |
602 | return 0; |
603 | } |
604 | |
605 | static void isight_card_free(struct snd_card *card) |
606 | { |
607 | struct isight *isight = card->private_data; |
608 | |
609 | fw_iso_resources_destroy(&isight->resources); |
610 | fw_unit_put(isight->unit); |
611 | mutex_destroy(&isight->mutex); |
612 | } |
613 | |
614 | static u64 get_unit_base(struct fw_unit *unit) |
615 | { |
616 | struct fw_csr_iterator i; |
617 | int key, value; |
618 | |
619 | fw_csr_iterator_init(&i, unit->directory); |
620 | while (fw_csr_iterator_next(&i, &key, &value)) |
621 | if (key == CSR_OFFSET) |
622 | return CSR_REGISTER_BASE + value * 4; |
623 | return 0; |
624 | } |
625 | |
626 | static int isight_probe(struct fw_unit *unit, |
627 | const struct ieee1394_device_id *id) |
628 | { |
629 | struct fw_device *fw_dev = fw_parent_device(unit); |
630 | struct snd_card *card; |
631 | struct isight *isight; |
632 | int err; |
633 | |
634 | err = snd_card_new(&unit->device, -1, NULL, THIS_MODULE, |
635 | sizeof(*isight), &card); |
636 | if (err < 0) |
637 | return err; |
638 | |
639 | isight = card->private_data; |
640 | isight->card = card; |
641 | mutex_init(&isight->mutex); |
642 | isight->unit = fw_unit_get(unit); |
643 | isight->device = fw_dev; |
644 | isight->audio_base = get_unit_base(unit); |
645 | if (!isight->audio_base) { |
646 | dev_err(&unit->device, "audio unit base not found\n"); |
647 | err = -ENXIO; |
648 | goto err_unit; |
649 | } |
650 | fw_iso_resources_init(&isight->resources, unit); |
651 | |
652 | card->private_free = isight_card_free; |
653 | |
654 | strcpy(card->driver, "iSight"); |
655 | strcpy(card->shortname, "Apple iSight"); |
656 | snprintf(card->longname, sizeof(card->longname), |
657 | "Apple iSight (GUID %08x%08x) at %s, S%d", |
658 | fw_dev->config_rom[3], fw_dev->config_rom[4], |
659 | dev_name(&unit->device), 100 << fw_dev->max_speed); |
660 | strcpy(card->mixername, "iSight"); |
661 | |
662 | err = isight_create_pcm(isight); |
663 | if (err < 0) |
664 | goto error; |
665 | |
666 | err = isight_create_mixer(isight); |
667 | if (err < 0) |
668 | goto error; |
669 | |
670 | err = snd_card_register(card); |
671 | if (err < 0) |
672 | goto error; |
673 | |
674 | dev_set_drvdata(&unit->device, isight); |
675 | |
676 | return 0; |
677 | |
678 | err_unit: |
679 | fw_unit_put(isight->unit); |
680 | mutex_destroy(&isight->mutex); |
681 | error: |
682 | snd_card_free(card); |
683 | return err; |
684 | } |
685 | |
686 | static void isight_bus_reset(struct fw_unit *unit) |
687 | { |
688 | struct isight *isight = dev_get_drvdata(&unit->device); |
689 | |
690 | if (fw_iso_resources_update(&isight->resources) < 0) { |
691 | isight_pcm_abort(isight); |
692 | |
693 | mutex_lock(&isight->mutex); |
694 | isight_stop_streaming(isight); |
695 | mutex_unlock(&isight->mutex); |
696 | } |
697 | } |
698 | |
699 | static void isight_remove(struct fw_unit *unit) |
700 | { |
701 | struct isight *isight = dev_get_drvdata(&unit->device); |
702 | |
703 | isight_pcm_abort(isight); |
704 | |
705 | snd_card_disconnect(isight->card); |
706 | |
707 | mutex_lock(&isight->mutex); |
708 | isight_stop_streaming(isight); |
709 | mutex_unlock(&isight->mutex); |
710 | |
711 | snd_card_free_when_closed(isight->card); |
712 | } |
713 | |
714 | static const struct ieee1394_device_id isight_id_table[] = { |
715 | { |
716 | .match_flags = IEEE1394_MATCH_SPECIFIER_ID | |
717 | IEEE1394_MATCH_VERSION, |
718 | .specifier_id = OUI_APPLE, |
719 | .version = SW_ISIGHT_AUDIO, |
720 | }, |
721 | { } |
722 | }; |
723 | MODULE_DEVICE_TABLE(ieee1394, isight_id_table); |
724 | |
725 | static struct fw_driver isight_driver = { |
726 | .driver = { |
727 | .owner = THIS_MODULE, |
728 | .name = KBUILD_MODNAME, |
729 | .bus = &fw_bus_type, |
730 | }, |
731 | .probe = isight_probe, |
732 | .update = isight_bus_reset, |
733 | .remove = isight_remove, |
734 | .id_table = isight_id_table, |
735 | }; |
736 | |
737 | static int __init alsa_isight_init(void) |
738 | { |
739 | return driver_register(&isight_driver.driver); |
740 | } |
741 | |
742 | static void __exit alsa_isight_exit(void) |
743 | { |
744 | driver_unregister(&isight_driver.driver); |
745 | } |
746 | |
747 | module_init(alsa_isight_init); |
748 | module_exit(alsa_isight_exit); |
749 |
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