[deliverable/linux.git] / sound / firewire / dice / dice-pcm.c

/*
 * dice_pcm.c - a part of driver for DICE based devices
 *
 * Copyright (c) Clemens Ladisch <clemens@ladisch.de>
 * Copyright (c) 2014 Takashi Sakamoto <o-takashi@sakamocchi.jp>
 *
 * Licensed under the terms of the GNU General Public License, version 2.
 */

#include "dice.h"

static int dice_rate_constraint(struct snd_pcm_hw_params *params,
				struct snd_pcm_hw_rule *rule)
{
	struct snd_pcm_substream *substream = rule->private;
	struct snd_dice *dice = substream->private_data;

	const struct snd_interval *c =
		hw_param_interval_c(params, SNDRV_PCM_HW_PARAM_CHANNELS);
	struct snd_interval *r =
		hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE);
	struct snd_interval rates = {
		.min = UINT_MAX, .max = 0, .integer = 1
	};
	unsigned int i, rate, mode, *pcm_channels;

	if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
		pcm_channels = dice->tx_channels;
	else
		pcm_channels = dice->rx_channels;

	for (i = 0; i < ARRAY_SIZE(snd_dice_rates); ++i) {
		rate = snd_dice_rates[i];
		if (snd_dice_stream_get_rate_mode(dice, rate, &mode) < 0)
			continue;

		if (!snd_interval_test(c, pcm_channels[mode]))
			continue;

		rates.min = min(rates.min, rate);
		rates.max = max(rates.max, rate);
	}

	return snd_interval_refine(r, &rates);
}

static int dice_channels_constraint(struct snd_pcm_hw_params *params,
				    struct snd_pcm_hw_rule *rule)
{
	struct snd_pcm_substream *substream = rule->private;
	struct snd_dice *dice = substream->private_data;

	const struct snd_interval *r =
		hw_param_interval_c(params, SNDRV_PCM_HW_PARAM_RATE);
	struct snd_interval *c =
		hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS);
	struct snd_interval channels = {
		.min = UINT_MAX, .max = 0, .integer = 1
	};
	unsigned int i, rate, mode, *pcm_channels;

	if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
		pcm_channels = dice->tx_channels;
	else
		pcm_channels = dice->rx_channels;

	for (i = 0; i < ARRAY_SIZE(snd_dice_rates); ++i) {
		rate = snd_dice_rates[i];
		if (snd_dice_stream_get_rate_mode(dice, rate, &mode) < 0)
			continue;

		if (!snd_interval_test(r, rate))
			continue;

		channels.min = min(channels.min, pcm_channels[mode]);
		channels.max = max(channels.max, pcm_channels[mode]);
	}

	return snd_interval_refine(c, &channels);
}

static void limit_channels_and_rates(struct snd_dice *dice,
				     struct snd_pcm_runtime *runtime,
				     unsigned int *pcm_channels)
{
	struct snd_pcm_hardware *hw = &runtime->hw;
	unsigned int i, rate, mode;

	hw->channels_min = UINT_MAX;
	hw->channels_max = 0;

	for (i = 0; i < ARRAY_SIZE(snd_dice_rates); ++i) {
		rate = snd_dice_rates[i];
		if (snd_dice_stream_get_rate_mode(dice, rate, &mode) < 0)
			continue;
		hw->rates |= snd_pcm_rate_to_rate_bit(rate);

		if (pcm_channels[mode] == 0)
			continue;
		hw->channels_min = min(hw->channels_min, pcm_channels[mode]);
		hw->channels_max = max(hw->channels_max, pcm_channels[mode]);
	}

	snd_pcm_limit_hw_rates(runtime);
}

static void limit_period_and_buffer(struct snd_pcm_hardware *hw)
{
	hw->periods_min = 2;			/* SNDRV_PCM_INFO_BATCH */
	hw->periods_max = UINT_MAX;

	hw->period_bytes_min = 4 * hw->channels_max;    /* byte for a frame */

	/* Just to prevent from allocating much pages. */
	hw->period_bytes_max = hw->period_bytes_min * 2048;
	hw->buffer_bytes_max = hw->period_bytes_max * hw->periods_min;
}

