1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
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
59
60static 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
85
86
87
88static 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
97
98
99
100
101
102
103
104
105static int vx_set_differed_time(struct vx_core *chip, struct vx_rmh *rmh,
106 struct vx_pipe *pipe)
107{
108
109 if (! (pipe->differed_type & DC_DIFFERED_DELAY))
110 return 0;
111
112
113 rmh->Cmd[0] |= DSP_DIFFERED_COMMAND_MASK;
114
115
116 vx_set_pcx_time(chip, &pipe->pcx_time, &rmh->Cmd[1]);
117
118
119 if (pipe->differed_type & DC_NOTIFY_DELAY)
120 rmh->Cmd[1] |= NOTIFY_MASK_TIME_HIGH ;
121
122
123 if (pipe->differed_type & DC_MULTIPLE_DELAY)
124 rmh->Cmd[1] |= MULTIPLE_MASK_TIME_HIGH;
125
126
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
136
137
138
139static 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
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 ;
153 rmh.LgCmd += 2;
154
155 return vx_send_msg(chip, &rmh);
156}
157
158
159
160
161
162
163
164
165
166static 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
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
194
195static 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
217
218
219
220
221
222
223
224
225static 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(chip, &rmh);
233 if (! err)
234 *state = (rmh.Stat[0] & (1 << pipe->number)) ? 1 : 0;
235 return err;
236}
237
238
239
240
241
242
243
244
245
246
247
248
249
250static 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
268
269
270
271
272
273
274static 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(chip, &rmh);
284 if (! err) {
285 if (rmh.Stat[0])
286 err = 1;
287 }
288 return err;
289}
290
291
292
293
294
295static 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(chip, &rmh);
304}
305
306
307
308
309static 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(chip, &rmh);
315}
316
317
318#define MAX_WAIT_FOR_DSP 250
319
320
321
322
323#define CAN_START_DELAY 2
324#define WAIT_STATE_DELAY 2
325
326
327
328
329
330
331
332
333
334static int vx_toggle_pipe(struct vx_core *chip, struct vx_pipe *pipe, int state)
335{
336 int err, i, cur_state;
337
338
339 if (vx_get_pipe_state(chip, pipe, &cur_state) < 0)
340 return -EBADFD;
341 if (state == cur_state)
342 return 0;
343
344
345
346
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
354
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
367
368
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
383
384
385
386
387static 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(chip, &rmh);
393}
394
395
396
397
398
399
400
401
402
403
404
405static 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
418 if (underrun_skip_sound)
419 rmh.Cmd[0] |= BIT_SKIP_SOUND;
420#endif
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
429 pipe = kzalloc(sizeof(*pipe), GFP_KERNEL);
430 if (! pipe) {
431
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
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
453
454
455static 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
470
471
472
473static 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(chip, &rmh);
481}
482
483
484
485
486
487
488
489static 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(chip, &rmh);
496}
497
498
499
500
501
502
503static 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 ),
507 .formats = (
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
524
525
526static int vx_pcm_playback_open(struct snd_pcm_substream *subs)
527{
528 struct snd_pcm_runtime *runtime = subs->runtime;
529 struct vx_core *chip = snd_pcm_substream_chip(subs);
530 struct vx_pipe *pipe = NULL;
531 unsigned int audio;
532 int err;
533
534 if (chip->chip_status & VX_STAT_IS_STALE)
535 return -EBUSY;
536
537 audio = subs->pcm->device * 2;
538 if (snd_BUG_ON(audio >= chip->audio_outs))
539 return -EINVAL;
540
541
542 pipe = chip->playback_pipes[audio];
543 if (! pipe) {
544
545 err = vx_alloc_pipe(chip, 0, audio, 2, &pipe);
546 if (err < 0)
547 return err;
548 chip->playback_pipes[audio] = pipe;
549 }
550
551 pipe->references++;
552
553 pipe->substream = subs;
554 chip->playback_pipes[audio] = pipe;
555
556 runtime->hw = vx_pcm_playback_hw;
557 runtime->hw.period_bytes_min = chip->ibl.size;
558 runtime->private_data = pipe;
559
560
561 snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_BYTES, 4);
562 snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 4);
563
564 return 0;
565}
566
567
568
569
570static int vx_pcm_playback_close(struct snd_pcm_substream *subs)
571{
572 struct vx_core *chip = snd_pcm_substream_chip(subs);
573 struct vx_pipe *pipe;
574
575 if (! subs->runtime->private_data)
576 return -EINVAL;
577
578 pipe = subs->runtime->private_data;
579
580 if (--pipe->references == 0) {
581 chip->playback_pipes[pipe->number] = NULL;
582 vx_free_pipe(chip, pipe);
583 }
584
585 return 0;
586
587}
588
589
590
591
592
593
594
595
596static int vx_notify_end_of_buffer(struct vx_core *chip, struct vx_pipe *pipe)
597{
598 int err;
599 struct vx_rmh rmh;
600
601
602 vx_send_rih_nolock(chip, IRQ_PAUSE_START_CONNECT);
603 vx_init_rmh(&rmh, CMD_NOTIFY_END_OF_BUFFER);
604 vx_set_stream_cmd_params(&rmh, 0, pipe->number);
605 err = vx_send_msg_nolock(chip, &rmh);
606 if (err < 0)
607 return err;
608
609 vx_send_rih_nolock(chip, IRQ_PAUSE_START_CONNECT);
610 return 0;
611}
612
613
614
615
616
617
618
619
620
621
622
623
624static int vx_pcm_playback_transfer_chunk(struct vx_core *chip,
625 struct snd_pcm_runtime *runtime,
626 struct vx_pipe *pipe, int size)
627{
628 int space, err = 0;
629
630 space = vx_query_hbuffer_size(chip, pipe);
631 if (space < 0) {
632
633 vx_send_rih(chip, IRQ_CONNECT_STREAM_NEXT);
634 snd_printd("error hbuffer\n");
635 return space;
636 }
637 if (space < size) {
638 vx_send_rih(chip, IRQ_CONNECT_STREAM_NEXT);
639 snd_printd("no enough hbuffer space %d\n", space);
640 return -EIO;
641 }
642
643
644
645
646 mutex_lock(&chip->lock);
647 vx_pseudo_dma_write(chip, runtime, pipe, size);
648 err = vx_notify_end_of_buffer(chip, pipe);
649
650 vx_send_rih_nolock(chip, IRQ_CONNECT_STREAM_NEXT);
651 mutex_unlock(&chip->lock);
652 return err;
653}
654
655
656
657
658
659
660
661
662static int vx_update_pipe_position(struct vx_core *chip,
663 struct snd_pcm_runtime *runtime,
664 struct vx_pipe *pipe)
665{
666 struct vx_rmh rmh;
667 int err, update;
668 u64 count;
669
670 vx_init_rmh(&rmh, CMD_STREAM_SAMPLE_COUNT);
671 vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
672 err = vx_send_msg(chip, &rmh);
673 if (err < 0)
674 return err;
675
676 count = ((u64)(rmh.Stat[0] & 0xfffff) << 24) | (u64)rmh.Stat[1];
677 update = (int)(count - pipe->cur_count);
678 pipe->cur_count = count;
679 pipe->position += update;
680 if (pipe->position >= (int)runtime->buffer_size)
681 pipe->position %= runtime->buffer_size;
682 pipe->transferred += update;
683 return 0;
684}
685
686
687
688
689
690static void vx_pcm_playback_transfer(struct vx_core *chip,
691 struct snd_pcm_substream *subs,
692 struct vx_pipe *pipe, int nchunks)
693{
694 int i, err;
695 struct snd_pcm_runtime *runtime = subs->runtime;
696
697 if (! pipe->prepared || (chip->chip_status & VX_STAT_IS_STALE))
698 return;
699 for (i = 0; i < nchunks; i++) {
700 if ((err = vx_pcm_playback_transfer_chunk(chip, runtime, pipe,
701 chip->ibl.size)) < 0)
702 return;
703 }
704}
705
706
707
708
709
710static void vx_pcm_playback_update(struct vx_core *chip,
711 struct snd_pcm_substream *subs,
712 struct vx_pipe *pipe)
713{
714 int err;
715 struct snd_pcm_runtime *runtime = subs->runtime;
716
717 if (pipe->running && ! (chip->chip_status & VX_STAT_IS_STALE)) {
718 if ((err = vx_update_pipe_position(chip, runtime, pipe)) < 0)
719 return;
720 if (pipe->transferred >= (int)runtime->period_size) {
721 pipe->transferred %= runtime->period_size;
722 snd_pcm_period_elapsed(subs);
723 }
724 }
725}
726
727
728
729
730static int vx_pcm_trigger(struct snd_pcm_substream *subs, int cmd)
731{
732 struct vx_core *chip = snd_pcm_substream_chip(subs);
733 struct vx_pipe *pipe = subs->runtime->private_data;
734 int err;
735
736 if (chip->chip_status & VX_STAT_IS_STALE)
737 return -EBUSY;
738
739 switch (cmd) {
740 case SNDRV_PCM_TRIGGER_START:
741 case SNDRV_PCM_TRIGGER_RESUME:
742 if (! pipe->is_capture)
743 vx_pcm_playback_transfer(chip, subs, pipe, 2);
744 err = vx_start_stream(chip, pipe);
745 if (err < 0) {
746 pr_debug("vx: cannot start stream\n");
747 return err;
748 }
749 err = vx_toggle_pipe(chip, pipe, 1);
750 if (err < 0) {
751 pr_debug("vx: cannot start pipe\n");
752 vx_stop_stream(chip, pipe);
753 return err;
754 }
755 chip->pcm_running++;
756 pipe->running = 1;
757 break;
758 case SNDRV_PCM_TRIGGER_STOP:
759 case SNDRV_PCM_TRIGGER_SUSPEND:
760 vx_toggle_pipe(chip, pipe, 0);
761 vx_stop_pipe(chip, pipe);
762 vx_stop_stream(chip, pipe);
763 chip->pcm_running--;
764 pipe->running = 0;
765 break;
766 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
767 if ((err = vx_toggle_pipe(chip, pipe, 0)) < 0)
768 return err;
769 break;
770 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
771 if ((err = vx_toggle_pipe(chip, pipe, 1)) < 0)
772 return err;
773 break;
774 default:
775 return -EINVAL;
776 }
777 return 0;
778}
779
780
781
782
783static snd_pcm_uframes_t vx_pcm_playback_pointer(struct snd_pcm_substream *subs)
784{
785 struct snd_pcm_runtime *runtime = subs->runtime;
786 struct vx_pipe *pipe = runtime->private_data;
787 return pipe->position;
788}
789
790
791
792
793static int vx_pcm_hw_params(struct snd_pcm_substream *subs,
794 struct snd_pcm_hw_params *hw_params)
795{
796 return snd_pcm_lib_alloc_vmalloc_32_buffer
797 (subs, params_buffer_bytes(hw_params));
798}
799
800
801
802
803static int vx_pcm_hw_free(struct snd_pcm_substream *subs)
804{
805 return snd_pcm_lib_free_vmalloc_buffer(subs);
806}
807
808
809
810
811static int vx_pcm_prepare(struct snd_pcm_substream *subs)
812{
813 struct vx_core *chip = snd_pcm_substream_chip(subs);
814 struct snd_pcm_runtime *runtime = subs->runtime;
815 struct vx_pipe *pipe = runtime->private_data;
816 int err, data_mode;
817
818
819 if (chip->chip_status & VX_STAT_IS_STALE)
820 return -EBUSY;
821
822 data_mode = (chip->uer_bits & IEC958_AES0_NONAUDIO) != 0;
823 if (data_mode != pipe->data_mode && ! pipe->is_capture) {
824
825
826 struct vx_rmh rmh;
827 snd_printdd(KERN_DEBUG "reopen the pipe with data_mode = %d\n", data_mode);
828 vx_init_rmh(&rmh, CMD_FREE_PIPE);
829 vx_set_pipe_cmd_params(&rmh, 0, pipe->number, 0);
830 if ((err = vx_send_msg(chip, &rmh)) < 0)
831 return err;
832 vx_init_rmh(&rmh, CMD_RES_PIPE);
833 vx_set_pipe_cmd_params(&rmh, 0, pipe->number, pipe->channels);
834 if (data_mode)
835 rmh.Cmd[0] |= BIT_DATA_MODE;
836 if ((err = vx_send_msg(chip, &rmh)) < 0)
837 return err;
838 pipe->data_mode = data_mode;
839 }
840
841 if (chip->pcm_running && chip->freq != runtime->rate) {
842 snd_printk(KERN_ERR "vx: cannot set different clock %d "
843 "from the current %d\n", runtime->rate, chip->freq);
844 return -EINVAL;
845 }
846 vx_set_clock(chip, runtime->rate);
847
848 if ((err = vx_set_format(chip, pipe, runtime)) < 0)
849 return err;
850
851 if (vx_is_pcmcia(chip)) {
852 pipe->align = 2;
853 } else {
854 pipe->align = 4;
855 }
856
857 pipe->buffer_bytes = frames_to_bytes(runtime, runtime->buffer_size);
858 pipe->period_bytes = frames_to_bytes(runtime, runtime->period_size);
859 pipe->hw_ptr = 0;
860
861
862 vx_update_pipe_position(chip, runtime, pipe);
863
864 pipe->transferred = 0;
865 pipe->position = 0;
866
867 pipe->prepared = 1;
868
869 return 0;
870}
871
872
873
874
875
876static struct snd_pcm_ops vx_pcm_playback_ops = {
877 .open = vx_pcm_playback_open,
878 .close = vx_pcm_playback_close,
879 .ioctl = snd_pcm_lib_ioctl,
880 .hw_params = vx_pcm_hw_params,
881 .hw_free = vx_pcm_hw_free,
882 .prepare = vx_pcm_prepare,
883 .trigger = vx_pcm_trigger,
884 .pointer = vx_pcm_playback_pointer,
885 .page = snd_pcm_lib_get_vmalloc_page,
886 .mmap = snd_pcm_lib_mmap_vmalloc,
887};
888
889
890
891
892
893
894static struct snd_pcm_hardware vx_pcm_capture_hw = {
895 .info = (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
896 SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_MMAP_VALID
897 ),
898 .formats = (
899 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_3LE),
900 .rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000,
901 .rate_min = 5000,
902 .rate_max = 48000,
903 .channels_min = 1,
904 .channels_max = 2,
905 .buffer_bytes_max = (128*1024),
906 .period_bytes_min = 126,
907 .period_bytes_max = (128*1024),
908 .periods_min = 2,
909 .periods_max = VX_MAX_PERIODS,
910 .fifo_size = 126,
911};
912
913
914
915
916
917static int vx_pcm_capture_open(struct snd_pcm_substream *subs)
918{
919 struct snd_pcm_runtime *runtime = subs->runtime;
920 struct vx_core *chip = snd_pcm_substream_chip(subs);
921 struct vx_pipe *pipe;
922 struct vx_pipe *pipe_out_monitoring = NULL;
923 unsigned int audio;
924 int err;
925
926 if (chip->chip_status & VX_STAT_IS_STALE)
927 return -EBUSY;
928
929 audio = subs->pcm->device * 2;
930 if (snd_BUG_ON(audio >= chip->audio_ins))
931 return -EINVAL;
932 err = vx_alloc_pipe(chip, 1, audio, 2, &pipe);
933 if (err < 0)
934 return err;
935 pipe->substream = subs;
936 chip->capture_pipes[audio] = pipe;
937
938
939 if (chip->audio_monitor_active[audio]) {
940 pipe_out_monitoring = chip->playback_pipes[audio];
941 if (! pipe_out_monitoring) {
942
943 err = vx_alloc_pipe(chip, 0, audio, 2, &pipe_out_monitoring);
944 if (err < 0)
945 return err;
946 chip->playback_pipes[audio] = pipe_out_monitoring;
947 }
948 pipe_out_monitoring->references++;
949
950
951
952
953 vx_set_monitor_level(chip, audio, chip->audio_monitor[audio],
954 chip->audio_monitor_active[audio]);
955
956 vx_set_monitor_level(chip, audio+1, chip->audio_monitor[audio+1],
957 chip->audio_monitor_active[audio+1]);
958 }
959
960 pipe->monitoring_pipe = pipe_out_monitoring;
961
962 runtime->hw = vx_pcm_capture_hw;
963 runtime->hw.period_bytes_min = chip->ibl.size;
964 runtime->private_data = pipe;
965
966
967 snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_BYTES, 4);
968 snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 4);
969
970 return 0;
971}
972
973
974
975
976static int vx_pcm_capture_close(struct snd_pcm_substream *subs)
977{
978 struct vx_core *chip = snd_pcm_substream_chip(subs);
979 struct vx_pipe *pipe;
980 struct vx_pipe *pipe_out_monitoring;
981
982 if (! subs->runtime->private_data)
983 return -EINVAL;
984 pipe = subs->runtime->private_data;
985 chip->capture_pipes[pipe->number] = NULL;
986
987 pipe_out_monitoring = pipe->monitoring_pipe;
988
989
990
991
992
993 if (pipe_out_monitoring) {
994 if (--pipe_out_monitoring->references == 0) {
995 vx_free_pipe(chip, pipe_out_monitoring);
996 chip->playback_pipes[pipe->number] = NULL;
997 pipe->monitoring_pipe = NULL;
998 }
999 }
1000
1001 vx_free_pipe(chip, pipe);
1002 return 0;
1003}
1004
1005
1006
1007#define DMA_READ_ALIGN 6
1008
1009
1010
1011
1012static void vx_pcm_capture_update(struct vx_core *chip, struct snd_pcm_substream *subs,
1013 struct vx_pipe *pipe)
1014{
1015 int size, space, count;
1016 struct snd_pcm_runtime *runtime = subs->runtime;
1017
1018 if (! pipe->prepared || (chip->chip_status & VX_STAT_IS_STALE))
1019 return;
1020
1021 size = runtime->buffer_size - snd_pcm_capture_avail(runtime);
1022 if (! size)
1023 return;
1024 size = frames_to_bytes(runtime, size);
1025 space = vx_query_hbuffer_size(chip, pipe);
1026 if (space < 0)
1027 goto _error;
1028 if (size > space)
1029 size = space;
1030 size = (size / 3) * 3;
1031 if (size < DMA_READ_ALIGN)
1032 goto _error;
1033
1034
1035 count = size - DMA_READ_ALIGN;
1036
1037
1038
1039 while (count > 0) {
1040 if ((pipe->hw_ptr % pipe->align) == 0)
1041 break;
1042 if (vx_wait_for_rx_full(chip) < 0)
1043 goto _error;
1044 vx_pcm_read_per_bytes(chip, runtime, pipe);
1045 count -= 3;
1046 }
1047 if (count > 0) {
1048
1049 int align = pipe->align * 3;
1050 space = (count / align) * align;
1051 vx_pseudo_dma_read(chip, runtime, pipe, space);
1052 count -= space;
1053 }
1054
1055 while (count > 0) {
1056 if (vx_wait_for_rx_full(chip) < 0)
1057 goto _error;
1058 vx_pcm_read_per_bytes(chip, runtime, pipe);
1059 count -= 3;
1060 }
1061
1062 vx_send_rih(chip, IRQ_CONNECT_STREAM_NEXT);
1063
1064 count = DMA_READ_ALIGN;
1065 while (count > 0) {
1066 vx_pcm_read_per_bytes(chip, runtime, pipe);
1067 count -= 3;
1068 }
1069
1070 pipe->transferred += size;
1071 if (pipe->transferred >= pipe->period_bytes) {
1072 pipe->transferred %= pipe->period_bytes;
1073 snd_pcm_period_elapsed(subs);
1074 }
1075 return;
1076
1077 _error:
1078
1079 vx_send_rih(chip, IRQ_CONNECT_STREAM_NEXT);
1080 return;
1081}
1082
1083
1084
1085
1086static snd_pcm_uframes_t vx_pcm_capture_pointer(struct snd_pcm_substream *subs)
1087{
1088 struct snd_pcm_runtime *runtime = subs->runtime;
1089 struct vx_pipe *pipe = runtime->private_data;
1090 return bytes_to_frames(runtime, pipe->hw_ptr);
1091}
1092
1093
1094
1095
1096static struct snd_pcm_ops vx_pcm_capture_ops = {
1097 .open = vx_pcm_capture_open,
1098 .close = vx_pcm_capture_close,
1099 .ioctl = snd_pcm_lib_ioctl,
1100 .hw_params = vx_pcm_hw_params,
1101 .hw_free = vx_pcm_hw_free,
1102 .prepare = vx_pcm_prepare,
1103 .trigger = vx_pcm_trigger,
1104 .pointer = vx_pcm_capture_pointer,
1105 .page = snd_pcm_lib_get_vmalloc_page,
1106 .mmap = snd_pcm_lib_mmap_vmalloc,
1107};
1108
1109
1110
1111
1112
1113void vx_pcm_update_intr(struct vx_core *chip, unsigned int events)
1114{
1115 unsigned int i;
1116 struct vx_pipe *pipe;
1117
1118#define EVENT_MASK (END_OF_BUFFER_EVENTS_PENDING|ASYNC_EVENTS_PENDING)
1119
1120 if (events & EVENT_MASK) {
1121 vx_init_rmh(&chip->irq_rmh, CMD_ASYNC);
1122 if (events & ASYNC_EVENTS_PENDING)
1123 chip->irq_rmh.Cmd[0] |= 0x00000001;
1124 if (events & END_OF_BUFFER_EVENTS_PENDING)
1125 chip->irq_rmh.Cmd[0] |= 0x00000002;
1126
1127 if (vx_send_msg(chip, &chip->irq_rmh) < 0) {
1128 snd_printdd(KERN_ERR "msg send error!!\n");
1129 return;
1130 }
1131
1132 i = 1;
1133 while (i < chip->irq_rmh.LgStat) {
1134 int p, buf, capture, eob;
1135 p = chip->irq_rmh.Stat[i] & MASK_FIRST_FIELD;
1136 capture = (chip->irq_rmh.Stat[i] & 0x400000) ? 1 : 0;
1137 eob = (chip->irq_rmh.Stat[i] & 0x800000) ? 1 : 0;
1138 i++;
1139 if (events & ASYNC_EVENTS_PENDING)
1140 i++;
1141 buf = 1;
1142 if (events & END_OF_BUFFER_EVENTS_PENDING) {
1143 if (eob)
1144 buf = chip->irq_rmh.Stat[i];
1145 i++;
1146 }
1147 if (capture)
1148 continue;
1149 if (snd_BUG_ON(p < 0 || p >= chip->audio_outs))
1150 continue;
1151 pipe = chip->playback_pipes[p];
1152 if (pipe && pipe->substream) {
1153 vx_pcm_playback_update(chip, pipe->substream, pipe);
1154 vx_pcm_playback_transfer(chip, pipe->substream, pipe, buf);
1155 }
1156 }
1157 }
1158
1159
1160 for (i = 0; i < chip->audio_ins; i++) {
1161 pipe = chip->capture_pipes[i];
1162 if (pipe && pipe->substream)
1163 vx_pcm_capture_update(chip, pipe->substream, pipe);
1164 }
1165}
1166
1167
1168
1169
1170
1171static int vx_init_audio_io(struct vx_core *chip)
1172{
1173 struct vx_rmh rmh;
1174 int preferred;
1175
1176 vx_init_rmh(&rmh, CMD_SUPPORTED);
1177 if (vx_send_msg(chip, &rmh) < 0) {
1178 snd_printk(KERN_ERR "vx: cannot get the supported audio data\n");
1179 return -ENXIO;
1180 }
1181
1182 chip->audio_outs = rmh.Stat[0] & MASK_FIRST_FIELD;
1183 chip->audio_ins = (rmh.Stat[0] >> (FIELD_SIZE*2)) & MASK_FIRST_FIELD;
1184 chip->audio_info = rmh.Stat[1];
1185
1186
1187 chip->playback_pipes = kcalloc(chip->audio_outs, sizeof(struct vx_pipe *), GFP_KERNEL);
1188 if (!chip->playback_pipes)
1189 return -ENOMEM;
1190 chip->capture_pipes = kcalloc(chip->audio_ins, sizeof(struct vx_pipe *), GFP_KERNEL);
1191 if (!chip->capture_pipes) {
1192 kfree(chip->playback_pipes);
1193 return -ENOMEM;
1194 }
1195
1196 preferred = chip->ibl.size;
1197 chip->ibl.size = 0;
1198 vx_set_ibl(chip, &chip->ibl);
1199 if (preferred > 0) {
1200 chip->ibl.size = ((preferred + chip->ibl.granularity - 1) /
1201 chip->ibl.granularity) * chip->ibl.granularity;
1202 if (chip->ibl.size > chip->ibl.max_size)
1203 chip->ibl.size = chip->ibl.max_size;
1204 } else
1205 chip->ibl.size = chip->ibl.min_size;
1206 vx_set_ibl(chip, &chip->ibl);
1207
1208 return 0;
1209}
1210
1211
1212
1213
1214
1215static void snd_vx_pcm_free(struct snd_pcm *pcm)
1216{
1217 struct vx_core *chip = pcm->private_data;
1218 chip->pcm[pcm->device] = NULL;
1219 kfree(chip->playback_pipes);
1220 chip->playback_pipes = NULL;
1221 kfree(chip->capture_pipes);
1222 chip->capture_pipes = NULL;
1223}
1224
1225
1226
1227
1228int snd_vx_pcm_new(struct vx_core *chip)
1229{
1230 struct snd_pcm *pcm;
1231 unsigned int i;
1232 int err;
1233
1234 if ((err = vx_init_audio_io(chip)) < 0)
1235 return err;
1236
1237 for (i = 0; i < chip->hw->num_codecs; i++) {
1238 unsigned int outs, ins;
1239 outs = chip->audio_outs > i * 2 ? 1 : 0;
1240 ins = chip->audio_ins > i * 2 ? 1 : 0;
1241 if (! outs && ! ins)
1242 break;
1243 err = snd_pcm_new(chip->card, "VX PCM", i,
1244 outs, ins, &pcm);
1245 if (err < 0)
1246 return err;
1247 if (outs)
1248 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &vx_pcm_playback_ops);
1249 if (ins)
1250 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &vx_pcm_capture_ops);
1251
1252 pcm->private_data = chip;
1253 pcm->private_free = snd_vx_pcm_free;
1254 pcm->info_flags = 0;
1255 pcm->nonatomic = true;
1256 strcpy(pcm->name, chip->card->shortname);
1257 chip->pcm[i] = pcm;
1258 }
1259
1260 return 0;
1261}
1262