c8385d26a16f2dd749ddbae4aafeb706b89edbb3
[deliverable/linux.git] / sound / drivers / vx / vx_pcm.c
1 /*
2 * Driver for Digigram VX soundcards
3 *
4 * PCM part
5 *
6 * Copyright (c) 2002,2003 by Takashi Iwai <tiwai@suse.de>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 *
22 *
23 * STRATEGY
24 * for playback, we send series of "chunks", which size is equal with the
25 * IBL size, typically 126 samples. at each end of chunk, the end-of-buffer
26 * interrupt is notified, and the interrupt handler will feed the next chunk.
27 *
28 * the current position is calculated from the sample count RMH.
29 * pipe->transferred is the counter of data which has been already transferred.
30 * if this counter reaches to the period size, snd_pcm_period_elapsed() will
31 * be issued.
32 *
33 * for capture, the situation is much easier.
34 * to get a low latency response, we'll check the capture streams at each
35 * interrupt (capture stream has no EOB notification). if the pending
36 * data is accumulated to the period size, snd_pcm_period_elapsed() is
37 * called and the pointer is updated.
38 *
39 * the current point of read buffer is kept in pipe->hw_ptr. note that
40 * this is in bytes.
41 *
42 *
43 * TODO
44 * - linked trigger for full-duplex mode.
45 * - scheduled action on the stream.
46 */
47
48 #include <linux/slab.h>
49 #include <linux/delay.h>
50 #include <sound/core.h>
51 #include <sound/asoundef.h>
52 #include <sound/pcm.h>
53 #include <sound/vx_core.h>
54 #include "vx_cmd.h"
55
56
57 /*
58 * read three pending pcm bytes via inb()
59 */
60 static void vx_pcm_read_per_bytes(struct vx_core *chip, struct snd_pcm_runtime *runtime,
61 struct vx_pipe *pipe)
62 {
63 int offset = pipe->hw_ptr;
64 unsigned char *buf = (unsigned char *)(runtime->dma_area + offset);
65 *buf++ = vx_inb(chip, RXH);
66 if (++offset >= pipe->buffer_bytes) {
67 offset = 0;
68 buf = (unsigned char *)runtime->dma_area;
69 }
70 *buf++ = vx_inb(chip, RXM);
71 if (++offset >= pipe->buffer_bytes) {
72 offset = 0;
73 buf = (unsigned char *)runtime->dma_area;
74 }
75 *buf++ = vx_inb(chip, RXL);
76 if (++offset >= pipe->buffer_bytes) {
77 offset = 0;
78 buf = (unsigned char *)runtime->dma_area;
79 }
80 pipe->hw_ptr = offset;
81 }
82
83 /*
84 * vx_set_pcx_time - convert from the PC time to the RMH status time.
85 * @pc_time: the pointer for the PC-time to set
86 * @dsp_time: the pointer for RMH status time array
87 */
88 static void vx_set_pcx_time(struct vx_core *chip, pcx_time_t *pc_time,
89 unsigned int *dsp_time)
90 {
91 dsp_time[0] = (unsigned int)((*pc_time) >> 24) & PCX_TIME_HI_MASK;
92 dsp_time[1] = (unsigned int)(*pc_time) & MASK_DSP_WORD;
93 }
94
95 /*
96 * vx_set_differed_time - set the differed time if specified
97 * @rmh: the rmh record to modify
98 * @pipe: the pipe to be checked
99 *
100 * if the pipe is programmed with the differed time, set the DSP time
101 * on the rmh and changes its command length.
102 *
103 * returns the increase of the command length.
104 */
105 static int vx_set_differed_time(struct vx_core *chip, struct vx_rmh *rmh,
106 struct vx_pipe *pipe)
107 {
108 /* Update The length added to the RMH command by the timestamp */
109 if (! (pipe->differed_type & DC_DIFFERED_DELAY))
110 return 0;
111
112 /* Set the T bit */
113 rmh->Cmd[0] |= DSP_DIFFERED_COMMAND_MASK;
114
115 /* Time stamp is the 1st following parameter */
116 vx_set_pcx_time(chip, &pipe->pcx_time, &rmh->Cmd[1]);
117
118 /* Add the flags to a notified differed command */
119 if (pipe->differed_type & DC_NOTIFY_DELAY)
120 rmh->Cmd[1] |= NOTIFY_MASK_TIME_HIGH ;
121
122 /* Add the flags to a multiple differed command */
123 if (pipe->differed_type & DC_MULTIPLE_DELAY)
124 rmh->Cmd[1] |= MULTIPLE_MASK_TIME_HIGH;
125
126 /* Add the flags to a stream-time differed command */
127 if (pipe->differed_type & DC_STREAM_TIME_DELAY)
128 rmh->Cmd[1] |= STREAM_MASK_TIME_HIGH;
129
130 rmh->LgCmd += 2;
131 return 2;
132 }
133
134 /*
135 * vx_set_stream_format - send the stream format command
136 * @pipe: the affected pipe
137 * @data: format bitmask
138 */
139 static int vx_set_stream_format(struct vx_core *chip, struct vx_pipe *pipe,
140 unsigned int data)
141 {
142 struct vx_rmh rmh;
143
144 vx_init_rmh(&rmh, pipe->is_capture ?
145 CMD_FORMAT_STREAM_IN : CMD_FORMAT_STREAM_OUT);
146 rmh.Cmd[0] |= pipe->number << FIELD_SIZE;
147
148 /* Command might be longer since we may have to add a timestamp */
149 vx_set_differed_time(chip, &rmh, pipe);
150
151 rmh.Cmd[rmh.LgCmd] = (data & 0xFFFFFF00) >> 8;
152 rmh.Cmd[rmh.LgCmd + 1] = (data & 0xFF) << 16 /*| (datal & 0xFFFF00) >> 8*/;
153 rmh.LgCmd += 2;
154
155 return vx_send_msg(chip, &rmh);
156 }
157
158
159 /*
160 * vx_set_format - set the format of a pipe
161 * @pipe: the affected pipe
162 * @runtime: pcm runtime instance to be referred
163 *
164 * returns 0 if successful, or a negative error code.
165 */
166 static int vx_set_format(struct vx_core *chip, struct vx_pipe *pipe,
167 struct snd_pcm_runtime *runtime)
168 {
169 unsigned int header = HEADER_FMT_BASE;
170
171 if (runtime->channels == 1)
172 header |= HEADER_FMT_MONO;
173 if (snd_pcm_format_little_endian(runtime->format))
174 header |= HEADER_FMT_INTEL;
175 if (runtime->rate < 32000 && runtime->rate > 11025)
176 header |= HEADER_FMT_UPTO32;
177 else if (runtime->rate <= 11025)
178 header |= HEADER_FMT_UPTO11;
179
180 switch (snd_pcm_format_physical_width(runtime->format)) {
181 // case 8: break;
182 case 16: header |= HEADER_FMT_16BITS; break;
183 case 24: header |= HEADER_FMT_24BITS; break;
184 default :
185 snd_BUG();
186 return -EINVAL;
187 };
188
189 return vx_set_stream_format(chip, pipe, header);
190 }
191
192 /*
193 * set / query the IBL size
194 */
195 static int vx_set_ibl(struct vx_core *chip, struct vx_ibl_info *info)
196 {
197 int err;
198 struct vx_rmh rmh;
199
200 vx_init_rmh(&rmh, CMD_IBL);
201 rmh.Cmd[0] |= info->size & 0x03ffff;
202 err = vx_send_msg(chip, &rmh);
203 if (err < 0)
204 return err;
205 info->size = rmh.Stat[0];
206 info->max_size = rmh.Stat[1];
207 info->min_size = rmh.Stat[2];
208 info->granularity = rmh.Stat[3];
209 snd_printdd(KERN_DEBUG "vx_set_ibl: size = %d, max = %d, min = %d, gran = %d\n",
210 info->size, info->max_size, info->min_size, info->granularity);
211 return 0;
212 }
213
214
215 /*
216 * vx_get_pipe_state - get the state of a pipe
217 * @pipe: the pipe to be checked
218 * @state: the pointer for the returned state
219 *
220 * checks the state of a given pipe, and stores the state (1 = running,
221 * 0 = paused) on the given pointer.
222 *
223 * called from trigger callback only
224 */
225 static int vx_get_pipe_state(struct vx_core *chip, struct vx_pipe *pipe, int *state)
226 {
227 int err;
228 struct vx_rmh rmh;
229
230 vx_init_rmh(&rmh, CMD_PIPE_STATE);
231 vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
232 err = vx_send_msg_nolock(chip, &rmh); /* no lock needed for trigger */
233 if (! err)
234 *state = (rmh.Stat[0] & (1 << pipe->number)) ? 1 : 0;
235 return err;
236 }
237
238
239 /*
240 * vx_query_hbuffer_size - query available h-buffer size in bytes
241 * @pipe: the pipe to be checked
242 *
243 * return the available size on h-buffer in bytes,
244 * or a negative error code.
245 *
246 * NOTE: calling this function always switches to the stream mode.
247 * you'll need to disconnect the host to get back to the
248 * normal mode.
249 */
250 static int vx_query_hbuffer_size(struct vx_core *chip, struct vx_pipe *pipe)
251 {
252 int result;
253 struct vx_rmh rmh;
254
255 vx_init_rmh(&rmh, CMD_SIZE_HBUFFER);
256 vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
257 if (pipe->is_capture)
258 rmh.Cmd[0] |= 0x00000001;
259 result = vx_send_msg(chip, &rmh);
260 if (! result)
261 result = rmh.Stat[0] & 0xffff;
262 return result;
263 }
264
265
266 /*
267 * vx_pipe_can_start - query whether a pipe is ready for start
268 * @pipe: the pipe to be checked
269 *
270 * return 1 if ready, 0 if not ready, and negative value on error.
271 *
272 * called from trigger callback only
273 */
274 static int vx_pipe_can_start(struct vx_core *chip, struct vx_pipe *pipe)
275 {
276 int err;
277 struct vx_rmh rmh;
278
279 vx_init_rmh(&rmh, CMD_CAN_START_PIPE);
280 vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
281 rmh.Cmd[0] |= 1;
282
283 err = vx_send_msg_nolock(chip, &rmh); /* no lock needed for trigger */
284 if (! err) {
285 if (rmh.Stat[0])
286 err = 1;
287 }
288 return err;
289 }
290
291 /*
292 * vx_conf_pipe - tell the pipe to stand by and wait for IRQA.
293 * @pipe: the pipe to be configured
294 */
295 static int vx_conf_pipe(struct vx_core *chip, struct vx_pipe *pipe)
296 {
297 struct vx_rmh rmh;
298
299 vx_init_rmh(&rmh, CMD_CONF_PIPE);
300 if (pipe->is_capture)
301 rmh.Cmd[0] |= COMMAND_RECORD_MASK;
302 rmh.Cmd[1] = 1 << pipe->number;
303 return vx_send_msg_nolock(chip, &rmh); /* no lock needed for trigger */
304 }
305
306 /*
307 * vx_send_irqa - trigger IRQA
308 */
309 static int vx_send_irqa(struct vx_core *chip)
310 {
311 struct vx_rmh rmh;
312
313 vx_init_rmh(&rmh, CMD_SEND_IRQA);
314 return vx_send_msg_nolock(chip, &rmh); /* no lock needed for trigger */
315 }
316
317
318 #define MAX_WAIT_FOR_DSP 250
319 /*
320 * vx boards do not support inter-card sync, besides
321 * only 126 samples require to be prepared before a pipe can start
322 */
323 #define CAN_START_DELAY 2 /* wait 2ms only before asking if the pipe is ready*/
324 #define WAIT_STATE_DELAY 2 /* wait 2ms after irqA was requested and check if the pipe state toggled*/
325
326 /*
327 * vx_toggle_pipe - start / pause a pipe
328 * @pipe: the pipe to be triggered
329 * @state: start = 1, pause = 0
330 *
331 * called from trigger callback only
332 *
333 */
334 static int vx_toggle_pipe(struct vx_core *chip, struct vx_pipe *pipe, int state)
335 {
336 int err, i, cur_state;
337
338 /* Check the pipe is not already in the requested state */
339 if (vx_get_pipe_state(chip, pipe, &cur_state) < 0)
340 return -EBADFD;
341 if (state == cur_state)
342 return 0;
343
344 /* If a start is requested, ask the DSP to get prepared
345 * and wait for a positive acknowledge (when there are
346 * enough sound buffer for this pipe)
347 */
348 if (state) {
349 for (i = 0 ; i < MAX_WAIT_FOR_DSP; i++) {
350 err = vx_pipe_can_start(chip, pipe);
351 if (err > 0)
352 break;
353 /* Wait for a few, before asking again
354 * to avoid flooding the DSP with our requests
355 */
356 mdelay(1);
357 }
358 }
359
360 if ((err = vx_conf_pipe(chip, pipe)) < 0)
361 return err;
362
363 if ((err = vx_send_irqa(chip)) < 0)
364 return err;
365
366 /* If it completes successfully, wait for the pipes
367 * reaching the expected state before returning
368 * Check one pipe only (since they are synchronous)
369 */
370 for (i = 0; i < MAX_WAIT_FOR_DSP; i++) {
371 err = vx_get_pipe_state(chip, pipe, &cur_state);
372 if (err < 0 || cur_state == state)
373 break;
374 err = -EIO;
375 mdelay(1);
376 }
377 return err < 0 ? -EIO : 0;
378 }
379
380
381 /*
382 * vx_stop_pipe - stop a pipe
383 * @pipe: the pipe to be stopped
384 *
385 * called from trigger callback only
386 */
387 static int vx_stop_pipe(struct vx_core *chip, struct vx_pipe *pipe)
388 {
389 struct vx_rmh rmh;
390 vx_init_rmh(&rmh, CMD_STOP_PIPE);
391 vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
392 return vx_send_msg_nolock(chip, &rmh); /* no lock needed for trigger */
393 }
394
395
396 /*
397 * vx_alloc_pipe - allocate a pipe and initialize the pipe instance
398 * @capture: 0 = playback, 1 = capture operation
399 * @audioid: the audio id to be assigned
400 * @num_audio: number of audio channels
401 * @pipep: the returned pipe instance
402 *
403 * return 0 on success, or a negative error code.
404 */
405 static int vx_alloc_pipe(struct vx_core *chip, int capture,
406 int audioid, int num_audio,
407 struct vx_pipe **pipep)
408 {
409 int err;
410 struct vx_pipe *pipe;
411 struct vx_rmh rmh;
412 int data_mode;
413
414 *pipep = NULL;
415 vx_init_rmh(&rmh, CMD_RES_PIPE);
416 vx_set_pipe_cmd_params(&rmh, capture, audioid, num_audio);
417 #if 0 // NYI
418 if (underrun_skip_sound)
419 rmh.Cmd[0] |= BIT_SKIP_SOUND;
420 #endif // NYI
421 data_mode = (chip->uer_bits & IEC958_AES0_NONAUDIO) != 0;
422 if (! capture && data_mode)
423 rmh.Cmd[0] |= BIT_DATA_MODE;
424 err = vx_send_msg(chip, &rmh);
425 if (err < 0)
426 return err;
427
428 /* initialize the pipe record */
429 pipe = kzalloc(sizeof(*pipe), GFP_KERNEL);
430 if (! pipe) {
431 /* release the pipe */
432 vx_init_rmh(&rmh, CMD_FREE_PIPE);
433 vx_set_pipe_cmd_params(&rmh, capture, audioid, 0);
434 vx_send_msg(chip, &rmh);
435 return -ENOMEM;
436 }
437
438 /* the pipe index should be identical with the audio index */
439 pipe->number = audioid;
440 pipe->is_capture = capture;
441 pipe->channels = num_audio;
442 pipe->differed_type = 0;
443 pipe->pcx_time = 0;
444 pipe->data_mode = data_mode;
445 *pipep = pipe;
446
447 return 0;
448 }
449
450
451 /*
452 * vx_free_pipe - release a pipe
453 * @pipe: pipe to be released
454 */
455 static int vx_free_pipe(struct vx_core *chip, struct vx_pipe *pipe)
456 {
457 struct vx_rmh rmh;
458
459 vx_init_rmh(&rmh, CMD_FREE_PIPE);
460 vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
461 vx_send_msg(chip, &rmh);
462
463 kfree(pipe);
464 return 0;
465 }
466
467
468 /*
469 * vx_start_stream - start the stream
470 *
471 * called from trigger callback only
472 */
473 static int vx_start_stream(struct vx_core *chip, struct vx_pipe *pipe)
474 {
475 struct vx_rmh rmh;
476
477 vx_init_rmh(&rmh, CMD_START_ONE_STREAM);
478 vx_set_stream_cmd_params(&rmh, pipe->is_capture, pipe->number);
479 vx_set_differed_time(chip, &rmh, pipe);
480 return vx_send_msg_nolock(chip, &rmh); /* no lock needed for trigger */
481 }
482
483
484 /*
485 * vx_stop_stream - stop the stream
486 *
487 * called from trigger callback only
488 */
489 static int vx_stop_stream(struct vx_core *chip, struct vx_pipe *pipe)
490 {
491 struct vx_rmh rmh;
492
493 vx_init_rmh(&rmh, CMD_STOP_STREAM);
494 vx_set_stream_cmd_params(&rmh, pipe->is_capture, pipe->number);
495 return vx_send_msg_nolock(chip, &rmh); /* no lock needed for trigger */
496 }
497
498
499 /*
500 * playback hw information
501 */
502
503 static struct snd_pcm_hardware vx_pcm_playback_hw = {
504 .info = (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
505 SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_MMAP_VALID /*|*/
506 /*SNDRV_PCM_INFO_RESUME*/),
507 .formats = (/*SNDRV_PCM_FMTBIT_U8 |*/
508 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_3LE),
509 .rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000,
510 .rate_min = 5000,
511 .rate_max = 48000,
512 .channels_min = 1,
513 .channels_max = 2,
514 .buffer_bytes_max = (128*1024),
515 .period_bytes_min = 126,
516 .period_bytes_max = (128*1024),
517 .periods_min = 2,
518 .periods_max = VX_MAX_PERIODS,
519 .fifo_size = 126,
520 };
521
522
523 static void vx_pcm_delayed_start(unsigned long arg);
524
525 /*
526 * vx_pcm_playback_open - open callback for playback
527 */
528 static int vx_pcm_playback_open(struct snd_pcm_substream *subs)
529 {
530 struct snd_pcm_runtime *runtime = subs->runtime;
531 struct vx_core *chip = snd_pcm_substream_chip(subs);
532 struct vx_pipe *pipe = NULL;
533 unsigned int audio;
534 int err;
535
536 if (chip->chip_status & VX_STAT_IS_STALE)
537 return -EBUSY;
538
539 audio = subs->pcm->device * 2;
540 if (snd_BUG_ON(audio >= chip->audio_outs))
541 return -EINVAL;
542
543 /* playback pipe may have been already allocated for monitoring */
544 pipe = chip->playback_pipes[audio];
545 if (! pipe) {
546 /* not allocated yet */
547 err = vx_alloc_pipe(chip, 0, audio, 2, &pipe); /* stereo playback */
548 if (err < 0)
549 return err;
550 chip->playback_pipes[audio] = pipe;
551 }
552 /* open for playback */
553 pipe->references++;
554
555 pipe->substream = subs;
556 tasklet_init(&pipe->start_tq, vx_pcm_delayed_start, (unsigned long)subs);
557 chip->playback_pipes[audio] = pipe;
558
559 runtime->hw = vx_pcm_playback_hw;
560 runtime->hw.period_bytes_min = chip->ibl.size;
561 runtime->private_data = pipe;
562
563 /* align to 4 bytes (otherwise will be problematic when 24bit is used) */
564 snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_BYTES, 4);
565 snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 4);
566
567 return 0;
568 }
569
570 /*
571 * vx_pcm_playback_close - close callback for playback
572 */
573 static int vx_pcm_playback_close(struct snd_pcm_substream *subs)
574 {
575 struct vx_core *chip = snd_pcm_substream_chip(subs);
576 struct vx_pipe *pipe;
577
578 if (! subs->runtime->private_data)
579 return -EINVAL;
580
581 pipe = subs->runtime->private_data;
582
583 if (--pipe->references == 0) {
584 chip->playback_pipes[pipe->number] = NULL;
585 vx_free_pipe(chip, pipe);
586 }
587
588 return 0;
589
590 }
591
592
593 /*
594 * vx_notify_end_of_buffer - send "end-of-buffer" notifier at the given pipe
595 * @pipe: the pipe to notify
596 *
597 * NB: call with a certain lock.
598 */
599 static int vx_notify_end_of_buffer(struct vx_core *chip, struct vx_pipe *pipe)
600 {
601 int err;
602 struct vx_rmh rmh; /* use a temporary rmh here */
603
604 /* Toggle Dsp Host Interface into Message mode */
605 vx_send_rih_nolock(chip, IRQ_PAUSE_START_CONNECT);
606 vx_init_rmh(&rmh, CMD_NOTIFY_END_OF_BUFFER);
607 vx_set_stream_cmd_params(&rmh, 0, pipe->number);
608 err = vx_send_msg_nolock(chip, &rmh);
609 if (err < 0)
610 return err;
611 /* Toggle Dsp Host Interface back to sound transfer mode */
612 vx_send_rih_nolock(chip, IRQ_PAUSE_START_CONNECT);
613 return 0;
614 }
615
616 /*
617 * vx_pcm_playback_transfer_chunk - transfer a single chunk
618 * @subs: substream
619 * @pipe: the pipe to transfer
620 * @size: chunk size in bytes
621 *
622 * transfer a single buffer chunk. EOB notificaton is added after that.
623 * called from the interrupt handler, too.
624 *
625 * return 0 if ok.
626 */
627 static int vx_pcm_playback_transfer_chunk(struct vx_core *chip,
628 struct snd_pcm_runtime *runtime,
629 struct vx_pipe *pipe, int size)
630 {
631 int space, err = 0;
632
633 space = vx_query_hbuffer_size(chip, pipe);
634 if (space < 0) {
635 /* disconnect the host, SIZE_HBUF command always switches to the stream mode */
636 vx_send_rih(chip, IRQ_CONNECT_STREAM_NEXT);
637 snd_printd("error hbuffer\n");
638 return space;
639 }
640 if (space < size) {
641 vx_send_rih(chip, IRQ_CONNECT_STREAM_NEXT);
642 snd_printd("no enough hbuffer space %d\n", space);
643 return -EIO; /* XRUN */
644 }
645
646 /* we don't need irqsave here, because this function
647 * is called from either trigger callback or irq handler
648 */
649 spin_lock(&chip->lock);
650 vx_pseudo_dma_write(chip, runtime, pipe, size);
651 err = vx_notify_end_of_buffer(chip, pipe);
652 /* disconnect the host, SIZE_HBUF command always switches to the stream mode */
653 vx_send_rih_nolock(chip, IRQ_CONNECT_STREAM_NEXT);
654 spin_unlock(&chip->lock);
655 return err;
656 }
657
658 /*
659 * update the position of the given pipe.
660 * pipe->position is updated and wrapped within the buffer size.
661 * pipe->transferred is updated, too, but the size is not wrapped,
662 * so that the caller can check the total transferred size later
663 * (to call snd_pcm_period_elapsed).
664 */
665 static int vx_update_pipe_position(struct vx_core *chip,
666 struct snd_pcm_runtime *runtime,
667 struct vx_pipe *pipe)
668 {
669 struct vx_rmh rmh;
670 int err, update;
671 u64 count;
672
673 vx_init_rmh(&rmh, CMD_STREAM_SAMPLE_COUNT);
674 vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
675 err = vx_send_msg(chip, &rmh);
676 if (err < 0)
677 return err;
678
679 count = ((u64)(rmh.Stat[0] & 0xfffff) << 24) | (u64)rmh.Stat[1];
680 update = (int)(count - pipe->cur_count);
681 pipe->cur_count = count;
682 pipe->position += update;
683 if (pipe->position >= (int)runtime->buffer_size)
684 pipe->position %= runtime->buffer_size;
685 pipe->transferred += update;
686 return 0;
687 }
688
689 /*
690 * transfer the pending playback buffer data to DSP
691 * called from interrupt handler
692 */
693 static void vx_pcm_playback_transfer(struct vx_core *chip,
694 struct snd_pcm_substream *subs,
695 struct vx_pipe *pipe, int nchunks)
696 {
697 int i, err;
698 struct snd_pcm_runtime *runtime = subs->runtime;
699
700 if (! pipe->prepared || (chip->chip_status & VX_STAT_IS_STALE))
701 return;
702 for (i = 0; i < nchunks; i++) {
703 if ((err = vx_pcm_playback_transfer_chunk(chip, runtime, pipe,
704 chip->ibl.size)) < 0)
705 return;
706 }
707 }
708
709 /*
710 * update the playback position and call snd_pcm_period_elapsed() if necessary
711 * called from interrupt handler
712 */
713 static void vx_pcm_playback_update(struct vx_core *chip,
714 struct snd_pcm_substream *subs,
715 struct vx_pipe *pipe)
716 {
717 int err;
718 struct snd_pcm_runtime *runtime = subs->runtime;
719
720 if (pipe->running && ! (chip->chip_status & VX_STAT_IS_STALE)) {
721 if ((err = vx_update_pipe_position(chip, runtime, pipe)) < 0)
722 return;
723 if (pipe->transferred >= (int)runtime->period_size) {
724 pipe->transferred %= runtime->period_size;
725 snd_pcm_period_elapsed(subs);
726 }
727 }
728 }
729
730 /*
731 * start the stream and pipe.
732 * this function is called from tasklet, which is invoked by the trigger
733 * START callback.
734 */
735 static void vx_pcm_delayed_start(unsigned long arg)
736 {
737 struct snd_pcm_substream *subs = (struct snd_pcm_substream *)arg;
738 struct vx_core *chip = subs->pcm->private_data;
739 struct vx_pipe *pipe = subs->runtime->private_data;
740 int err;
741
742 /* printk( KERN_DEBUG "DDDD tasklet delayed start jiffies = %ld\n", jiffies);*/
743
744 if ((err = vx_start_stream(chip, pipe)) < 0) {
745 snd_printk(KERN_ERR "vx: cannot start stream\n");
746 return;
747 }
748 if ((err = vx_toggle_pipe(chip, pipe, 1)) < 0) {
749 snd_printk(KERN_ERR "vx: cannot start pipe\n");
750 return;
751 }
752 /* printk( KERN_DEBUG "dddd tasklet delayed start jiffies = %ld \n", jiffies);*/
753 }
754
755 /*
756 * vx_pcm_playback_trigger - trigger callback for playback
757 */
758 static int vx_pcm_trigger(struct snd_pcm_substream *subs, int cmd)
759 {
760 struct vx_core *chip = snd_pcm_substream_chip(subs);
761 struct vx_pipe *pipe = subs->runtime->private_data;
762 int err;
763
764 if (chip->chip_status & VX_STAT_IS_STALE)
765 return -EBUSY;
766
767 switch (cmd) {
768 case SNDRV_PCM_TRIGGER_START:
769 case SNDRV_PCM_TRIGGER_RESUME:
770 if (! pipe->is_capture)
771 vx_pcm_playback_transfer(chip, subs, pipe, 2);
772 /* FIXME:
773 * we trigger the pipe using tasklet, so that the interrupts are
774 * issued surely after the trigger is completed.
775 */
776 tasklet_schedule(&pipe->start_tq);
777 chip->pcm_running++;
778 pipe->running = 1;
779 break;
780 case SNDRV_PCM_TRIGGER_STOP:
781 case SNDRV_PCM_TRIGGER_SUSPEND:
782 vx_toggle_pipe(chip, pipe, 0);
783 vx_stop_pipe(chip, pipe);
784 vx_stop_stream(chip, pipe);
785 chip->pcm_running--;
786 pipe->running = 0;
787 break;
788 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
789 if ((err = vx_toggle_pipe(chip, pipe, 0)) < 0)
790 return err;
791 break;
792 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
793 if ((err = vx_toggle_pipe(chip, pipe, 1)) < 0)
794 return err;
795 break;
796 default:
797 return -EINVAL;
798 }
799 return 0;
800 }
801
802 /*
803 * vx_pcm_playback_pointer - pointer callback for playback
804 */
805 static snd_pcm_uframes_t vx_pcm_playback_pointer(struct snd_pcm_substream *subs)
806 {
807 struct snd_pcm_runtime *runtime = subs->runtime;
808 struct vx_pipe *pipe = runtime->private_data;
809 return pipe->position;
810 }
811
812 /*
813 * vx_pcm_hw_params - hw_params callback for playback and capture
814 */
815 static int vx_pcm_hw_params(struct snd_pcm_substream *subs,
816 struct snd_pcm_hw_params *hw_params)
817 {
818 return snd_pcm_lib_alloc_vmalloc_32_buffer
819 (subs, params_buffer_bytes(hw_params));
820 }
821
822 /*
823 * vx_pcm_hw_free - hw_free callback for playback and capture
824 */
825 static int vx_pcm_hw_free(struct snd_pcm_substream *subs)
826 {
827 return snd_pcm_lib_free_vmalloc_buffer(subs);
828 }
829
830 /*
831 * vx_pcm_prepare - prepare callback for playback and capture
832 */
833 static int vx_pcm_prepare(struct snd_pcm_substream *subs)
834 {
835 struct vx_core *chip = snd_pcm_substream_chip(subs);
836 struct snd_pcm_runtime *runtime = subs->runtime;
837 struct vx_pipe *pipe = runtime->private_data;
838 int err, data_mode;
839 // int max_size, nchunks;
840
841 if (chip->chip_status & VX_STAT_IS_STALE)
842 return -EBUSY;
843
844 data_mode = (chip->uer_bits & IEC958_AES0_NONAUDIO) != 0;
845 if (data_mode != pipe->data_mode && ! pipe->is_capture) {
846 /* IEC958 status (raw-mode) was changed */
847 /* we reopen the pipe */
848 struct vx_rmh rmh;
849 snd_printdd(KERN_DEBUG "reopen the pipe with data_mode = %d\n", data_mode);
850 vx_init_rmh(&rmh, CMD_FREE_PIPE);
851 vx_set_pipe_cmd_params(&rmh, 0, pipe->number, 0);
852 if ((err = vx_send_msg(chip, &rmh)) < 0)
853 return err;
854 vx_init_rmh(&rmh, CMD_RES_PIPE);
855 vx_set_pipe_cmd_params(&rmh, 0, pipe->number, pipe->channels);
856 if (data_mode)
857 rmh.Cmd[0] |= BIT_DATA_MODE;
858 if ((err = vx_send_msg(chip, &rmh)) < 0)
859 return err;
860 pipe->data_mode = data_mode;
861 }
862
863 if (chip->pcm_running && chip->freq != runtime->rate) {
864 snd_printk(KERN_ERR "vx: cannot set different clock %d "
865 "from the current %d\n", runtime->rate, chip->freq);
866 return -EINVAL;
867 }
868 vx_set_clock(chip, runtime->rate);
869
870 if ((err = vx_set_format(chip, pipe, runtime)) < 0)
871 return err;
872
873 if (vx_is_pcmcia(chip)) {
874 pipe->align = 2; /* 16bit word */
875 } else {
876 pipe->align = 4; /* 32bit word */
877 }
878
879 pipe->buffer_bytes = frames_to_bytes(runtime, runtime->buffer_size);
880 pipe->period_bytes = frames_to_bytes(runtime, runtime->period_size);
881 pipe->hw_ptr = 0;
882
883 /* set the timestamp */
884 vx_update_pipe_position(chip, runtime, pipe);
885 /* clear again */
886 pipe->transferred = 0;
887 pipe->position = 0;
888
889 pipe->prepared = 1;
890
891 return 0;
892 }
893
894
895 /*
896 * operators for PCM playback
897 */
898 static struct snd_pcm_ops vx_pcm_playback_ops = {
899 .open = vx_pcm_playback_open,
900 .close = vx_pcm_playback_close,
901 .ioctl = snd_pcm_lib_ioctl,
902 .hw_params = vx_pcm_hw_params,
903 .hw_free = vx_pcm_hw_free,
904 .prepare = vx_pcm_prepare,
905 .trigger = vx_pcm_trigger,
906 .pointer = vx_pcm_playback_pointer,
907 .page = snd_pcm_lib_get_vmalloc_page,
908 };
909
910
911 /*
912 * playback hw information
913 */
914
915 static struct snd_pcm_hardware vx_pcm_capture_hw = {
916 .info = (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
917 SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_MMAP_VALID /*|*/
918 /*SNDRV_PCM_INFO_RESUME*/),
919 .formats = (/*SNDRV_PCM_FMTBIT_U8 |*/
920 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_3LE),
921 .rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000,
922 .rate_min = 5000,
923 .rate_max = 48000,
924 .channels_min = 1,
925 .channels_max = 2,
926 .buffer_bytes_max = (128*1024),
927 .period_bytes_min = 126,
928 .period_bytes_max = (128*1024),
929 .periods_min = 2,
930 .periods_max = VX_MAX_PERIODS,
931 .fifo_size = 126,
932 };
933
934
935 /*
936 * vx_pcm_capture_open - open callback for capture
937 */
938 static int vx_pcm_capture_open(struct snd_pcm_substream *subs)
939 {
940 struct snd_pcm_runtime *runtime = subs->runtime;
941 struct vx_core *chip = snd_pcm_substream_chip(subs);
942 struct vx_pipe *pipe;
943 struct vx_pipe *pipe_out_monitoring = NULL;
944 unsigned int audio;
945 int err;
946
947 if (chip->chip_status & VX_STAT_IS_STALE)
948 return -EBUSY;
949
950 audio = subs->pcm->device * 2;
951 if (snd_BUG_ON(audio >= chip->audio_ins))
952 return -EINVAL;
953 err = vx_alloc_pipe(chip, 1, audio, 2, &pipe);
954 if (err < 0)
955 return err;
956 pipe->substream = subs;
957 tasklet_init(&pipe->start_tq, vx_pcm_delayed_start, (unsigned long)subs);
958 chip->capture_pipes[audio] = pipe;
959
960 /* check if monitoring is needed */
961 if (chip->audio_monitor_active[audio]) {
962 pipe_out_monitoring = chip->playback_pipes[audio];
963 if (! pipe_out_monitoring) {
964 /* allocate a pipe */
965 err = vx_alloc_pipe(chip, 0, audio, 2, &pipe_out_monitoring);
966 if (err < 0)
967 return err;
968 chip->playback_pipes[audio] = pipe_out_monitoring;
969 }
970 pipe_out_monitoring->references++;
971 /*
972 if an output pipe is available, it's audios still may need to be
973 unmuted. hence we'll have to call a mixer entry point.
974 */
975 vx_set_monitor_level(chip, audio, chip->audio_monitor[audio],
976 chip->audio_monitor_active[audio]);
977 /* assuming stereo */
978 vx_set_monitor_level(chip, audio+1, chip->audio_monitor[audio+1],
979 chip->audio_monitor_active[audio+1]);
980 }
981
982 pipe->monitoring_pipe = pipe_out_monitoring; /* default value NULL */
983
984 runtime->hw = vx_pcm_capture_hw;
985 runtime->hw.period_bytes_min = chip->ibl.size;
986 runtime->private_data = pipe;
987
988 /* align to 4 bytes (otherwise will be problematic when 24bit is used) */
989 snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_BYTES, 4);
990 snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 4);
991
992 return 0;
993 }
994
995 /*
996 * vx_pcm_capture_close - close callback for capture
997 */
998 static int vx_pcm_capture_close(struct snd_pcm_substream *subs)
999 {
1000 struct vx_core *chip = snd_pcm_substream_chip(subs);
1001 struct vx_pipe *pipe;
1002 struct vx_pipe *pipe_out_monitoring;
1003
1004 if (! subs->runtime->private_data)
1005 return -EINVAL;
1006 pipe = subs->runtime->private_data;
1007 chip->capture_pipes[pipe->number] = NULL;
1008
1009 pipe_out_monitoring = pipe->monitoring_pipe;
1010
1011 /*
1012 if an output pipe is attached to this input,
1013 check if it needs to be released.
1014 */
1015 if (pipe_out_monitoring) {
1016 if (--pipe_out_monitoring->references == 0) {
1017 vx_free_pipe(chip, pipe_out_monitoring);
1018 chip->playback_pipes[pipe->number] = NULL;
1019 pipe->monitoring_pipe = NULL;
1020 }
1021 }
1022
1023 vx_free_pipe(chip, pipe);
1024 return 0;
1025 }
1026
1027
1028
1029 #define DMA_READ_ALIGN 6 /* hardware alignment for read */
1030
1031 /*
1032 * vx_pcm_capture_update - update the capture buffer
1033 */
1034 static void vx_pcm_capture_update(struct vx_core *chip, struct snd_pcm_substream *subs,
1035 struct vx_pipe *pipe)
1036 {
1037 int size, space, count;
1038 struct snd_pcm_runtime *runtime = subs->runtime;
1039
1040 if (! pipe->prepared || (chip->chip_status & VX_STAT_IS_STALE))
1041 return;
1042
1043 size = runtime->buffer_size - snd_pcm_capture_avail(runtime);
1044 if (! size)
1045 return;
1046 size = frames_to_bytes(runtime, size);
1047 space = vx_query_hbuffer_size(chip, pipe);
1048 if (space < 0)
1049 goto _error;
1050 if (size > space)
1051 size = space;
1052 size = (size / 3) * 3; /* align to 3 bytes */
1053 if (size < DMA_READ_ALIGN)
1054 goto _error;
1055
1056 /* keep the last 6 bytes, they will be read after disconnection */
1057 count = size - DMA_READ_ALIGN;
1058 /* read bytes until the current pointer reaches to the aligned position
1059 * for word-transfer
1060 */
1061 while (count > 0) {
1062 if ((pipe->hw_ptr % pipe->align) == 0)
1063 break;
1064 if (vx_wait_for_rx_full(chip) < 0)
1065 goto _error;
1066 vx_pcm_read_per_bytes(chip, runtime, pipe);
1067 count -= 3;
1068 }
1069 if (count > 0) {
1070 /* ok, let's accelerate! */
1071 int align = pipe->align * 3;
1072 space = (count / align) * align;
1073 vx_pseudo_dma_read(chip, runtime, pipe, space);
1074 count -= space;
1075 }
1076 /* read the rest of bytes */
1077 while (count > 0) {
1078 if (vx_wait_for_rx_full(chip) < 0)
1079 goto _error;
1080 vx_pcm_read_per_bytes(chip, runtime, pipe);
1081 count -= 3;
1082 }
1083 /* disconnect the host, SIZE_HBUF command always switches to the stream mode */
1084 vx_send_rih_nolock(chip, IRQ_CONNECT_STREAM_NEXT);
1085 /* read the last pending 6 bytes */
1086 count = DMA_READ_ALIGN;
1087 while (count > 0) {
1088 vx_pcm_read_per_bytes(chip, runtime, pipe);
1089 count -= 3;
1090 }
1091 /* update the position */
1092 pipe->transferred += size;
1093 if (pipe->transferred >= pipe->period_bytes) {
1094 pipe->transferred %= pipe->period_bytes;
1095 snd_pcm_period_elapsed(subs);
1096 }
1097 return;
1098
1099 _error:
1100 /* disconnect the host, SIZE_HBUF command always switches to the stream mode */
1101 vx_send_rih_nolock(chip, IRQ_CONNECT_STREAM_NEXT);
1102 return;
1103 }
1104
1105 /*
1106 * vx_pcm_capture_pointer - pointer callback for capture
1107 */
1108 static snd_pcm_uframes_t vx_pcm_capture_pointer(struct snd_pcm_substream *subs)
1109 {
1110 struct snd_pcm_runtime *runtime = subs->runtime;
1111 struct vx_pipe *pipe = runtime->private_data;
1112 return bytes_to_frames(runtime, pipe->hw_ptr);
1113 }
1114
1115 /*
1116 * operators for PCM capture
1117 */
1118 static struct snd_pcm_ops vx_pcm_capture_ops = {
1119 .open = vx_pcm_capture_open,
1120 .close = vx_pcm_capture_close,
1121 .ioctl = snd_pcm_lib_ioctl,
1122 .hw_params = vx_pcm_hw_params,
1123 .hw_free = vx_pcm_hw_free,
1124 .prepare = vx_pcm_prepare,
1125 .trigger = vx_pcm_trigger,
1126 .pointer = vx_pcm_capture_pointer,
1127 .page = snd_pcm_lib_get_vmalloc_page,
1128 };
1129
1130
1131 /*
1132 * interrupt handler for pcm streams
1133 */
1134 void vx_pcm_update_intr(struct vx_core *chip, unsigned int events)
1135 {
1136 unsigned int i;
1137 struct vx_pipe *pipe;
1138
1139 #define EVENT_MASK (END_OF_BUFFER_EVENTS_PENDING|ASYNC_EVENTS_PENDING)
1140
1141 if (events & EVENT_MASK) {
1142 vx_init_rmh(&chip->irq_rmh, CMD_ASYNC);
1143 if (events & ASYNC_EVENTS_PENDING)
1144 chip->irq_rmh.Cmd[0] |= 0x00000001; /* SEL_ASYNC_EVENTS */
1145 if (events & END_OF_BUFFER_EVENTS_PENDING)
1146 chip->irq_rmh.Cmd[0] |= 0x00000002; /* SEL_END_OF_BUF_EVENTS */
1147
1148 if (vx_send_msg(chip, &chip->irq_rmh) < 0) {
1149 snd_printdd(KERN_ERR "msg send error!!\n");
1150 return;
1151 }
1152
1153 i = 1;
1154 while (i < chip->irq_rmh.LgStat) {
1155 int p, buf, capture, eob;
1156 p = chip->irq_rmh.Stat[i] & MASK_FIRST_FIELD;
1157 capture = (chip->irq_rmh.Stat[i] & 0x400000) ? 1 : 0;
1158 eob = (chip->irq_rmh.Stat[i] & 0x800000) ? 1 : 0;
1159 i++;
1160 if (events & ASYNC_EVENTS_PENDING)
1161 i++;
1162 buf = 1; /* force to transfer */
1163 if (events & END_OF_BUFFER_EVENTS_PENDING) {
1164 if (eob)
1165 buf = chip->irq_rmh.Stat[i];
1166 i++;
1167 }
1168 if (capture)
1169 continue;
1170 if (snd_BUG_ON(p < 0 || p >= chip->audio_outs))
1171 continue;
1172 pipe = chip->playback_pipes[p];
1173 if (pipe && pipe->substream) {
1174 vx_pcm_playback_update(chip, pipe->substream, pipe);
1175 vx_pcm_playback_transfer(chip, pipe->substream, pipe, buf);
1176 }
1177 }
1178 }
1179
1180 /* update the capture pcm pointers as frequently as possible */
1181 for (i = 0; i < chip->audio_ins; i++) {
1182 pipe = chip->capture_pipes[i];
1183 if (pipe && pipe->substream)
1184 vx_pcm_capture_update(chip, pipe->substream, pipe);
1185 }
1186 }
1187
1188
1189 /*
1190 * vx_init_audio_io - check the availabe audio i/o and allocate pipe arrays
1191 */
1192 static int vx_init_audio_io(struct vx_core *chip)
1193 {
1194 struct vx_rmh rmh;
1195 int preferred;
1196
1197 vx_init_rmh(&rmh, CMD_SUPPORTED);
1198 if (vx_send_msg(chip, &rmh) < 0) {
1199 snd_printk(KERN_ERR "vx: cannot get the supported audio data\n");
1200 return -ENXIO;
1201 }
1202
1203 chip->audio_outs = rmh.Stat[0] & MASK_FIRST_FIELD;
1204 chip->audio_ins = (rmh.Stat[0] >> (FIELD_SIZE*2)) & MASK_FIRST_FIELD;
1205 chip->audio_info = rmh.Stat[1];
1206
1207 /* allocate pipes */
1208 chip->playback_pipes = kcalloc(chip->audio_outs, sizeof(struct vx_pipe *), GFP_KERNEL);
1209 if (!chip->playback_pipes)
1210 return -ENOMEM;
1211 chip->capture_pipes = kcalloc(chip->audio_ins, sizeof(struct vx_pipe *), GFP_KERNEL);
1212 if (!chip->capture_pipes) {
1213 kfree(chip->playback_pipes);
1214 return -ENOMEM;
1215 }
1216
1217 preferred = chip->ibl.size;
1218 chip->ibl.size = 0;
1219 vx_set_ibl(chip, &chip->ibl); /* query the info */
1220 if (preferred > 0) {
1221 chip->ibl.size = ((preferred + chip->ibl.granularity - 1) /
1222 chip->ibl.granularity) * chip->ibl.granularity;
1223 if (chip->ibl.size > chip->ibl.max_size)
1224 chip->ibl.size = chip->ibl.max_size;
1225 } else
1226 chip->ibl.size = chip->ibl.min_size; /* set to the minimum */
1227 vx_set_ibl(chip, &chip->ibl);
1228
1229 return 0;
1230 }
1231
1232
1233 /*
1234 * free callback for pcm
1235 */
1236 static void snd_vx_pcm_free(struct snd_pcm *pcm)
1237 {
1238 struct vx_core *chip = pcm->private_data;
1239 chip->pcm[pcm->device] = NULL;
1240 kfree(chip->playback_pipes);
1241 chip->playback_pipes = NULL;
1242 kfree(chip->capture_pipes);
1243 chip->capture_pipes = NULL;
1244 }
1245
1246 /*
1247 * snd_vx_pcm_new - create and initialize a pcm
1248 */
1249 int snd_vx_pcm_new(struct vx_core *chip)
1250 {
1251 struct snd_pcm *pcm;
1252 unsigned int i;
1253 int err;
1254
1255 if ((err = vx_init_audio_io(chip)) < 0)
1256 return err;
1257
1258 for (i = 0; i < chip->hw->num_codecs; i++) {
1259 unsigned int outs, ins;
1260 outs = chip->audio_outs > i * 2 ? 1 : 0;
1261 ins = chip->audio_ins > i * 2 ? 1 : 0;
1262 if (! outs && ! ins)
1263 break;
1264 err = snd_pcm_new(chip->card, "VX PCM", i,
1265 outs, ins, &pcm);
1266 if (err < 0)
1267 return err;
1268 if (outs)
1269 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &vx_pcm_playback_ops);
1270 if (ins)
1271 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &vx_pcm_capture_ops);
1272
1273 pcm->private_data = chip;
1274 pcm->private_free = snd_vx_pcm_free;
1275 pcm->info_flags = 0;
1276 strcpy(pcm->name, chip->card->shortname);
1277 chip->pcm[i] = pcm;
1278 }
1279
1280 return 0;
1281 }
This page took 0.055454 seconds and 4 git commands to generate.