static int init_hw_info(struct snd_dice *dice,
			struct snd_pcm_substream *substream)
{
	struct snd_pcm_runtime *runtime = substream->runtime;
	struct snd_pcm_hardware *hw = &runtime->hw;
	struct amdtp_stream *stream;
	unsigned int *pcm_channels;
	int err;

	hw->info = SNDRV_PCM_INFO_MMAP |
		   SNDRV_PCM_INFO_MMAP_VALID |
		   SNDRV_PCM_INFO_BATCH |
		   SNDRV_PCM_INFO_INTERLEAVED |
		   SNDRV_PCM_INFO_JOINT_DUPLEX |
		   SNDRV_PCM_INFO_BLOCK_TRANSFER;

	if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
		hw->formats = AM824_IN_PCM_FORMAT_BITS;
		stream = &dice->tx_stream;
		pcm_channels = dice->tx_channels;
	} else {
		hw->formats = AM824_OUT_PCM_FORMAT_BITS;
		stream = &dice->rx_stream;
		pcm_channels = dice->rx_channels;
	}

	limit_channels_and_rates(dice, runtime, pcm_channels);
	limit_period_and_buffer(hw);

	err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_RATE,
				  dice_rate_constraint, substream,
				  SNDRV_PCM_HW_PARAM_CHANNELS, -1);
	if (err < 0)
		goto end;
	err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_CHANNELS,
				  dice_channels_constraint, substream,
				  SNDRV_PCM_HW_PARAM_RATE, -1);
	if (err < 0)
		goto end;

	err = amdtp_am824_add_pcm_hw_constraints(stream, runtime);
end:
	return err;
}

static int pcm_open(struct snd_pcm_substream *substream)
{
	struct snd_dice *dice = substream->private_data;
	unsigned int source, rate;
	bool internal;
	int err;

	err = snd_dice_stream_lock_try(dice);
	if (err < 0)
		goto end;

	err = init_hw_info(dice, substream);
	if (err < 0)
		goto err_locked;

	err = snd_dice_transaction_get_clock_source(dice, &source);
	if (err < 0)
		goto err_locked;
	switch (source) {
	case CLOCK_SOURCE_AES1:
	case CLOCK_SOURCE_AES2:
	case CLOCK_SOURCE_AES3:
	case CLOCK_SOURCE_AES4:
	case CLOCK_SOURCE_AES_ANY:
	case CLOCK_SOURCE_ADAT:
	case CLOCK_SOURCE_TDIF:
	case CLOCK_SOURCE_WC:
		internal = false;
		break;
	default:
		internal = true;
		break;
	}

	/*
	 * When source of clock is not internal or any PCM streams are running,
	 * available sampling rate is limited at current sampling rate.
	 */
	if (!internal ||
	    amdtp_stream_pcm_running(&dice->tx_stream) ||
	    amdtp_stream_pcm_running(&dice->rx_stream)) {
		err = snd_dice_transaction_get_rate(dice, &rate);
		if (err < 0)
			goto err_locked;
		substream->runtime->hw.rate_min = rate;
		substream->runtime->hw.rate_max = rate;
	}

	snd_pcm_set_sync(substream);
end:
	return err;
err_locked:
	snd_dice_stream_lock_release(dice);
	return err;
}

static int pcm_close(struct snd_pcm_substream *substream)
{
	struct snd_dice *dice = substream->private_data;

	snd_dice_stream_lock_release(dice);

	return 0;
}

