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