6db4831e98
Android 14
1262 lines
33 KiB
C
1262 lines
33 KiB
C
/*
|
|
* Driver for Digigram VX soundcards
|
|
*
|
|
* PCM part
|
|
*
|
|
* Copyright (c) 2002,2003 by Takashi Iwai <tiwai@suse.de>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*
|
|
*
|
|
* STRATEGY
|
|
* for playback, we send series of "chunks", which size is equal with the
|
|
* IBL size, typically 126 samples. at each end of chunk, the end-of-buffer
|
|
* interrupt is notified, and the interrupt handler will feed the next chunk.
|
|
*
|
|
* the current position is calculated from the sample count RMH.
|
|
* pipe->transferred is the counter of data which has been already transferred.
|
|
* if this counter reaches to the period size, snd_pcm_period_elapsed() will
|
|
* be issued.
|
|
*
|
|
* for capture, the situation is much easier.
|
|
* to get a low latency response, we'll check the capture streams at each
|
|
* interrupt (capture stream has no EOB notification). if the pending
|
|
* data is accumulated to the period size, snd_pcm_period_elapsed() is
|
|
* called and the pointer is updated.
|
|
*
|
|
* the current point of read buffer is kept in pipe->hw_ptr. note that
|
|
* this is in bytes.
|
|
*
|
|
*
|
|
* TODO
|
|
* - linked trigger for full-duplex mode.
|
|
* - scheduled action on the stream.
|
|
*/
|
|
|
|
#include <linux/slab.h>
|
|
#include <linux/delay.h>
|
|
#include <sound/core.h>
|
|
#include <sound/asoundef.h>
|
|
#include <sound/pcm.h>
|
|
#include <sound/vx_core.h>
|
|
#include "vx_cmd.h"
|
|
|
|
|
|
/*
|
|
* read three pending pcm bytes via inb()
|
|
*/
|
|
static void vx_pcm_read_per_bytes(struct vx_core *chip, struct snd_pcm_runtime *runtime,
|
|
struct vx_pipe *pipe)
|
|
{
|
|
int offset = pipe->hw_ptr;
|
|
unsigned char *buf = (unsigned char *)(runtime->dma_area + offset);
|
|
*buf++ = vx_inb(chip, RXH);
|
|
if (++offset >= pipe->buffer_bytes) {
|
|
offset = 0;
|
|
buf = (unsigned char *)runtime->dma_area;
|
|
}
|
|
*buf++ = vx_inb(chip, RXM);
|
|
if (++offset >= pipe->buffer_bytes) {
|
|
offset = 0;
|
|
buf = (unsigned char *)runtime->dma_area;
|
|
}
|
|
*buf++ = vx_inb(chip, RXL);
|
|
if (++offset >= pipe->buffer_bytes) {
|
|
offset = 0;
|
|
buf = (unsigned char *)runtime->dma_area;
|
|
}
|
|
pipe->hw_ptr = offset;
|
|
}
|
|
|
|
/*
|
|
* vx_set_pcx_time - convert from the PC time to the RMH status time.
|
|
* @pc_time: the pointer for the PC-time to set
|
|
* @dsp_time: the pointer for RMH status time array
|
|
*/
|
|
static void vx_set_pcx_time(struct vx_core *chip, pcx_time_t *pc_time,
|
|
unsigned int *dsp_time)
|
|
{
|
|
dsp_time[0] = (unsigned int)((*pc_time) >> 24) & PCX_TIME_HI_MASK;
|
|
dsp_time[1] = (unsigned int)(*pc_time) & MASK_DSP_WORD;
|
|
}
|
|
|
|
/*
|
|
* vx_set_differed_time - set the differed time if specified
|
|
* @rmh: the rmh record to modify
|
|
* @pipe: the pipe to be checked
|
|
*
|
|
* if the pipe is programmed with the differed time, set the DSP time
|
|
* on the rmh and changes its command length.
|
|
*
|
|
* returns the increase of the command length.
|
|
*/
|
|
static int vx_set_differed_time(struct vx_core *chip, struct vx_rmh *rmh,
|
|
struct vx_pipe *pipe)
|
|
{
|
|
/* Update The length added to the RMH command by the timestamp */
|
|
if (! (pipe->differed_type & DC_DIFFERED_DELAY))
|
|
return 0;
|
|
|
|
/* Set the T bit */
|
|
rmh->Cmd[0] |= DSP_DIFFERED_COMMAND_MASK;
|
|
|
|
/* Time stamp is the 1st following parameter */
|
|
vx_set_pcx_time(chip, &pipe->pcx_time, &rmh->Cmd[1]);
|
|
|
|
/* Add the flags to a notified differed command */
|
|
if (pipe->differed_type & DC_NOTIFY_DELAY)
|
|
rmh->Cmd[1] |= NOTIFY_MASK_TIME_HIGH ;
|
|
|
|
/* Add the flags to a multiple differed command */
|
|
if (pipe->differed_type & DC_MULTIPLE_DELAY)
|
|
rmh->Cmd[1] |= MULTIPLE_MASK_TIME_HIGH;
|
|
|
|
/* Add the flags to a stream-time differed command */
|
|
if (pipe->differed_type & DC_STREAM_TIME_DELAY)
|
|
rmh->Cmd[1] |= STREAM_MASK_TIME_HIGH;
|
|
|
|
rmh->LgCmd += 2;
|
|
return 2;
|
|
}
|
|
|
|
/*
|
|
* vx_set_stream_format - send the stream format command
|
|
* @pipe: the affected pipe
|
|
* @data: format bitmask
|
|
*/
|
|
static int vx_set_stream_format(struct vx_core *chip, struct vx_pipe *pipe,
|
|
unsigned int data)
|
|
{
|
|
struct vx_rmh rmh;
|
|
|
|
vx_init_rmh(&rmh, pipe->is_capture ?
|
|
CMD_FORMAT_STREAM_IN : CMD_FORMAT_STREAM_OUT);
|
|
rmh.Cmd[0] |= pipe->number << FIELD_SIZE;
|
|
|
|
/* Command might be longer since we may have to add a timestamp */
|
|
vx_set_differed_time(chip, &rmh, pipe);
|
|
|
|
rmh.Cmd[rmh.LgCmd] = (data & 0xFFFFFF00) >> 8;
|
|
rmh.Cmd[rmh.LgCmd + 1] = (data & 0xFF) << 16 /*| (datal & 0xFFFF00) >> 8*/;
|
|
rmh.LgCmd += 2;
|
|
|
|
return vx_send_msg(chip, &rmh);
|
|
}
|
|
|
|
|
|
/*
|
|
* vx_set_format - set the format of a pipe
|
|
* @pipe: the affected pipe
|
|
* @runtime: pcm runtime instance to be referred
|
|
*
|
|
* returns 0 if successful, or a negative error code.
|
|
*/
|
|
static int vx_set_format(struct vx_core *chip, struct vx_pipe *pipe,
|
|
struct snd_pcm_runtime *runtime)
|
|
{
|
|
unsigned int header = HEADER_FMT_BASE;
|
|
|
|
if (runtime->channels == 1)
|
|
header |= HEADER_FMT_MONO;
|
|
if (snd_pcm_format_little_endian(runtime->format))
|
|
header |= HEADER_FMT_INTEL;
|
|
if (runtime->rate < 32000 && runtime->rate > 11025)
|
|
header |= HEADER_FMT_UPTO32;
|
|
else if (runtime->rate <= 11025)
|
|
header |= HEADER_FMT_UPTO11;
|
|
|
|
switch (snd_pcm_format_physical_width(runtime->format)) {
|
|
// case 8: break;
|
|
case 16: header |= HEADER_FMT_16BITS; break;
|
|
case 24: header |= HEADER_FMT_24BITS; break;
|
|
default :
|
|
snd_BUG();
|
|
return -EINVAL;
|
|
}
|
|
|
|
return vx_set_stream_format(chip, pipe, header);
|
|
}
|
|
|
|
/*
|
|
* set / query the IBL size
|
|
*/
|
|
static int vx_set_ibl(struct vx_core *chip, struct vx_ibl_info *info)
|
|
{
|
|
int err;
|
|
struct vx_rmh rmh;
|
|
|
|
vx_init_rmh(&rmh, CMD_IBL);
|
|
rmh.Cmd[0] |= info->size & 0x03ffff;
|
|
err = vx_send_msg(chip, &rmh);
|
|
if (err < 0)
|
|
return err;
|
|
info->size = rmh.Stat[0];
|
|
info->max_size = rmh.Stat[1];
|
|
info->min_size = rmh.Stat[2];
|
|
info->granularity = rmh.Stat[3];
|
|
snd_printdd(KERN_DEBUG "vx_set_ibl: size = %d, max = %d, min = %d, gran = %d\n",
|
|
info->size, info->max_size, info->min_size, info->granularity);
|
|
return 0;
|
|
}
|
|
|
|
|
|
/*
|
|
* vx_get_pipe_state - get the state of a pipe
|
|
* @pipe: the pipe to be checked
|
|
* @state: the pointer for the returned state
|
|
*
|
|
* checks the state of a given pipe, and stores the state (1 = running,
|
|
* 0 = paused) on the given pointer.
|
|
*
|
|
* called from trigger callback only
|
|
*/
|
|
static int vx_get_pipe_state(struct vx_core *chip, struct vx_pipe *pipe, int *state)
|
|
{
|
|
int err;
|
|
struct vx_rmh rmh;
|
|
|
|
vx_init_rmh(&rmh, CMD_PIPE_STATE);
|
|
vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
|
|
err = vx_send_msg(chip, &rmh);
|
|
if (! err)
|
|
*state = (rmh.Stat[0] & (1 << pipe->number)) ? 1 : 0;
|
|
return err;
|
|
}
|
|
|
|
|
|
/*
|
|
* vx_query_hbuffer_size - query available h-buffer size in bytes
|
|
* @pipe: the pipe to be checked
|
|
*
|
|
* return the available size on h-buffer in bytes,
|
|
* or a negative error code.
|
|
*
|
|
* NOTE: calling this function always switches to the stream mode.
|
|
* you'll need to disconnect the host to get back to the
|
|
* normal mode.
|
|
*/
|
|
static int vx_query_hbuffer_size(struct vx_core *chip, struct vx_pipe *pipe)
|
|
{
|
|
int result;
|
|
struct vx_rmh rmh;
|
|
|
|
vx_init_rmh(&rmh, CMD_SIZE_HBUFFER);
|
|
vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
|
|
if (pipe->is_capture)
|
|
rmh.Cmd[0] |= 0x00000001;
|
|
result = vx_send_msg(chip, &rmh);
|
|
if (! result)
|
|
result = rmh.Stat[0] & 0xffff;
|
|
return result;
|
|
}
|
|
|
|
|
|
/*
|
|
* vx_pipe_can_start - query whether a pipe is ready for start
|
|
* @pipe: the pipe to be checked
|
|
*
|
|
* return 1 if ready, 0 if not ready, and negative value on error.
|
|
*
|
|
* called from trigger callback only
|
|
*/
|
|
static int vx_pipe_can_start(struct vx_core *chip, struct vx_pipe *pipe)
|
|
{
|
|
int err;
|
|
struct vx_rmh rmh;
|
|
|
|
vx_init_rmh(&rmh, CMD_CAN_START_PIPE);
|
|
vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
|
|
rmh.Cmd[0] |= 1;
|
|
|
|
err = vx_send_msg(chip, &rmh);
|
|
if (! err) {
|
|
if (rmh.Stat[0])
|
|
err = 1;
|
|
}
|
|
return err;
|
|
}
|
|
|
|
/*
|
|
* vx_conf_pipe - tell the pipe to stand by and wait for IRQA.
|
|
* @pipe: the pipe to be configured
|
|
*/
|
|
static int vx_conf_pipe(struct vx_core *chip, struct vx_pipe *pipe)
|
|
{
|
|
struct vx_rmh rmh;
|
|
|
|
vx_init_rmh(&rmh, CMD_CONF_PIPE);
|
|
if (pipe->is_capture)
|
|
rmh.Cmd[0] |= COMMAND_RECORD_MASK;
|
|
rmh.Cmd[1] = 1 << pipe->number;
|
|
return vx_send_msg(chip, &rmh);
|
|
}
|
|
|
|
/*
|
|
* vx_send_irqa - trigger IRQA
|
|
*/
|
|
static int vx_send_irqa(struct vx_core *chip)
|
|
{
|
|
struct vx_rmh rmh;
|
|
|
|
vx_init_rmh(&rmh, CMD_SEND_IRQA);
|
|
return vx_send_msg(chip, &rmh);
|
|
}
|
|
|
|
|
|
#define MAX_WAIT_FOR_DSP 250
|
|
/*
|
|
* vx boards do not support inter-card sync, besides
|
|
* only 126 samples require to be prepared before a pipe can start
|
|
*/
|
|
#define CAN_START_DELAY 2 /* wait 2ms only before asking if the pipe is ready*/
|
|
#define WAIT_STATE_DELAY 2 /* wait 2ms after irqA was requested and check if the pipe state toggled*/
|
|
|
|
/*
|
|
* vx_toggle_pipe - start / pause a pipe
|
|
* @pipe: the pipe to be triggered
|
|
* @state: start = 1, pause = 0
|
|
*
|
|
* called from trigger callback only
|
|
*
|
|
*/
|
|
static int vx_toggle_pipe(struct vx_core *chip, struct vx_pipe *pipe, int state)
|
|
{
|
|
int err, i, cur_state;
|
|
|
|
/* Check the pipe is not already in the requested state */
|
|
if (vx_get_pipe_state(chip, pipe, &cur_state) < 0)
|
|
return -EBADFD;
|
|
if (state == cur_state)
|
|
return 0;
|
|
|
|
/* If a start is requested, ask the DSP to get prepared
|
|
* and wait for a positive acknowledge (when there are
|
|
* enough sound buffer for this pipe)
|
|
*/
|
|
if (state) {
|
|
for (i = 0 ; i < MAX_WAIT_FOR_DSP; i++) {
|
|
err = vx_pipe_can_start(chip, pipe);
|
|
if (err > 0)
|
|
break;
|
|
/* Wait for a few, before asking again
|
|
* to avoid flooding the DSP with our requests
|
|
*/
|
|
mdelay(1);
|
|
}
|
|
}
|
|
|
|
if ((err = vx_conf_pipe(chip, pipe)) < 0)
|
|
return err;
|
|
|
|
if ((err = vx_send_irqa(chip)) < 0)
|
|
return err;
|
|
|
|
/* If it completes successfully, wait for the pipes
|
|
* reaching the expected state before returning
|
|
* Check one pipe only (since they are synchronous)
|
|
*/
|
|
for (i = 0; i < MAX_WAIT_FOR_DSP; i++) {
|
|
err = vx_get_pipe_state(chip, pipe, &cur_state);
|
|
if (err < 0 || cur_state == state)
|
|
break;
|
|
err = -EIO;
|
|
mdelay(1);
|
|
}
|
|
return err < 0 ? -EIO : 0;
|
|
}
|
|
|
|
|
|
/*
|
|
* vx_stop_pipe - stop a pipe
|
|
* @pipe: the pipe to be stopped
|
|
*
|
|
* called from trigger callback only
|
|
*/
|
|
static int vx_stop_pipe(struct vx_core *chip, struct vx_pipe *pipe)
|
|
{
|
|
struct vx_rmh rmh;
|
|
vx_init_rmh(&rmh, CMD_STOP_PIPE);
|
|
vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
|
|
return vx_send_msg(chip, &rmh);
|
|
}
|
|
|
|
|
|
/*
|
|
* vx_alloc_pipe - allocate a pipe and initialize the pipe instance
|
|
* @capture: 0 = playback, 1 = capture operation
|
|
* @audioid: the audio id to be assigned
|
|
* @num_audio: number of audio channels
|
|
* @pipep: the returned pipe instance
|
|
*
|
|
* return 0 on success, or a negative error code.
|
|
*/
|
|
static int vx_alloc_pipe(struct vx_core *chip, int capture,
|
|
int audioid, int num_audio,
|
|
struct vx_pipe **pipep)
|
|
{
|
|
int err;
|
|
struct vx_pipe *pipe;
|
|
struct vx_rmh rmh;
|
|
int data_mode;
|
|
|
|
*pipep = NULL;
|
|
vx_init_rmh(&rmh, CMD_RES_PIPE);
|
|
vx_set_pipe_cmd_params(&rmh, capture, audioid, num_audio);
|
|
#if 0 // NYI
|
|
if (underrun_skip_sound)
|
|
rmh.Cmd[0] |= BIT_SKIP_SOUND;
|
|
#endif // NYI
|
|
data_mode = (chip->uer_bits & IEC958_AES0_NONAUDIO) != 0;
|
|
if (! capture && data_mode)
|
|
rmh.Cmd[0] |= BIT_DATA_MODE;
|
|
err = vx_send_msg(chip, &rmh);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
/* initialize the pipe record */
|
|
pipe = kzalloc(sizeof(*pipe), GFP_KERNEL);
|
|
if (! pipe) {
|
|
/* release the pipe */
|
|
vx_init_rmh(&rmh, CMD_FREE_PIPE);
|
|
vx_set_pipe_cmd_params(&rmh, capture, audioid, 0);
|
|
vx_send_msg(chip, &rmh);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
/* the pipe index should be identical with the audio index */
|
|
pipe->number = audioid;
|
|
pipe->is_capture = capture;
|
|
pipe->channels = num_audio;
|
|
pipe->differed_type = 0;
|
|
pipe->pcx_time = 0;
|
|
pipe->data_mode = data_mode;
|
|
*pipep = pipe;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/*
|
|
* vx_free_pipe - release a pipe
|
|
* @pipe: pipe to be released
|
|
*/
|
|
static int vx_free_pipe(struct vx_core *chip, struct vx_pipe *pipe)
|
|
{
|
|
struct vx_rmh rmh;
|
|
|
|
vx_init_rmh(&rmh, CMD_FREE_PIPE);
|
|
vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
|
|
vx_send_msg(chip, &rmh);
|
|
|
|
kfree(pipe);
|
|
return 0;
|
|
}
|
|
|
|
|
|
/*
|
|
* vx_start_stream - start the stream
|
|
*
|
|
* called from trigger callback only
|
|
*/
|
|
static int vx_start_stream(struct vx_core *chip, struct vx_pipe *pipe)
|
|
{
|
|
struct vx_rmh rmh;
|
|
|
|
vx_init_rmh(&rmh, CMD_START_ONE_STREAM);
|
|
vx_set_stream_cmd_params(&rmh, pipe->is_capture, pipe->number);
|
|
vx_set_differed_time(chip, &rmh, pipe);
|
|
return vx_send_msg(chip, &rmh);
|
|
}
|
|
|
|
|
|
/*
|
|
* vx_stop_stream - stop the stream
|
|
*
|
|
* called from trigger callback only
|
|
*/
|
|
static int vx_stop_stream(struct vx_core *chip, struct vx_pipe *pipe)
|
|
{
|
|
struct vx_rmh rmh;
|
|
|
|
vx_init_rmh(&rmh, CMD_STOP_STREAM);
|
|
vx_set_stream_cmd_params(&rmh, pipe->is_capture, pipe->number);
|
|
return vx_send_msg(chip, &rmh);
|
|
}
|
|
|
|
|
|
/*
|
|
* playback hw information
|
|
*/
|
|
|
|
static const struct snd_pcm_hardware vx_pcm_playback_hw = {
|
|
.info = (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
|
|
SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_MMAP_VALID /*|*/
|
|
/*SNDRV_PCM_INFO_RESUME*/),
|
|
.formats = (/*SNDRV_PCM_FMTBIT_U8 |*/
|
|
SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_3LE),
|
|
.rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000,
|
|
.rate_min = 5000,
|
|
.rate_max = 48000,
|
|
.channels_min = 1,
|
|
.channels_max = 2,
|
|
.buffer_bytes_max = (128*1024),
|
|
.period_bytes_min = 126,
|
|
.period_bytes_max = (128*1024),
|
|
.periods_min = 2,
|
|
.periods_max = VX_MAX_PERIODS,
|
|
.fifo_size = 126,
|
|
};
|
|
|
|
|
|
/*
|
|
* vx_pcm_playback_open - open callback for playback
|
|
*/
|
|
static int vx_pcm_playback_open(struct snd_pcm_substream *subs)
|
|
{
|
|
struct snd_pcm_runtime *runtime = subs->runtime;
|
|
struct vx_core *chip = snd_pcm_substream_chip(subs);
|
|
struct vx_pipe *pipe = NULL;
|
|
unsigned int audio;
|
|
int err;
|
|
|
|
if (chip->chip_status & VX_STAT_IS_STALE)
|
|
return -EBUSY;
|
|
|
|
audio = subs->pcm->device * 2;
|
|
if (snd_BUG_ON(audio >= chip->audio_outs))
|
|
return -EINVAL;
|
|
|
|
/* playback pipe may have been already allocated for monitoring */
|
|
pipe = chip->playback_pipes[audio];
|
|
if (! pipe) {
|
|
/* not allocated yet */
|
|
err = vx_alloc_pipe(chip, 0, audio, 2, &pipe); /* stereo playback */
|
|
if (err < 0)
|
|
return err;
|
|
chip->playback_pipes[audio] = pipe;
|
|
}
|
|
/* open for playback */
|
|
pipe->references++;
|
|
|
|
pipe->substream = subs;
|
|
chip->playback_pipes[audio] = pipe;
|
|
|
|
runtime->hw = vx_pcm_playback_hw;
|
|
runtime->hw.period_bytes_min = chip->ibl.size;
|
|
runtime->private_data = pipe;
|
|
|
|
/* align to 4 bytes (otherwise will be problematic when 24bit is used) */
|
|
snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_BYTES, 4);
|
|
snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 4);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* vx_pcm_playback_close - close callback for playback
|
|
*/
|
|
static int vx_pcm_playback_close(struct snd_pcm_substream *subs)
|
|
{
|
|
struct vx_core *chip = snd_pcm_substream_chip(subs);
|
|
struct vx_pipe *pipe;
|
|
|
|
if (! subs->runtime->private_data)
|
|
return -EINVAL;
|
|
|
|
pipe = subs->runtime->private_data;
|
|
|
|
if (--pipe->references == 0) {
|
|
chip->playback_pipes[pipe->number] = NULL;
|
|
vx_free_pipe(chip, pipe);
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
/*
|
|
* vx_notify_end_of_buffer - send "end-of-buffer" notifier at the given pipe
|
|
* @pipe: the pipe to notify
|
|
*
|
|
* NB: call with a certain lock.
|
|
*/
|
|
static int vx_notify_end_of_buffer(struct vx_core *chip, struct vx_pipe *pipe)
|
|
{
|
|
int err;
|
|
struct vx_rmh rmh; /* use a temporary rmh here */
|
|
|
|
/* Toggle Dsp Host Interface into Message mode */
|
|
vx_send_rih_nolock(chip, IRQ_PAUSE_START_CONNECT);
|
|
vx_init_rmh(&rmh, CMD_NOTIFY_END_OF_BUFFER);
|
|
vx_set_stream_cmd_params(&rmh, 0, pipe->number);
|
|
err = vx_send_msg_nolock(chip, &rmh);
|
|
if (err < 0)
|
|
return err;
|
|
/* Toggle Dsp Host Interface back to sound transfer mode */
|
|
vx_send_rih_nolock(chip, IRQ_PAUSE_START_CONNECT);
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* vx_pcm_playback_transfer_chunk - transfer a single chunk
|
|
* @subs: substream
|
|
* @pipe: the pipe to transfer
|
|
* @size: chunk size in bytes
|
|
*
|
|
* transfer a single buffer chunk. EOB notificaton is added after that.
|
|
* called from the interrupt handler, too.
|
|
*
|
|
* return 0 if ok.
|
|
*/
|
|
static int vx_pcm_playback_transfer_chunk(struct vx_core *chip,
|
|
struct snd_pcm_runtime *runtime,
|
|
struct vx_pipe *pipe, int size)
|
|
{
|
|
int space, err = 0;
|
|
|
|
space = vx_query_hbuffer_size(chip, pipe);
|
|
if (space < 0) {
|
|
/* disconnect the host, SIZE_HBUF command always switches to the stream mode */
|
|
vx_send_rih(chip, IRQ_CONNECT_STREAM_NEXT);
|
|
snd_printd("error hbuffer\n");
|
|
return space;
|
|
}
|
|
if (space < size) {
|
|
vx_send_rih(chip, IRQ_CONNECT_STREAM_NEXT);
|
|
snd_printd("no enough hbuffer space %d\n", space);
|
|
return -EIO; /* XRUN */
|
|
}
|
|
|
|
/* we don't need irqsave here, because this function
|
|
* is called from either trigger callback or irq handler
|
|
*/
|
|
mutex_lock(&chip->lock);
|
|
vx_pseudo_dma_write(chip, runtime, pipe, size);
|
|
err = vx_notify_end_of_buffer(chip, pipe);
|
|
/* disconnect the host, SIZE_HBUF command always switches to the stream mode */
|
|
vx_send_rih_nolock(chip, IRQ_CONNECT_STREAM_NEXT);
|
|
mutex_unlock(&chip->lock);
|
|
return err;
|
|
}
|
|
|
|
/*
|
|
* update the position of the given pipe.
|
|
* pipe->position is updated and wrapped within the buffer size.
|
|
* pipe->transferred is updated, too, but the size is not wrapped,
|
|
* so that the caller can check the total transferred size later
|
|
* (to call snd_pcm_period_elapsed).
|
|
*/
|
|
static int vx_update_pipe_position(struct vx_core *chip,
|
|
struct snd_pcm_runtime *runtime,
|
|
struct vx_pipe *pipe)
|
|
{
|
|
struct vx_rmh rmh;
|
|
int err, update;
|
|
u64 count;
|
|
|
|
vx_init_rmh(&rmh, CMD_STREAM_SAMPLE_COUNT);
|
|
vx_set_pipe_cmd_params(&rmh, pipe->is_capture, pipe->number, 0);
|
|
err = vx_send_msg(chip, &rmh);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
count = ((u64)(rmh.Stat[0] & 0xfffff) << 24) | (u64)rmh.Stat[1];
|
|
update = (int)(count - pipe->cur_count);
|
|
pipe->cur_count = count;
|
|
pipe->position += update;
|
|
if (pipe->position >= (int)runtime->buffer_size)
|
|
pipe->position %= runtime->buffer_size;
|
|
pipe->transferred += update;
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* transfer the pending playback buffer data to DSP
|
|
* called from interrupt handler
|
|
*/
|
|
static void vx_pcm_playback_transfer(struct vx_core *chip,
|
|
struct snd_pcm_substream *subs,
|
|
struct vx_pipe *pipe, int nchunks)
|
|
{
|
|
int i, err;
|
|
struct snd_pcm_runtime *runtime = subs->runtime;
|
|
|
|
if (! pipe->prepared || (chip->chip_status & VX_STAT_IS_STALE))
|
|
return;
|
|
for (i = 0; i < nchunks; i++) {
|
|
if ((err = vx_pcm_playback_transfer_chunk(chip, runtime, pipe,
|
|
chip->ibl.size)) < 0)
|
|
return;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* update the playback position and call snd_pcm_period_elapsed() if necessary
|
|
* called from interrupt handler
|
|
*/
|
|
static void vx_pcm_playback_update(struct vx_core *chip,
|
|
struct snd_pcm_substream *subs,
|
|
struct vx_pipe *pipe)
|
|
{
|
|
int err;
|
|
struct snd_pcm_runtime *runtime = subs->runtime;
|
|
|
|
if (pipe->running && ! (chip->chip_status & VX_STAT_IS_STALE)) {
|
|
if ((err = vx_update_pipe_position(chip, runtime, pipe)) < 0)
|
|
return;
|
|
if (pipe->transferred >= (int)runtime->period_size) {
|
|
pipe->transferred %= runtime->period_size;
|
|
snd_pcm_period_elapsed(subs);
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* vx_pcm_playback_trigger - trigger callback for playback
|
|
*/
|
|
static int vx_pcm_trigger(struct snd_pcm_substream *subs, int cmd)
|
|
{
|
|
struct vx_core *chip = snd_pcm_substream_chip(subs);
|
|
struct vx_pipe *pipe = subs->runtime->private_data;
|
|
int err;
|
|
|
|
if (chip->chip_status & VX_STAT_IS_STALE)
|
|
return -EBUSY;
|
|
|
|
switch (cmd) {
|
|
case SNDRV_PCM_TRIGGER_START:
|
|
case SNDRV_PCM_TRIGGER_RESUME:
|
|
if (! pipe->is_capture)
|
|
vx_pcm_playback_transfer(chip, subs, pipe, 2);
|
|
err = vx_start_stream(chip, pipe);
|
|
if (err < 0) {
|
|
pr_debug("vx: cannot start stream\n");
|
|
return err;
|
|
}
|
|
err = vx_toggle_pipe(chip, pipe, 1);
|
|
if (err < 0) {
|
|
pr_debug("vx: cannot start pipe\n");
|
|
vx_stop_stream(chip, pipe);
|
|
return err;
|
|
}
|
|
chip->pcm_running++;
|
|
pipe->running = 1;
|
|
break;
|
|
case SNDRV_PCM_TRIGGER_STOP:
|
|
case SNDRV_PCM_TRIGGER_SUSPEND:
|
|
vx_toggle_pipe(chip, pipe, 0);
|
|
vx_stop_pipe(chip, pipe);
|
|
vx_stop_stream(chip, pipe);
|
|
chip->pcm_running--;
|
|
pipe->running = 0;
|
|
break;
|
|
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
|
|
if ((err = vx_toggle_pipe(chip, pipe, 0)) < 0)
|
|
return err;
|
|
break;
|
|
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
|
|
if ((err = vx_toggle_pipe(chip, pipe, 1)) < 0)
|
|
return err;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* vx_pcm_playback_pointer - pointer callback for playback
|
|
*/
|
|
static snd_pcm_uframes_t vx_pcm_playback_pointer(struct snd_pcm_substream *subs)
|
|
{
|
|
struct snd_pcm_runtime *runtime = subs->runtime;
|
|
struct vx_pipe *pipe = runtime->private_data;
|
|
return pipe->position;
|
|
}
|
|
|
|
/*
|
|
* vx_pcm_hw_params - hw_params callback for playback and capture
|
|
*/
|
|
static int vx_pcm_hw_params(struct snd_pcm_substream *subs,
|
|
struct snd_pcm_hw_params *hw_params)
|
|
{
|
|
return snd_pcm_lib_alloc_vmalloc_32_buffer
|
|
(subs, params_buffer_bytes(hw_params));
|
|
}
|
|
|
|
/*
|
|
* vx_pcm_hw_free - hw_free callback for playback and capture
|
|
*/
|
|
static int vx_pcm_hw_free(struct snd_pcm_substream *subs)
|
|
{
|
|
return snd_pcm_lib_free_vmalloc_buffer(subs);
|
|
}
|
|
|
|
/*
|
|
* vx_pcm_prepare - prepare callback for playback and capture
|
|
*/
|
|
static int vx_pcm_prepare(struct snd_pcm_substream *subs)
|
|
{
|
|
struct vx_core *chip = snd_pcm_substream_chip(subs);
|
|
struct snd_pcm_runtime *runtime = subs->runtime;
|
|
struct vx_pipe *pipe = runtime->private_data;
|
|
int err, data_mode;
|
|
// int max_size, nchunks;
|
|
|
|
if (chip->chip_status & VX_STAT_IS_STALE)
|
|
return -EBUSY;
|
|
|
|
data_mode = (chip->uer_bits & IEC958_AES0_NONAUDIO) != 0;
|
|
if (data_mode != pipe->data_mode && ! pipe->is_capture) {
|
|
/* IEC958 status (raw-mode) was changed */
|
|
/* we reopen the pipe */
|
|
struct vx_rmh rmh;
|
|
snd_printdd(KERN_DEBUG "reopen the pipe with data_mode = %d\n", data_mode);
|
|
vx_init_rmh(&rmh, CMD_FREE_PIPE);
|
|
vx_set_pipe_cmd_params(&rmh, 0, pipe->number, 0);
|
|
if ((err = vx_send_msg(chip, &rmh)) < 0)
|
|
return err;
|
|
vx_init_rmh(&rmh, CMD_RES_PIPE);
|
|
vx_set_pipe_cmd_params(&rmh, 0, pipe->number, pipe->channels);
|
|
if (data_mode)
|
|
rmh.Cmd[0] |= BIT_DATA_MODE;
|
|
if ((err = vx_send_msg(chip, &rmh)) < 0)
|
|
return err;
|
|
pipe->data_mode = data_mode;
|
|
}
|
|
|
|
if (chip->pcm_running && chip->freq != runtime->rate) {
|
|
snd_printk(KERN_ERR "vx: cannot set different clock %d "
|
|
"from the current %d\n", runtime->rate, chip->freq);
|
|
return -EINVAL;
|
|
}
|
|
vx_set_clock(chip, runtime->rate);
|
|
|
|
if ((err = vx_set_format(chip, pipe, runtime)) < 0)
|
|
return err;
|
|
|
|
if (vx_is_pcmcia(chip)) {
|
|
pipe->align = 2; /* 16bit word */
|
|
} else {
|
|
pipe->align = 4; /* 32bit word */
|
|
}
|
|
|
|
pipe->buffer_bytes = frames_to_bytes(runtime, runtime->buffer_size);
|
|
pipe->period_bytes = frames_to_bytes(runtime, runtime->period_size);
|
|
pipe->hw_ptr = 0;
|
|
|
|
/* set the timestamp */
|
|
vx_update_pipe_position(chip, runtime, pipe);
|
|
/* clear again */
|
|
pipe->transferred = 0;
|
|
pipe->position = 0;
|
|
|
|
pipe->prepared = 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/*
|
|
* operators for PCM playback
|
|
*/
|
|
static const struct snd_pcm_ops vx_pcm_playback_ops = {
|
|
.open = vx_pcm_playback_open,
|
|
.close = vx_pcm_playback_close,
|
|
.ioctl = snd_pcm_lib_ioctl,
|
|
.hw_params = vx_pcm_hw_params,
|
|
.hw_free = vx_pcm_hw_free,
|
|
.prepare = vx_pcm_prepare,
|
|
.trigger = vx_pcm_trigger,
|
|
.pointer = vx_pcm_playback_pointer,
|
|
.page = snd_pcm_lib_get_vmalloc_page,
|
|
};
|
|
|
|
|
|
/*
|
|
* playback hw information
|
|
*/
|
|
|
|
static const struct snd_pcm_hardware vx_pcm_capture_hw = {
|
|
.info = (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
|
|
SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_MMAP_VALID /*|*/
|
|
/*SNDRV_PCM_INFO_RESUME*/),
|
|
.formats = (/*SNDRV_PCM_FMTBIT_U8 |*/
|
|
SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_3LE),
|
|
.rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000,
|
|
.rate_min = 5000,
|
|
.rate_max = 48000,
|
|
.channels_min = 1,
|
|
.channels_max = 2,
|
|
.buffer_bytes_max = (128*1024),
|
|
.period_bytes_min = 126,
|
|
.period_bytes_max = (128*1024),
|
|
.periods_min = 2,
|
|
.periods_max = VX_MAX_PERIODS,
|
|
.fifo_size = 126,
|
|
};
|
|
|
|
|
|
/*
|
|
* vx_pcm_capture_open - open callback for capture
|
|
*/
|
|
static int vx_pcm_capture_open(struct snd_pcm_substream *subs)
|
|
{
|
|
struct snd_pcm_runtime *runtime = subs->runtime;
|
|
struct vx_core *chip = snd_pcm_substream_chip(subs);
|
|
struct vx_pipe *pipe;
|
|
struct vx_pipe *pipe_out_monitoring = NULL;
|
|
unsigned int audio;
|
|
int err;
|
|
|
|
if (chip->chip_status & VX_STAT_IS_STALE)
|
|
return -EBUSY;
|
|
|
|
audio = subs->pcm->device * 2;
|
|
if (snd_BUG_ON(audio >= chip->audio_ins))
|
|
return -EINVAL;
|
|
err = vx_alloc_pipe(chip, 1, audio, 2, &pipe);
|
|
if (err < 0)
|
|
return err;
|
|
pipe->substream = subs;
|
|
chip->capture_pipes[audio] = pipe;
|
|
|
|
/* check if monitoring is needed */
|
|
if (chip->audio_monitor_active[audio]) {
|
|
pipe_out_monitoring = chip->playback_pipes[audio];
|
|
if (! pipe_out_monitoring) {
|
|
/* allocate a pipe */
|
|
err = vx_alloc_pipe(chip, 0, audio, 2, &pipe_out_monitoring);
|
|
if (err < 0)
|
|
return err;
|
|
chip->playback_pipes[audio] = pipe_out_monitoring;
|
|
}
|
|
pipe_out_monitoring->references++;
|
|
/*
|
|
if an output pipe is available, it's audios still may need to be
|
|
unmuted. hence we'll have to call a mixer entry point.
|
|
*/
|
|
vx_set_monitor_level(chip, audio, chip->audio_monitor[audio],
|
|
chip->audio_monitor_active[audio]);
|
|
/* assuming stereo */
|
|
vx_set_monitor_level(chip, audio+1, chip->audio_monitor[audio+1],
|
|
chip->audio_monitor_active[audio+1]);
|
|
}
|
|
|
|
pipe->monitoring_pipe = pipe_out_monitoring; /* default value NULL */
|
|
|
|
runtime->hw = vx_pcm_capture_hw;
|
|
runtime->hw.period_bytes_min = chip->ibl.size;
|
|
runtime->private_data = pipe;
|
|
|
|
/* align to 4 bytes (otherwise will be problematic when 24bit is used) */
|
|
snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_BYTES, 4);
|
|
snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 4);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* vx_pcm_capture_close - close callback for capture
|
|
*/
|
|
static int vx_pcm_capture_close(struct snd_pcm_substream *subs)
|
|
{
|
|
struct vx_core *chip = snd_pcm_substream_chip(subs);
|
|
struct vx_pipe *pipe;
|
|
struct vx_pipe *pipe_out_monitoring;
|
|
|
|
if (! subs->runtime->private_data)
|
|
return -EINVAL;
|
|
pipe = subs->runtime->private_data;
|
|
chip->capture_pipes[pipe->number] = NULL;
|
|
|
|
pipe_out_monitoring = pipe->monitoring_pipe;
|
|
|
|
/*
|
|
if an output pipe is attached to this input,
|
|
check if it needs to be released.
|
|
*/
|
|
if (pipe_out_monitoring) {
|
|
if (--pipe_out_monitoring->references == 0) {
|
|
vx_free_pipe(chip, pipe_out_monitoring);
|
|
chip->playback_pipes[pipe->number] = NULL;
|
|
pipe->monitoring_pipe = NULL;
|
|
}
|
|
}
|
|
|
|
vx_free_pipe(chip, pipe);
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
#define DMA_READ_ALIGN 6 /* hardware alignment for read */
|
|
|
|
/*
|
|
* vx_pcm_capture_update - update the capture buffer
|
|
*/
|
|
static void vx_pcm_capture_update(struct vx_core *chip, struct snd_pcm_substream *subs,
|
|
struct vx_pipe *pipe)
|
|
{
|
|
int size, space, count;
|
|
struct snd_pcm_runtime *runtime = subs->runtime;
|
|
|
|
if (!pipe->running || (chip->chip_status & VX_STAT_IS_STALE))
|
|
return;
|
|
|
|
size = runtime->buffer_size - snd_pcm_capture_avail(runtime);
|
|
if (! size)
|
|
return;
|
|
size = frames_to_bytes(runtime, size);
|
|
space = vx_query_hbuffer_size(chip, pipe);
|
|
if (space < 0)
|
|
goto _error;
|
|
if (size > space)
|
|
size = space;
|
|
size = (size / 3) * 3; /* align to 3 bytes */
|
|
if (size < DMA_READ_ALIGN)
|
|
goto _error;
|
|
|
|
/* keep the last 6 bytes, they will be read after disconnection */
|
|
count = size - DMA_READ_ALIGN;
|
|
/* read bytes until the current pointer reaches to the aligned position
|
|
* for word-transfer
|
|
*/
|
|
while (count > 0) {
|
|
if ((pipe->hw_ptr % pipe->align) == 0)
|
|
break;
|
|
if (vx_wait_for_rx_full(chip) < 0)
|
|
goto _error;
|
|
vx_pcm_read_per_bytes(chip, runtime, pipe);
|
|
count -= 3;
|
|
}
|
|
if (count > 0) {
|
|
/* ok, let's accelerate! */
|
|
int align = pipe->align * 3;
|
|
space = (count / align) * align;
|
|
if (space > 0) {
|
|
vx_pseudo_dma_read(chip, runtime, pipe, space);
|
|
count -= space;
|
|
}
|
|
}
|
|
/* read the rest of bytes */
|
|
while (count > 0) {
|
|
if (vx_wait_for_rx_full(chip) < 0)
|
|
goto _error;
|
|
vx_pcm_read_per_bytes(chip, runtime, pipe);
|
|
count -= 3;
|
|
}
|
|
/* disconnect the host, SIZE_HBUF command always switches to the stream mode */
|
|
vx_send_rih(chip, IRQ_CONNECT_STREAM_NEXT);
|
|
/* read the last pending 6 bytes */
|
|
count = DMA_READ_ALIGN;
|
|
while (count > 0) {
|
|
vx_pcm_read_per_bytes(chip, runtime, pipe);
|
|
count -= 3;
|
|
}
|
|
/* update the position */
|
|
pipe->transferred += size;
|
|
if (pipe->transferred >= pipe->period_bytes) {
|
|
pipe->transferred %= pipe->period_bytes;
|
|
snd_pcm_period_elapsed(subs);
|
|
}
|
|
return;
|
|
|
|
_error:
|
|
/* disconnect the host, SIZE_HBUF command always switches to the stream mode */
|
|
vx_send_rih(chip, IRQ_CONNECT_STREAM_NEXT);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* vx_pcm_capture_pointer - pointer callback for capture
|
|
*/
|
|
static snd_pcm_uframes_t vx_pcm_capture_pointer(struct snd_pcm_substream *subs)
|
|
{
|
|
struct snd_pcm_runtime *runtime = subs->runtime;
|
|
struct vx_pipe *pipe = runtime->private_data;
|
|
return bytes_to_frames(runtime, pipe->hw_ptr);
|
|
}
|
|
|
|
/*
|
|
* operators for PCM capture
|
|
*/
|
|
static const struct snd_pcm_ops vx_pcm_capture_ops = {
|
|
.open = vx_pcm_capture_open,
|
|
.close = vx_pcm_capture_close,
|
|
.ioctl = snd_pcm_lib_ioctl,
|
|
.hw_params = vx_pcm_hw_params,
|
|
.hw_free = vx_pcm_hw_free,
|
|
.prepare = vx_pcm_prepare,
|
|
.trigger = vx_pcm_trigger,
|
|
.pointer = vx_pcm_capture_pointer,
|
|
.page = snd_pcm_lib_get_vmalloc_page,
|
|
};
|
|
|
|
|
|
/*
|
|
* interrupt handler for pcm streams
|
|
*/
|
|
void vx_pcm_update_intr(struct vx_core *chip, unsigned int events)
|
|
{
|
|
unsigned int i;
|
|
struct vx_pipe *pipe;
|
|
|
|
#define EVENT_MASK (END_OF_BUFFER_EVENTS_PENDING|ASYNC_EVENTS_PENDING)
|
|
|
|
if (events & EVENT_MASK) {
|
|
vx_init_rmh(&chip->irq_rmh, CMD_ASYNC);
|
|
if (events & ASYNC_EVENTS_PENDING)
|
|
chip->irq_rmh.Cmd[0] |= 0x00000001; /* SEL_ASYNC_EVENTS */
|
|
if (events & END_OF_BUFFER_EVENTS_PENDING)
|
|
chip->irq_rmh.Cmd[0] |= 0x00000002; /* SEL_END_OF_BUF_EVENTS */
|
|
|
|
if (vx_send_msg(chip, &chip->irq_rmh) < 0) {
|
|
snd_printdd(KERN_ERR "msg send error!!\n");
|
|
return;
|
|
}
|
|
|
|
i = 1;
|
|
while (i < chip->irq_rmh.LgStat) {
|
|
int p, buf, capture, eob;
|
|
p = chip->irq_rmh.Stat[i] & MASK_FIRST_FIELD;
|
|
capture = (chip->irq_rmh.Stat[i] & 0x400000) ? 1 : 0;
|
|
eob = (chip->irq_rmh.Stat[i] & 0x800000) ? 1 : 0;
|
|
i++;
|
|
if (events & ASYNC_EVENTS_PENDING)
|
|
i++;
|
|
buf = 1; /* force to transfer */
|
|
if (events & END_OF_BUFFER_EVENTS_PENDING) {
|
|
if (eob)
|
|
buf = chip->irq_rmh.Stat[i];
|
|
i++;
|
|
}
|
|
if (capture)
|
|
continue;
|
|
if (snd_BUG_ON(p < 0 || p >= chip->audio_outs))
|
|
continue;
|
|
pipe = chip->playback_pipes[p];
|
|
if (pipe && pipe->substream) {
|
|
vx_pcm_playback_update(chip, pipe->substream, pipe);
|
|
vx_pcm_playback_transfer(chip, pipe->substream, pipe, buf);
|
|
}
|
|
}
|
|
}
|
|
|
|
/* update the capture pcm pointers as frequently as possible */
|
|
for (i = 0; i < chip->audio_ins; i++) {
|
|
pipe = chip->capture_pipes[i];
|
|
if (pipe && pipe->substream)
|
|
vx_pcm_capture_update(chip, pipe->substream, pipe);
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* vx_init_audio_io - check the available audio i/o and allocate pipe arrays
|
|
*/
|
|
static int vx_init_audio_io(struct vx_core *chip)
|
|
{
|
|
struct vx_rmh rmh;
|
|
int preferred;
|
|
|
|
vx_init_rmh(&rmh, CMD_SUPPORTED);
|
|
if (vx_send_msg(chip, &rmh) < 0) {
|
|
snd_printk(KERN_ERR "vx: cannot get the supported audio data\n");
|
|
return -ENXIO;
|
|
}
|
|
|
|
chip->audio_outs = rmh.Stat[0] & MASK_FIRST_FIELD;
|
|
chip->audio_ins = (rmh.Stat[0] >> (FIELD_SIZE*2)) & MASK_FIRST_FIELD;
|
|
chip->audio_info = rmh.Stat[1];
|
|
|
|
/* allocate pipes */
|
|
chip->playback_pipes = kcalloc(chip->audio_outs, sizeof(struct vx_pipe *), GFP_KERNEL);
|
|
if (!chip->playback_pipes)
|
|
return -ENOMEM;
|
|
chip->capture_pipes = kcalloc(chip->audio_ins, sizeof(struct vx_pipe *), GFP_KERNEL);
|
|
if (!chip->capture_pipes) {
|
|
kfree(chip->playback_pipes);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
preferred = chip->ibl.size;
|
|
chip->ibl.size = 0;
|
|
vx_set_ibl(chip, &chip->ibl); /* query the info */
|
|
if (preferred > 0) {
|
|
chip->ibl.size = ((preferred + chip->ibl.granularity - 1) /
|
|
chip->ibl.granularity) * chip->ibl.granularity;
|
|
if (chip->ibl.size > chip->ibl.max_size)
|
|
chip->ibl.size = chip->ibl.max_size;
|
|
} else
|
|
chip->ibl.size = chip->ibl.min_size; /* set to the minimum */
|
|
vx_set_ibl(chip, &chip->ibl);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/*
|
|
* free callback for pcm
|
|
*/
|
|
static void snd_vx_pcm_free(struct snd_pcm *pcm)
|
|
{
|
|
struct vx_core *chip = pcm->private_data;
|
|
chip->pcm[pcm->device] = NULL;
|
|
kfree(chip->playback_pipes);
|
|
chip->playback_pipes = NULL;
|
|
kfree(chip->capture_pipes);
|
|
chip->capture_pipes = NULL;
|
|
}
|
|
|
|
/*
|
|
* snd_vx_pcm_new - create and initialize a pcm
|
|
*/
|
|
int snd_vx_pcm_new(struct vx_core *chip)
|
|
{
|
|
struct snd_pcm *pcm;
|
|
unsigned int i;
|
|
int err;
|
|
|
|
if ((err = vx_init_audio_io(chip)) < 0)
|
|
return err;
|
|
|
|
for (i = 0; i < chip->hw->num_codecs; i++) {
|
|
unsigned int outs, ins;
|
|
outs = chip->audio_outs > i * 2 ? 1 : 0;
|
|
ins = chip->audio_ins > i * 2 ? 1 : 0;
|
|
if (! outs && ! ins)
|
|
break;
|
|
err = snd_pcm_new(chip->card, "VX PCM", i,
|
|
outs, ins, &pcm);
|
|
if (err < 0)
|
|
return err;
|
|
if (outs)
|
|
snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &vx_pcm_playback_ops);
|
|
if (ins)
|
|
snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &vx_pcm_capture_ops);
|
|
|
|
pcm->private_data = chip;
|
|
pcm->private_free = snd_vx_pcm_free;
|
|
pcm->info_flags = 0;
|
|
pcm->nonatomic = true;
|
|
strcpy(pcm->name, chip->card->shortname);
|
|
chip->pcm[i] = pcm;
|
|
}
|
|
|
|
return 0;
|
|
}
|