static int capture_hw_params(struct snd_pcm_substream *substream,
			     struct snd_pcm_hw_params *hw_params)
{
	struct snd_dice *dice = 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) {
		mutex_lock(&dice->mutex);
		dice->substreams_counter++;
		mutex_unlock(&dice->mutex);
	}

	amdtp_am824_set_pcm_format(&dice->tx_stream, params_format(hw_params));

	return 0;
}
static int playback_hw_params(struct snd_pcm_substream *substream,
			      struct snd_pcm_hw_params *hw_params)
{
	struct snd_dice *dice = 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) {
		mutex_lock(&dice->mutex);
		dice->substreams_counter++;
		mutex_unlock(&dice->mutex);
	}

	amdtp_am824_set_pcm_format(&dice->rx_stream, params_format(hw_params));

	return 0;
}

static int capture_hw_free(struct snd_pcm_substream *substream)
{
	struct snd_dice *dice = substream->private_data;

	mutex_lock(&dice->mutex);

	if (substream->runtime->status->state != SNDRV_PCM_STATE_OPEN)
		dice->substreams_counter--;

	snd_dice_stream_stop_duplex(dice);

	mutex_unlock(&dice->mutex);

	return snd_pcm_lib_free_vmalloc_buffer(substream);
}

static int playback_hw_free(struct snd_pcm_substream *substream)
{
	struct snd_dice *dice = substream->private_data;

	mutex_lock(&dice->mutex);

	if (substream->runtime->status->state != SNDRV_PCM_STATE_OPEN)
		dice->substreams_counter--;

	snd_dice_stream_stop_duplex(dice);

	mutex_unlock(&dice->mutex);

	return snd_pcm_lib_free_vmalloc_buffer(substream);
}

static int capture_prepare(struct snd_pcm_substream *substream)
{
	struct snd_dice *dice = substream->private_data;
	int err;

	mutex_lock(&dice->mutex);
	err = snd_dice_stream_start_duplex(dice, substream->runtime->rate);
	mutex_unlock(&dice->mutex);
	if (err >= 0)
		amdtp_stream_pcm_prepare(&dice->tx_stream);

	return 0;
}
static int playback_prepare(struct snd_pcm_substream *substream)
{
	struct snd_dice *dice = substream->private_data;
	int err;

	mutex_lock(&dice->mutex);
	err = snd_dice_stream_start_duplex(dice, substream->runtime->rate);
	mutex_unlock(&dice->mutex);
	if (err >= 0)
		amdtp_stream_pcm_prepare(&dice->rx_stream);

	return err;
}

static int capture_trigger(struct snd_pcm_substream *substream, int cmd)
{
	struct snd_dice *dice = substream->private_data;

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_START:
		amdtp_stream_pcm_trigger(&dice->tx_stream, substream);
		break;
	case SNDRV_PCM_TRIGGER_STOP:
		amdtp_stream_pcm_trigger(&dice->tx_stream, NULL);
		break;
	default:
		return -EINVAL;
	}

	return 0;
}
static int playback_trigger(struct snd_pcm_substream *substream, int cmd)
{
	struct snd_dice *dice = substream->private_data;

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_START:
		amdtp_stream_pcm_trigger(&dice->rx_stream, substream);
		break;
	case SNDRV_PCM_TRIGGER_STOP:
		amdtp_stream_pcm_trigger(&dice->rx_stream, NULL);
		break;
	default:
		return -EINVAL;
	}

	return 0;
}

static snd_pcm_uframes_t capture_pointer(struct snd_pcm_substream *substream)
{
	struct snd_dice *dice = substream->private_data;

	return amdtp_stream_pcm_pointer(&dice->tx_stream);
}
static snd_pcm_uframes_t playback_pointer(struct snd_pcm_substream *substream)
{
	struct snd_dice *dice = substream->private_data;

	return amdtp_stream_pcm_pointer(&dice->rx_stream);
}

