mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-26 05:34:13 +08:00
c0ede398b5
In current implementation, when opening a PCM substream, it's needed to check whether the opposite PCM substream runs. This is to assign effectual constraints (e.g. sampling rate) to opened PCM substream. The number of PCM substreams and MIDI substreams on AMDTP streams in domain is recorded in own structure. Usage of this count is an alternative of the above check. This is better because the count is incremented in pcm.hw_params earlier than pcm.trigger. This idea has one issue because it's incremented for MIDI substreams as well. In current implementation, for a case that any MIDI substream run and a PCM substream is going to start, PCM application to start the PCM substream can decide hardware parameters by restart packet streaming. Just checking the substream count can brings regression. Now AMDTP domain structure has a member for the size of PCM period in PCM substream which starts AMDTP streams in domain. When the value has zero and the substream count is greater than 1, it means that any MIDI substream starts AMDTP streams in domain. Usage of the value can resolve the above issue. This commit replaces the check with the substream count and the value for the size of PCM period. Signed-off-by: Takashi Sakamoto <o-takashi@sakamocchi.jp> Link: https://lore.kernel.org/r/20191007110532.30270-13-o-takashi@sakamocchi.jp Signed-off-by: Takashi Iwai <tiwai@suse.de>
451 lines
11 KiB
C
451 lines
11 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* oxfw_pcm.c - a part of driver for OXFW970/971 based devices
|
|
*
|
|
* Copyright (c) Clemens Ladisch <clemens@ladisch.de>
|
|
*/
|
|
|
|
#include "oxfw.h"
|
|
|
|
static int hw_rule_rate(struct snd_pcm_hw_params *params,
|
|
struct snd_pcm_hw_rule *rule)
|
|
{
|
|
u8 **formats = rule->private;
|
|
struct snd_interval *r =
|
|
hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE);
|
|
const struct snd_interval *c =
|
|
hw_param_interval_c(params, SNDRV_PCM_HW_PARAM_CHANNELS);
|
|
struct snd_interval t = {
|
|
.min = UINT_MAX, .max = 0, .integer = 1
|
|
};
|
|
struct snd_oxfw_stream_formation formation;
|
|
int i, err;
|
|
|
|
for (i = 0; i < SND_OXFW_STREAM_FORMAT_ENTRIES; i++) {
|
|
if (formats[i] == NULL)
|
|
continue;
|
|
|
|
err = snd_oxfw_stream_parse_format(formats[i], &formation);
|
|
if (err < 0)
|
|
continue;
|
|
if (!snd_interval_test(c, formation.pcm))
|
|
continue;
|
|
|
|
t.min = min(t.min, formation.rate);
|
|
t.max = max(t.max, formation.rate);
|
|
|
|
}
|
|
return snd_interval_refine(r, &t);
|
|
}
|
|
|
|
static int hw_rule_channels(struct snd_pcm_hw_params *params,
|
|
struct snd_pcm_hw_rule *rule)
|
|
{
|
|
u8 **formats = rule->private;
|
|
struct snd_interval *c =
|
|
hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS);
|
|
const struct snd_interval *r =
|
|
hw_param_interval_c(params, SNDRV_PCM_HW_PARAM_RATE);
|
|
struct snd_oxfw_stream_formation formation;
|
|
int i, j, err;
|
|
unsigned int count, list[SND_OXFW_STREAM_FORMAT_ENTRIES] = {0};
|
|
|
|
count = 0;
|
|
for (i = 0; i < SND_OXFW_STREAM_FORMAT_ENTRIES; i++) {
|
|
if (formats[i] == NULL)
|
|
break;
|
|
|
|
err = snd_oxfw_stream_parse_format(formats[i], &formation);
|
|
if (err < 0)
|
|
continue;
|
|
if (!snd_interval_test(r, formation.rate))
|
|
continue;
|
|
if (list[count] == formation.pcm)
|
|
continue;
|
|
|
|
for (j = 0; j < ARRAY_SIZE(list); j++) {
|
|
if (list[j] == formation.pcm)
|
|
break;
|
|
}
|
|
if (j == ARRAY_SIZE(list)) {
|
|
list[count] = formation.pcm;
|
|
if (++count == ARRAY_SIZE(list))
|
|
break;
|
|
}
|
|
}
|
|
|
|
return snd_interval_list(c, count, list, 0);
|
|
}
|
|
|
|
static void limit_channels_and_rates(struct snd_pcm_hardware *hw, u8 **formats)
|
|
{
|
|
struct snd_oxfw_stream_formation formation;
|
|
int i, err;
|
|
|
|
hw->channels_min = UINT_MAX;
|
|
hw->channels_max = 0;
|
|
|
|
hw->rate_min = UINT_MAX;
|
|
hw->rate_max = 0;
|
|
hw->rates = 0;
|
|
|
|
for (i = 0; i < SND_OXFW_STREAM_FORMAT_ENTRIES; i++) {
|
|
if (formats[i] == NULL)
|
|
break;
|
|
|
|
err = snd_oxfw_stream_parse_format(formats[i], &formation);
|
|
if (err < 0)
|
|
continue;
|
|
|
|
hw->channels_min = min(hw->channels_min, formation.pcm);
|
|
hw->channels_max = max(hw->channels_max, formation.pcm);
|
|
|
|
hw->rate_min = min(hw->rate_min, formation.rate);
|
|
hw->rate_max = max(hw->rate_max, formation.rate);
|
|
hw->rates |= snd_pcm_rate_to_rate_bit(formation.rate);
|
|
}
|
|
}
|
|
|
|
static int init_hw_params(struct snd_oxfw *oxfw,
|
|
struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
u8 **formats;
|
|
struct amdtp_stream *stream;
|
|
int err;
|
|
|
|
if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
|
|
runtime->hw.formats = AM824_IN_PCM_FORMAT_BITS;
|
|
stream = &oxfw->tx_stream;
|
|
formats = oxfw->tx_stream_formats;
|
|
} else {
|
|
runtime->hw.formats = AM824_OUT_PCM_FORMAT_BITS;
|
|
stream = &oxfw->rx_stream;
|
|
formats = oxfw->rx_stream_formats;
|
|
}
|
|
|
|
limit_channels_and_rates(&runtime->hw, formats);
|
|
|
|
err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_CHANNELS,
|
|
hw_rule_channels, formats,
|
|
SNDRV_PCM_HW_PARAM_RATE, -1);
|
|
if (err < 0)
|
|
goto end;
|
|
|
|
err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_RATE,
|
|
hw_rule_rate, formats,
|
|
SNDRV_PCM_HW_PARAM_CHANNELS, -1);
|
|
if (err < 0)
|
|
goto end;
|
|
|
|
err = amdtp_am824_add_pcm_hw_constraints(stream, runtime);
|
|
end:
|
|
return err;
|
|
}
|
|
|
|
static int limit_to_current_params(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
struct snd_oxfw_stream_formation formation;
|
|
enum avc_general_plug_dir dir;
|
|
int err;
|
|
|
|
if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
|
|
dir = AVC_GENERAL_PLUG_DIR_OUT;
|
|
else
|
|
dir = AVC_GENERAL_PLUG_DIR_IN;
|
|
|
|
err = snd_oxfw_stream_get_current_formation(oxfw, dir, &formation);
|
|
if (err < 0)
|
|
goto end;
|
|
|
|
substream->runtime->hw.channels_min = formation.pcm;
|
|
substream->runtime->hw.channels_max = formation.pcm;
|
|
substream->runtime->hw.rate_min = formation.rate;
|
|
substream->runtime->hw.rate_max = formation.rate;
|
|
end:
|
|
return err;
|
|
}
|
|
|
|
static int pcm_open(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
struct amdtp_domain *d = &oxfw->domain;
|
|
int err;
|
|
|
|
err = snd_oxfw_stream_lock_try(oxfw);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
err = init_hw_params(oxfw, substream);
|
|
if (err < 0)
|
|
goto err_locked;
|
|
|
|
mutex_lock(&oxfw->mutex);
|
|
|
|
// When source of clock is not internal or any stream is reserved for
|
|
// transmission of PCM frames, the available sampling rate is limited
|
|
// at current one.
|
|
if (oxfw->substreams_count > 0 && d->events_per_period > 0) {
|
|
unsigned int frames_per_period = d->events_per_period;
|
|
|
|
err = limit_to_current_params(substream);
|
|
if (err < 0) {
|
|
mutex_unlock(&oxfw->mutex);
|
|
goto err_locked;
|
|
}
|
|
|
|
if (frames_per_period > 0) {
|
|
err = snd_pcm_hw_constraint_minmax(substream->runtime,
|
|
SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
|
|
frames_per_period, frames_per_period);
|
|
if (err < 0) {
|
|
mutex_unlock(&oxfw->mutex);
|
|
goto err_locked;
|
|
}
|
|
}
|
|
}
|
|
|
|
mutex_unlock(&oxfw->mutex);
|
|
|
|
snd_pcm_set_sync(substream);
|
|
|
|
return 0;
|
|
err_locked:
|
|
snd_oxfw_stream_lock_release(oxfw);
|
|
return err;
|
|
}
|
|
|
|
static int pcm_close(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
|
|
snd_oxfw_stream_lock_release(oxfw);
|
|
return 0;
|
|
}
|
|
|
|
static int pcm_capture_hw_params(struct snd_pcm_substream *substream,
|
|
struct snd_pcm_hw_params *hw_params)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
int err;
|
|
|
|
err = snd_pcm_lib_alloc_vmalloc_buffer(substream,
|
|
params_buffer_bytes(hw_params));
|
|
if (err < 0)
|
|
return err;
|
|
|
|
if (substream->runtime->status->state == SNDRV_PCM_STATE_OPEN) {
|
|
unsigned int rate = params_rate(hw_params);
|
|
unsigned int channels = params_channels(hw_params);
|
|
unsigned int frames_per_period = params_period_size(hw_params);
|
|
|
|
mutex_lock(&oxfw->mutex);
|
|
err = snd_oxfw_stream_reserve_duplex(oxfw, &oxfw->tx_stream,
|
|
rate, channels, frames_per_period);
|
|
if (err >= 0)
|
|
++oxfw->substreams_count;
|
|
mutex_unlock(&oxfw->mutex);
|
|
}
|
|
|
|
return err;
|
|
}
|
|
static int pcm_playback_hw_params(struct snd_pcm_substream *substream,
|
|
struct snd_pcm_hw_params *hw_params)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
int err;
|
|
|
|
err = snd_pcm_lib_alloc_vmalloc_buffer(substream,
|
|
params_buffer_bytes(hw_params));
|
|
if (err < 0)
|
|
return err;
|
|
|
|
if (substream->runtime->status->state == SNDRV_PCM_STATE_OPEN) {
|
|
unsigned int rate = params_rate(hw_params);
|
|
unsigned int channels = params_channels(hw_params);
|
|
unsigned int frames_per_period = params_period_size(hw_params);
|
|
|
|
mutex_lock(&oxfw->mutex);
|
|
err = snd_oxfw_stream_reserve_duplex(oxfw, &oxfw->rx_stream,
|
|
rate, channels, frames_per_period);
|
|
if (err >= 0)
|
|
++oxfw->substreams_count;
|
|
mutex_unlock(&oxfw->mutex);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int pcm_capture_hw_free(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
|
|
mutex_lock(&oxfw->mutex);
|
|
|
|
if (substream->runtime->status->state != SNDRV_PCM_STATE_OPEN)
|
|
--oxfw->substreams_count;
|
|
|
|
snd_oxfw_stream_stop_duplex(oxfw);
|
|
|
|
mutex_unlock(&oxfw->mutex);
|
|
|
|
return snd_pcm_lib_free_vmalloc_buffer(substream);
|
|
}
|
|
static int pcm_playback_hw_free(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
|
|
mutex_lock(&oxfw->mutex);
|
|
|
|
if (substream->runtime->status->state != SNDRV_PCM_STATE_OPEN)
|
|
--oxfw->substreams_count;
|
|
|
|
snd_oxfw_stream_stop_duplex(oxfw);
|
|
|
|
mutex_unlock(&oxfw->mutex);
|
|
|
|
return snd_pcm_lib_free_vmalloc_buffer(substream);
|
|
}
|
|
|
|
static int pcm_capture_prepare(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
int err;
|
|
|
|
mutex_lock(&oxfw->mutex);
|
|
err = snd_oxfw_stream_start_duplex(oxfw);
|
|
mutex_unlock(&oxfw->mutex);
|
|
if (err < 0)
|
|
goto end;
|
|
|
|
amdtp_stream_pcm_prepare(&oxfw->tx_stream);
|
|
end:
|
|
return err;
|
|
}
|
|
static int pcm_playback_prepare(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
int err;
|
|
|
|
mutex_lock(&oxfw->mutex);
|
|
err = snd_oxfw_stream_start_duplex(oxfw);
|
|
mutex_unlock(&oxfw->mutex);
|
|
if (err < 0)
|
|
goto end;
|
|
|
|
amdtp_stream_pcm_prepare(&oxfw->rx_stream);
|
|
end:
|
|
return err;
|
|
}
|
|
|
|
static int pcm_capture_trigger(struct snd_pcm_substream *substream, int cmd)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
struct snd_pcm_substream *pcm;
|
|
|
|
switch (cmd) {
|
|
case SNDRV_PCM_TRIGGER_START:
|
|
pcm = substream;
|
|
break;
|
|
case SNDRV_PCM_TRIGGER_STOP:
|
|
pcm = NULL;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
amdtp_stream_pcm_trigger(&oxfw->tx_stream, pcm);
|
|
return 0;
|
|
}
|
|
static int pcm_playback_trigger(struct snd_pcm_substream *substream, int cmd)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
struct snd_pcm_substream *pcm;
|
|
|
|
switch (cmd) {
|
|
case SNDRV_PCM_TRIGGER_START:
|
|
pcm = substream;
|
|
break;
|
|
case SNDRV_PCM_TRIGGER_STOP:
|
|
pcm = NULL;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
amdtp_stream_pcm_trigger(&oxfw->rx_stream, pcm);
|
|
return 0;
|
|
}
|
|
|
|
static snd_pcm_uframes_t pcm_capture_pointer(struct snd_pcm_substream *sbstm)
|
|
{
|
|
struct snd_oxfw *oxfw = sbstm->private_data;
|
|
|
|
return amdtp_stream_pcm_pointer(&oxfw->tx_stream);
|
|
}
|
|
static snd_pcm_uframes_t pcm_playback_pointer(struct snd_pcm_substream *sbstm)
|
|
{
|
|
struct snd_oxfw *oxfw = sbstm->private_data;
|
|
|
|
return amdtp_stream_pcm_pointer(&oxfw->rx_stream);
|
|
}
|
|
|
|
static int pcm_capture_ack(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
|
|
return amdtp_stream_pcm_ack(&oxfw->tx_stream);
|
|
}
|
|
|
|
static int pcm_playback_ack(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_oxfw *oxfw = substream->private_data;
|
|
|
|
return amdtp_stream_pcm_ack(&oxfw->rx_stream);
|
|
}
|
|
|
|
int snd_oxfw_create_pcm(struct snd_oxfw *oxfw)
|
|
{
|
|
static const struct snd_pcm_ops capture_ops = {
|
|
.open = pcm_open,
|
|
.close = pcm_close,
|
|
.ioctl = snd_pcm_lib_ioctl,
|
|
.hw_params = pcm_capture_hw_params,
|
|
.hw_free = pcm_capture_hw_free,
|
|
.prepare = pcm_capture_prepare,
|
|
.trigger = pcm_capture_trigger,
|
|
.pointer = pcm_capture_pointer,
|
|
.ack = pcm_capture_ack,
|
|
.page = snd_pcm_lib_get_vmalloc_page,
|
|
};
|
|
static const struct snd_pcm_ops playback_ops = {
|
|
.open = pcm_open,
|
|
.close = pcm_close,
|
|
.ioctl = snd_pcm_lib_ioctl,
|
|
.hw_params = pcm_playback_hw_params,
|
|
.hw_free = pcm_playback_hw_free,
|
|
.prepare = pcm_playback_prepare,
|
|
.trigger = pcm_playback_trigger,
|
|
.pointer = pcm_playback_pointer,
|
|
.ack = pcm_playback_ack,
|
|
.page = snd_pcm_lib_get_vmalloc_page,
|
|
};
|
|
struct snd_pcm *pcm;
|
|
unsigned int cap = 0;
|
|
int err;
|
|
|
|
if (oxfw->has_output)
|
|
cap = 1;
|
|
|
|
err = snd_pcm_new(oxfw->card, oxfw->card->driver, 0, 1, cap, &pcm);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
pcm->private_data = oxfw;
|
|
strcpy(pcm->name, oxfw->card->shortname);
|
|
snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &playback_ops);
|
|
if (cap > 0)
|
|
snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &capture_ops);
|
|
|
|
return 0;
|
|
}
|