int snd_dice_create_pcm(struct snd_dice *dice)
{
	static struct snd_pcm_ops capture_ops = {
		.open      = pcm_open,
		.close     = pcm_close,
		.ioctl     = snd_pcm_lib_ioctl,
		.hw_params = capture_hw_params,
		.hw_free   = capture_hw_free,
		.prepare   = capture_prepare,
		.trigger   = capture_trigger,
		.pointer   = capture_pointer,
		.page      = snd_pcm_lib_get_vmalloc_page,
		.mmap      = snd_pcm_lib_mmap_vmalloc,
	};
	static struct snd_pcm_ops playback_ops = {
		.open      = pcm_open,
		.close     = pcm_close,
		.ioctl     = snd_pcm_lib_ioctl,
		.hw_params = playback_hw_params,
		.hw_free   = playback_hw_free,
		.prepare   = playback_prepare,
		.trigger   = playback_trigger,
		.pointer   = playback_pointer,
		.page      = snd_pcm_lib_get_vmalloc_page,
		.mmap      = snd_pcm_lib_mmap_vmalloc,
	};
	struct snd_pcm *pcm;
	unsigned int i, capture, playback;
	int err;

	capture = playback = 0;
	for (i = 0; i < 3; i++) {
		if (dice->tx_channels[i] > 0)
			capture = 1;
		if (dice->rx_channels[i] > 0)
			playback = 1;
	}

	err = snd_pcm_new(dice->card, "DICE", 0, playback, capture, &pcm);
	if (err < 0)
		return err;
	pcm->private_data = dice;
	strcpy(pcm->name, dice->card->shortname);

	if (capture > 0)
		snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &capture_ops);

	if (playback > 0)
		snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &playback_ops);

	return 0;
}
Commit	Line	Data
c50fb91f TS	1	/*
	2	* dice_pcm.c - a part of driver for DICE based devices
	3	*
	4	* Copyright (c) Clemens Ladisch <clemens@ladisch.de>
	5	* Copyright (c) 2014 Takashi Sakamoto <o-takashi@sakamocchi.jp>
	6	*
	7	* Licensed under the terms of the GNU General Public License, version 2.
	8	*/
	9
	10	#include "dice.h"
	11
	12	static int dice_rate_constraint(struct snd_pcm_hw_params *params,
	13	struct snd_pcm_hw_rule *rule)
	14	{
69dcf3e4 TS	15	struct snd_pcm_substream *substream = rule->private;
69dcf3e4 TS	16	struct snd_dice *dice = substream->private_data;
c50fb91f TS	17
	18	const struct snd_interval *c =
	19	hw_param_interval_c(params, SNDRV_PCM_HW_PARAM_CHANNELS);
	20	struct snd_interval *r =
	21	hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE);
	22	struct snd_interval rates = {
	23	.min = UINT_MAX, .max = 0, .integer = 1
	24	};
69dcf3e4 TS	25	unsigned int i, rate, mode, *pcm_channels;
	26
	27	if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
	28	pcm_channels = dice->tx_channels;
	29	else
	30	pcm_channels = dice->rx_channels;
c50fb91f TS	31
	32	for (i = 0; i < ARRAY_SIZE(snd_dice_rates); ++i) {
	33	rate = snd_dice_rates[i];
	34	if (snd_dice_stream_get_rate_mode(dice, rate, &mode) < 0)
	35	continue;
	36
	37	if (!snd_interval_test(c, pcm_channels[mode]))
	38	continue;
	39
	40	rates.min = min(rates.min, rate);
	41	rates.max = max(rates.max, rate);
	42	}
	43
	44	return snd_interval_refine(r, &rates);
	45	}
	46
	47	static int dice_channels_constraint(struct snd_pcm_hw_params *params,
	48	struct snd_pcm_hw_rule *rule)
	49	{
69dcf3e4 TS	50	struct snd_pcm_substream *substream = rule->private;
69dcf3e4 TS	51	struct snd_dice *dice = substream->private_data;
c50fb91f TS	52
	53	const struct snd_interval *r =
	54	hw_param_interval_c(params, SNDRV_PCM_HW_PARAM_RATE);
	55	struct snd_interval *c =
	56	hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS);
	57	struct snd_interval channels = {
	58	.min = UINT_MAX, .max = 0, .integer = 1
	59	};
69dcf3e4 TS	60	unsigned int i, rate, mode, *pcm_channels;
	61
	62	if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
	63	pcm_channels = dice->tx_channels;
	64	else
	65	pcm_channels = dice->rx_channels;
c50fb91f TS	66
	67	for (i = 0; i < ARRAY_SIZE(snd_dice_rates); ++i) {
	68	rate = snd_dice_rates[i];
	69	if (snd_dice_stream_get_rate_mode(dice, rate, &mode) < 0)
	70	continue;
	71
	72	if (!snd_interval_test(r, rate))
	73	continue;
	74
	75	channels.min = min(channels.min, pcm_channels[mode]);
	76	channels.max = max(channels.max, pcm_channels[mode]);
	77	}
	78
	79	return snd_interval_refine(c, &channels);
	80	}
	81
2c2416c8 TS	82	static void limit_channels_and_rates(struct snd_dice *dice,
	83	struct snd_pcm_runtime *runtime,
	84	unsigned int *pcm_channels)
c50fb91f	85	{
2c2416c8 TS	86	struct snd_pcm_hardware *hw = &runtime->hw;
2c2416c8 TS	87	unsigned int i, rate, mode;
c50fb91f	88
2c2416c8 TS	89	hw->channels_min = UINT_MAX;
2c2416c8 TS	90	hw->channels_max = 0;
c50fb91f TS	91
c50fb91f TS	92	for (i = 0; i < ARRAY_SIZE(snd_dice_rates); ++i) {
2c2416c8 TS	93	rate = snd_dice_rates[i];
	94	if (snd_dice_stream_get_rate_mode(dice, rate, &mode) < 0)
	95	continue;
	96	hw->rates \|= snd_pcm_rate_to_rate_bit(rate);
	97
	98	if (pcm_channels[mode] == 0)
	99	continue;
	100	hw->channels_min = min(hw->channels_min, pcm_channels[mode]);
	101	hw->channels_max = max(hw->channels_max, pcm_channels[mode]);
c50fb91f	102	}
2c2416c8	103
c50fb91f	104	snd_pcm_limit_hw_rates(runtime);
2c2416c8	105	}
c50fb91f	106
2c2416c8 TS	107	static void limit_period_and_buffer(struct snd_pcm_hardware *hw)
	108	{
	109	hw->periods_min = 2; /* SNDRV_PCM_INFO_BATCH */
	110	hw->periods_max = UINT_MAX;
	111
	112	hw->period_bytes_min = 4 * hw->channels_max; /* byte for a frame */
	113
	114	/* Just to prevent from allocating much pages. */
	115	hw->period_bytes_max = hw->period_bytes_min * 2048;
	116	hw->buffer_bytes_max = hw->period_bytes_max * hw->periods_min;
	117	}
	118
	119	static int init_hw_info(struct snd_dice *dice,
	120	struct snd_pcm_substream *substream)
	121	{
	122	struct snd_pcm_runtime *runtime = substream->runtime;
	123	struct snd_pcm_hardware *hw = &runtime->hw;
69dcf3e4 TS	124	struct amdtp_stream *stream;
69dcf3e4 TS	125	unsigned int *pcm_channels;
2c2416c8 TS	126	int err;
	127
	128	hw->info = SNDRV_PCM_INFO_MMAP \|
	129	SNDRV_PCM_INFO_MMAP_VALID \|
	130	SNDRV_PCM_INFO_BATCH \|
	131	SNDRV_PCM_INFO_INTERLEAVED \|
69dcf3e4	132	SNDRV_PCM_INFO_JOINT_DUPLEX \|
2c2416c8	133	SNDRV_PCM_INFO_BLOCK_TRANSFER;
2c2416c8	134
69dcf3e4	135	if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
49c7b3fc	136	hw->formats = AM824_IN_PCM_FORMAT_BITS;
69dcf3e4 TS	137	stream = &dice->tx_stream;
	138	pcm_channels = dice->tx_channels;
	139	} else {
49c7b3fc	140	hw->formats = AM824_OUT_PCM_FORMAT_BITS;
69dcf3e4 TS	141	stream = &dice->rx_stream;
	142	pcm_channels = dice->rx_channels;
	143	}
	144
	145	limit_channels_and_rates(dice, runtime, pcm_channels);
2c2416c8	146	limit_period_and_buffer(hw);
c50fb91f TS	147
c50fb91f TS	148	err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_RATE,
69dcf3e4	149	dice_rate_constraint, substream,
c50fb91f TS	150	SNDRV_PCM_HW_PARAM_CHANNELS, -1);
c50fb91f TS	151	if (err < 0)
2c2416c8	152	goto end;
c50fb91f	153	err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_CHANNELS,
69dcf3e4	154	dice_channels_constraint, substream,
c50fb91f TS	155	SNDRV_PCM_HW_PARAM_RATE, -1);
c50fb91f TS	156	if (err < 0)
2c2416c8	157	goto end;
c50fb91f	158
bc8500da	159	err = amdtp_am824_add_pcm_hw_constraints(stream, runtime);
2c2416c8 TS	160	end:
	161	return err;
	162	}
c50fb91f	163
2c2416c8 TS	164	static int pcm_open(struct snd_pcm_substream *substream)
	165	{
	166	struct snd_dice *dice = substream->private_data;
8fc01fc0 TS	167	unsigned int source, rate;
8fc01fc0 TS	168	bool internal;
2c2416c8	169	int err;
c50fb91f	170
2c2416c8 TS	171	err = snd_dice_stream_lock_try(dice);
	172	if (err < 0)
	173	goto end;
	174
	175	err = init_hw_info(dice, substream);
	176	if (err < 0)
	177	goto err_locked;
8fc01fc0 TS	178
	179	err = snd_dice_transaction_get_clock_source(dice, &source);
	180	if (err < 0)
	181	goto err_locked;
	182	switch (source) {
	183	case CLOCK_SOURCE_AES1:
	184	case CLOCK_SOURCE_AES2:
	185	case CLOCK_SOURCE_AES3:
	186	case CLOCK_SOURCE_AES4:
	187	case CLOCK_SOURCE_AES_ANY:
	188	case CLOCK_SOURCE_ADAT:
	189	case CLOCK_SOURCE_TDIF:
	190	case CLOCK_SOURCE_WC:
	191	internal = false;
	192	break;
	193	default:
	194	internal = true;
	195	break;
	196	}
	197
	198	/*
69dcf3e4 TS	199	* When source of clock is not internal or any PCM streams are running,
69dcf3e4 TS	200	* available sampling rate is limited at current sampling rate.
8fc01fc0	201	*/
69dcf3e4 TS	202	if (!internal \|\|
	203	amdtp_stream_pcm_running(&dice->tx_stream) \|\|
	204	amdtp_stream_pcm_running(&dice->rx_stream)) {
8fc01fc0 TS	205	err = snd_dice_transaction_get_rate(dice, &rate);
	206	if (err < 0)
	207	goto err_locked;
	208	substream->runtime->hw.rate_min = rate;
	209	substream->runtime->hw.rate_max = rate;
	210	}
	211
	212	snd_pcm_set_sync(substream);
2c2416c8 TS	213	end:
	214	return err;
	215	err_locked:
c50fb91f	216	snd_dice_stream_lock_release(dice);
c50fb91f TS	217	return err;
	218	}
	219
	220	static int pcm_close(struct snd_pcm_substream *substream)
	221	{
	222	struct snd_dice *dice = substream->private_data;
	223
	224	snd_dice_stream_lock_release(dice);
	225
	226	return 0;
	227	}
	228
69dcf3e4 TS	229	static int capture_hw_params(struct snd_pcm_substream *substream,
	230	struct snd_pcm_hw_params *hw_params)
	231	{
	232	struct snd_dice *dice = substream->private_data;
22c103cd TS	233	int err;
	234
	235	err = snd_pcm_lib_alloc_vmalloc_buffer(substream,
	236	params_buffer_bytes(hw_params));
	237	if (err < 0)
	238	return err;
69dcf3e4 TS	239
	240	if (substream->runtime->status->state == SNDRV_PCM_STATE_OPEN) {
	241	mutex_lock(&dice->mutex);
	242	dice->substreams_counter++;
	243	mutex_unlock(&dice->mutex);
	244	}
	245
85130cb4	246	amdtp_am824_set_pcm_format(&dice->tx_stream, params_format(hw_params));
69dcf3e4	247
22c103cd	248	return 0;
69dcf3e4	249	}
c50fb91f TS	250	static int playback_hw_params(struct snd_pcm_substream *substream,
	251	struct snd_pcm_hw_params *hw_params)
	252	{
	253	struct snd_dice *dice = substream->private_data;
22c103cd TS	254	int err;
	255
	256	err = snd_pcm_lib_alloc_vmalloc_buffer(substream,
	257	params_buffer_bytes(hw_params));
	258	if (err < 0)
	259	return err;
69dcf3e4 TS	260
	261	if (substream->runtime->status->state == SNDRV_PCM_STATE_OPEN) {
	262	mutex_lock(&dice->mutex);
	263	dice->substreams_counter++;
	264	mutex_unlock(&dice->mutex);
	265	}
	266
85130cb4	267	amdtp_am824_set_pcm_format(&dice->rx_stream, params_format(hw_params));
c50fb91f	268
22c103cd	269	return 0;
c50fb91f TS	270	}
c50fb91f TS	271
69dcf3e4 TS	272	static int capture_hw_free(struct snd_pcm_substream *substream)
	273	{
	274	struct snd_dice *dice = substream->private_data;
	275
	276	mutex_lock(&dice->mutex);
	277
	278	if (substream->runtime->status->state != SNDRV_PCM_STATE_OPEN)
	279	dice->substreams_counter--;
	280
	281	snd_dice_stream_stop_duplex(dice);
	282
	283	mutex_unlock(&dice->mutex);
	284
	285	return snd_pcm_lib_free_vmalloc_buffer(substream);
	286	}
	287
c50fb91f TS	288	static int playback_hw_free(struct snd_pcm_substream *substream)
	289	{
	290	struct snd_dice *dice = substream->private_data;
	291
	292	mutex_lock(&dice->mutex);
69dcf3e4 TS	293
	294	if (substream->runtime->status->state != SNDRV_PCM_STATE_OPEN)
	295	dice->substreams_counter--;
	296
9a02843c	297	snd_dice_stream_stop_duplex(dice);
69dcf3e4	298
c50fb91f TS	299	mutex_unlock(&dice->mutex);
	300
	301	return snd_pcm_lib_free_vmalloc_buffer(substream);
	302	}
	303
69dcf3e4 TS	304	static int capture_prepare(struct snd_pcm_substream *substream)
	305	{
	306	struct snd_dice *dice = substream->private_data;
	307	int err;
	308
	309	mutex_lock(&dice->mutex);
	310	err = snd_dice_stream_start_duplex(dice, substream->runtime->rate);
	311	mutex_unlock(&dice->mutex);
	312	if (err >= 0)
	313	amdtp_stream_pcm_prepare(&dice->tx_stream);
	314
	315	return 0;
	316	}
c50fb91f TS	317	static int playback_prepare(struct snd_pcm_substream *substream)
	318	{
	319	struct snd_dice *dice = substream->private_data;
	320	int err;
	321
	322	mutex_lock(&dice->mutex);
9a02843c	323	err = snd_dice_stream_start_duplex(dice, substream->runtime->rate);
c50fb91f	324	mutex_unlock(&dice->mutex);
288a8d0c TS	325	if (err >= 0)
288a8d0c TS	326	amdtp_stream_pcm_prepare(&dice->rx_stream);
c50fb91f	327
288a8d0c	328	return err;
c50fb91f TS	329	}
c50fb91f TS	330
69dcf3e4 TS	331	static int capture_trigger(struct snd_pcm_substream *substream, int cmd)
	332	{
	333	struct snd_dice *dice = substream->private_data;
	334
	335	switch (cmd) {
	336	case SNDRV_PCM_TRIGGER_START:
	337	amdtp_stream_pcm_trigger(&dice->tx_stream, substream);
	338	break;
	339	case SNDRV_PCM_TRIGGER_STOP:
	340	amdtp_stream_pcm_trigger(&dice->tx_stream, NULL);
	341	break;
	342	default:
	343	return -EINVAL;
	344	}
	345
	346	return 0;
	347	}
c50fb91f TS	348	static int playback_trigger(struct snd_pcm_substream *substream, int cmd)
	349	{
	350	struct snd_dice *dice = substream->private_data;
	351
	352	switch (cmd) {
	353	case SNDRV_PCM_TRIGGER_START:
	354	amdtp_stream_pcm_trigger(&dice->rx_stream, substream);
	355	break;
	356	case SNDRV_PCM_TRIGGER_STOP:
	357	amdtp_stream_pcm_trigger(&dice->rx_stream, NULL);
	358	break;
	359	default:
	360	return -EINVAL;
	361	}
	362
	363	return 0;
	364	}
	365
69dcf3e4 TS	366	static snd_pcm_uframes_t capture_pointer(struct snd_pcm_substream *substream)
	367	{
	368	struct snd_dice *dice = substream->private_data;
	369
	370	return amdtp_stream_pcm_pointer(&dice->tx_stream);
	371	}
c50fb91f TS	372	static snd_pcm_uframes_t playback_pointer(struct snd_pcm_substream *substream)
	373	{
	374	struct snd_dice *dice = substream->private_data;
	375
	376	return amdtp_stream_pcm_pointer(&dice->rx_stream);
	377	}
	378
	379	int snd_dice_create_pcm(struct snd_dice *dice)
	380	{
69dcf3e4 TS	381	static struct snd_pcm_ops capture_ops = {
	382	.open = pcm_open,
	383	.close = pcm_close,
	384	.ioctl = snd_pcm_lib_ioctl,
	385	.hw_params = capture_hw_params,
	386	.hw_free = capture_hw_free,
	387	.prepare = capture_prepare,
	388	.trigger = capture_trigger,
	389	.pointer = capture_pointer,
	390	.page = snd_pcm_lib_get_vmalloc_page,
	391	.mmap = snd_pcm_lib_mmap_vmalloc,
	392	};
c50fb91f TS	393	static struct snd_pcm_ops playback_ops = {
	394	.open = pcm_open,
	395	.close = pcm_close,
	396	.ioctl = snd_pcm_lib_ioctl,
	397	.hw_params = playback_hw_params,
	398	.hw_free = playback_hw_free,
	399	.prepare = playback_prepare,
	400	.trigger = playback_trigger,
	401	.pointer = playback_pointer,
	402	.page = snd_pcm_lib_get_vmalloc_page,
	403	.mmap = snd_pcm_lib_mmap_vmalloc,
	404	};
	405	struct snd_pcm *pcm;
69dcf3e4	406	unsigned int i, capture, playback;
c50fb91f TS	407	int err;
c50fb91f TS	408
69dcf3e4 TS	409	capture = playback = 0;
	410	for (i = 0; i < 3; i++) {
	411	if (dice->tx_channels[i] > 0)
	412	capture = 1;
	413	if (dice->rx_channels[i] > 0)
	414	playback = 1;
	415	}
	416
	417	err = snd_pcm_new(dice->card, "DICE", 0, playback, capture, &pcm);
c50fb91f TS	418	if (err < 0)
	419	return err;
	420	pcm->private_data = dice;
	421	strcpy(pcm->name, dice->card->shortname);
69dcf3e4 TS	422
	423	if (capture > 0)
	424	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &capture_ops);
	425
	426	if (playback > 0)
	427	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &playback_ops);
c50fb91f TS	428
	429	return 0;
	430	}