[mirror_ubuntu-bionic-kernel.git] / sound / firewire / tascam / amdtp-tascam.c

/*
 * amdtp-tascam.c - a part of driver for TASCAM FireWire series
 *
 * Copyright (c) 2015 Takashi Sakamoto
 *
 * Licensed under the terms of the GNU General Public License, version 2.
 */

#include <sound/pcm.h>
#include "tascam.h"

#define AMDTP_FMT_TSCM_TX	0x1e
#define AMDTP_FMT_TSCM_RX	0x3e

struct amdtp_tscm {
	unsigned int pcm_channels;

	void (*transfer_samples)(struct amdtp_stream *s,
				 struct snd_pcm_substream *pcm,
				 __be32 *buffer, unsigned int frames);
};

int amdtp_tscm_set_parameters(struct amdtp_stream *s, unsigned int rate)
{
	struct amdtp_tscm *p = s->protocol;
	unsigned int data_channels;

	if (amdtp_stream_running(s))
		return -EBUSY;

	data_channels = p->pcm_channels;

	/* Packets in in-stream have extra 2 data channels. */
	if (s->direction == AMDTP_IN_STREAM)
		data_channels += 2;

	return amdtp_stream_set_parameters(s, rate, data_channels);
}

static void write_pcm_s32(struct amdtp_stream *s,
			  struct snd_pcm_substream *pcm,
			  __be32 *buffer, unsigned int frames)
{
	struct amdtp_tscm *p = s->protocol;
	struct snd_pcm_runtime *runtime = pcm->runtime;
	unsigned int channels, remaining_frames, i, c;
	const u32 *src;

	channels = p->pcm_channels;
	src = (void *)runtime->dma_area +
			frames_to_bytes(runtime, s->pcm_buffer_pointer);
	remaining_frames = runtime->buffer_size - s->pcm_buffer_pointer;

	for (i = 0; i < frames; ++i) {
		for (c = 0; c < channels; ++c) {
			buffer[c] = cpu_to_be32(*src);
			src++;
		}
		buffer += s->data_block_quadlets;
		if (--remaining_frames == 0)
			src = (void *)runtime->dma_area;
	}
}

static void write_pcm_s16(struct amdtp_stream *s,
			  struct snd_pcm_substream *pcm,
			  __be32 *buffer, unsigned int frames)
{
	struct amdtp_tscm *p = s->protocol;
	struct snd_pcm_runtime *runtime = pcm->runtime;
	unsigned int channels, remaining_frames, i, c;
	const u16 *src;

	channels = p->pcm_channels;
	src = (void *)runtime->dma_area +
			frames_to_bytes(runtime, s->pcm_buffer_pointer);
	remaining_frames = runtime->buffer_size - s->pcm_buffer_pointer;

	for (i = 0; i < frames; ++i) {
		for (c = 0; c < channels; ++c) {
			buffer[c] = cpu_to_be32(*src << 16);
			src++;
		}
		buffer += s->data_block_quadlets;
		if (--remaining_frames == 0)
			src = (void *)runtime->dma_area;
	}
}

static void read_pcm_s32(struct amdtp_stream *s,
			 struct snd_pcm_substream *pcm,
			 __be32 *buffer, unsigned int frames)
{
	struct amdtp_tscm *p = s->protocol;
	struct snd_pcm_runtime *runtime = pcm->runtime;
	unsigned int channels, remaining_frames, i, c;
	u32 *dst;

	channels = p->pcm_channels;
	dst  = (void *)runtime->dma_area +
			frames_to_bytes(runtime, s->pcm_buffer_pointer);
	remaining_frames = runtime->buffer_size - s->pcm_buffer_pointer;

	/* The first data channel is for event counter. */
	buffer += 1;

	for (i = 0; i < frames; ++i) {
		for (c = 0; c < channels; ++c) {
			*dst = be32_to_cpu(buffer[c]);
			dst++;
		}
		buffer += s->data_block_quadlets;
		if (--remaining_frames == 0)
			dst = (void *)runtime->dma_area;
	}
}

static void write_pcm_silence(struct amdtp_stream *s, __be32 *buffer,
			      unsigned int data_blocks)
{
	struct amdtp_tscm *p = s->protocol;
	unsigned int channels, i, c;

	channels = p->pcm_channels;

	for (i = 0; i < data_blocks; ++i) {
		for (c = 0; c < channels; ++c)
			buffer[c] = 0x00000000;
		buffer += s->data_block_quadlets;
	}
}

int amdtp_tscm_add_pcm_hw_constraints(struct amdtp_stream *s,
				      struct snd_pcm_runtime *runtime)
{
	int err;

	/*
	 * Our implementation allows this protocol to deliver 24 bit sample in
	 * 32bit data channel.
	 */
	err = snd_pcm_hw_constraint_msbits(runtime, 0, 32, 24);
	if (err < 0)
		return err;

	return amdtp_stream_add_pcm_hw_constraints(s, runtime);
}

void amdtp_tscm_set_pcm_format(struct amdtp_stream *s, snd_pcm_format_t format)
{
	struct amdtp_tscm *p = s->protocol;

	if (WARN_ON(amdtp_stream_pcm_running(s)))
		return;

	switch (format) {
	default:
		WARN_ON(1);
		/* fall through */
	case SNDRV_PCM_FORMAT_S16:
		if (s->direction == AMDTP_OUT_STREAM) {
			p->transfer_samples = write_pcm_s16;
			break;
		}
		WARN_ON(1);
		/* fall through */
	case SNDRV_PCM_FORMAT_S32:
		if (s->direction == AMDTP_OUT_STREAM)
			p->transfer_samples = write_pcm_s32;
		else
			p->transfer_samples = read_pcm_s32;
		break;
	}
}

static unsigned int process_tx_data_blocks(struct amdtp_stream *s,
					   __be32 *buffer,
					   unsigned int data_blocks,
					   unsigned int *syt)
{
	struct amdtp_tscm *p = (struct amdtp_tscm *)s->protocol;
	struct snd_pcm_substream *pcm;

	pcm = ACCESS_ONCE(s->pcm);
	if (data_blocks > 0 && pcm)
		p->transfer_samples(s, pcm, buffer, data_blocks);

	/* A place holder for control messages. */

	return data_blocks;
}

static unsigned int process_rx_data_blocks(struct amdtp_stream *s,
					   __be32 *buffer,
					   unsigned int data_blocks,
					   unsigned int *syt)
{
	struct amdtp_tscm *p = (struct amdtp_tscm *)s->protocol;
	struct snd_pcm_substream *pcm;

	/* This field is not used. */
	*syt = 0x0000;

	pcm = ACCESS_ONCE(s->pcm);
	if (pcm)
		p->transfer_samples(s, pcm, buffer, data_blocks);
	else
		write_pcm_silence(s, buffer, data_blocks);

	return data_blocks;
}

int amdtp_tscm_init(struct amdtp_stream *s, struct fw_unit *unit,
		    enum amdtp_stream_direction dir, unsigned int pcm_channels)
{
	amdtp_stream_process_data_blocks_t process_data_blocks;
	struct amdtp_tscm *p;
	unsigned int fmt;
	int err;

	if (dir == AMDTP_IN_STREAM) {
		fmt = AMDTP_FMT_TSCM_TX;
		process_data_blocks = process_tx_data_blocks;
	} else {
		fmt = AMDTP_FMT_TSCM_RX;
		process_data_blocks = process_rx_data_blocks;
	}

	err = amdtp_stream_init(s, unit, dir,
				CIP_NONBLOCKING | CIP_SKIP_DBC_ZERO_CHECK, fmt,
				process_data_blocks, sizeof(struct amdtp_tscm));
	if (err < 0)
		return 0;

	/* Use fixed value for FDF field. */
	s->fdf = 0x00;

	/* This protocol uses fixed number of data channels for PCM samples. */
	p = s->protocol;
	p->pcm_channels = pcm_channels;

	return 0;
}
Commit	Line	Data
47faeea2 TS	1	/*
	2	* amdtp-tascam.c - a part of driver for TASCAM FireWire series
	3	*
	4	* Copyright (c) 2015 Takashi Sakamoto
	5	*
	6	* Licensed under the terms of the GNU General Public License, version 2.
	7	*/
	8
	9	#include <sound/pcm.h>
	10	#include "tascam.h"
	11
	12	#define AMDTP_FMT_TSCM_TX 0x1e
	13	#define AMDTP_FMT_TSCM_RX 0x3e
	14
	15	struct amdtp_tscm {
	16	unsigned int pcm_channels;
	17
	18	void (transfer_samples)(struct amdtp_stream s,
	19	struct snd_pcm_substream *pcm,
	20	__be32 *buffer, unsigned int frames);
	21	};
	22
	23	int amdtp_tscm_set_parameters(struct amdtp_stream *s, unsigned int rate)
	24	{
	25	struct amdtp_tscm *p = s->protocol;
	26	unsigned int data_channels;
	27
	28	if (amdtp_stream_running(s))
	29	return -EBUSY;
	30
	31	data_channels = p->pcm_channels;
	32
	33	/* Packets in in-stream have extra 2 data channels. */
	34	if (s->direction == AMDTP_IN_STREAM)
	35	data_channels += 2;
	36
	37	return amdtp_stream_set_parameters(s, rate, data_channels);
	38	}
	39
	40	static void write_pcm_s32(struct amdtp_stream *s,
	41	struct snd_pcm_substream *pcm,
	42	__be32 *buffer, unsigned int frames)
	43	{
	44	struct amdtp_tscm *p = s->protocol;
	45	struct snd_pcm_runtime *runtime = pcm->runtime;
	46	unsigned int channels, remaining_frames, i, c;
	47	const u32 *src;
	48
	49	channels = p->pcm_channels;
	50	src = (void *)runtime->dma_area +
	51	frames_to_bytes(runtime, s->pcm_buffer_pointer);
	52	remaining_frames = runtime->buffer_size - s->pcm_buffer_pointer;
	53
	54	for (i = 0; i < frames; ++i) {
	55	for (c = 0; c < channels; ++c) {
	56	buffer[c] = cpu_to_be32(*src);
	57	src++;
	58	}
	59	buffer += s->data_block_quadlets;
	60	if (--remaining_frames == 0)
	61	src = (void *)runtime->dma_area;
	62	}
	63	}
	64
65	static void write_pcm_s16(struct amdtp_stream *s,
66	struct snd_pcm_substream *pcm,
67	__be32 *buffer, unsigned int frames)
68	{
69	struct amdtp_tscm *p = s->protocol;
70	struct snd_pcm_runtime *runtime = pcm->runtime;
71	unsigned int channels, remaining_frames, i, c;
72	const u16 *src;
73
74	channels = p->pcm_channels;
75	src = (void *)runtime->dma_area +
76	frames_to_bytes(runtime, s->pcm_buffer_pointer);
77	remaining_frames = runtime->buffer_size - s->pcm_buffer_pointer;
78
79	for (i = 0; i < frames; ++i) {
80	for (c = 0; c < channels; ++c) {
81	buffer[c] = cpu_to_be32(*src << 16);
82	src++;
83	}
84	buffer += s->data_block_quadlets;
85	if (--remaining_frames == 0)
86	src = (void *)runtime->dma_area;
87	}
88	}
89
90	static void read_pcm_s32(struct amdtp_stream *s,
91	struct snd_pcm_substream *pcm,
92	__be32 *buffer, unsigned int frames)
93	{
94	struct amdtp_tscm *p = s->protocol;
95	struct snd_pcm_runtime *runtime = pcm->runtime;
96	unsigned int channels, remaining_frames, i, c;
97	u32 *dst;
98
99	channels = p->pcm_channels;
100	dst = (void *)runtime->dma_area +
101	frames_to_bytes(runtime, s->pcm_buffer_pointer);
102	remaining_frames = runtime->buffer_size - s->pcm_buffer_pointer;
103
104	/* The first data channel is for event counter. */
105	buffer += 1;
106
107	for (i = 0; i < frames; ++i) {
108	for (c = 0; c < channels; ++c) {
109	*dst = be32_to_cpu(buffer[c]);
110	dst++;
111	}
112	buffer += s->data_block_quadlets;
113	if (--remaining_frames == 0)
114	dst = (void *)runtime->dma_area;
115	}
116	}
117
118	static void write_pcm_silence(struct amdtp_stream s, __be32 buffer,
119	unsigned int data_blocks)
120	{
121	struct amdtp_tscm *p = s->protocol;
122	unsigned int channels, i, c;
123
124	channels = p->pcm_channels;
125
126	for (i = 0; i < data_blocks; ++i) {
127	for (c = 0; c < channels; ++c)
128	buffer[c] = 0x00000000;
129	buffer += s->data_block_quadlets;
130	}
131	}
132
133	int amdtp_tscm_add_pcm_hw_constraints(struct amdtp_stream *s,
134	struct snd_pcm_runtime *runtime)
135	{
136	int err;
137
138	/*
139	* Our implementation allows this protocol to deliver 24 bit sample in
140	* 32bit data channel.
141	*/
142	err = snd_pcm_hw_constraint_msbits(runtime, 0, 32, 24);
143	if (err < 0)
144	return err;
145
146	return amdtp_stream_add_pcm_hw_constraints(s, runtime);
147	}
148
149	void amdtp_tscm_set_pcm_format(struct amdtp_stream *s, snd_pcm_format_t format)
150	{
151	struct amdtp_tscm *p = s->protocol;
152
153	if (WARN_ON(amdtp_stream_pcm_running(s)))
154	return;
155
156	switch (format) {
157	default:
158	WARN_ON(1);
159	/* fall through */
160	case SNDRV_PCM_FORMAT_S16:
161	if (s->direction == AMDTP_OUT_STREAM) {
162	p->transfer_samples = write_pcm_s16;
163	break;
164	}
165	WARN_ON(1);
166	/* fall through */
167	case SNDRV_PCM_FORMAT_S32:
168	if (s->direction == AMDTP_OUT_STREAM)
169	p->transfer_samples = write_pcm_s32;
170	else
171	p->transfer_samples = read_pcm_s32;
172	break;
173	}
174	}
175
176	static unsigned int process_tx_data_blocks(struct amdtp_stream *s,
177	__be32 *buffer,
178	unsigned int data_blocks,
179	unsigned int *syt)
180	{
181	struct amdtp_tscm p = (struct amdtp_tscm )s->protocol;
182	struct snd_pcm_substream *pcm;
183
184	pcm = ACCESS_ONCE(s->pcm);
185	if (data_blocks > 0 && pcm)
186	p->transfer_samples(s, pcm, buffer, data_blocks);
187
188	/* A place holder for control messages. */
189
190	return data_blocks;
191	}
192
193	static unsigned int process_rx_data_blocks(struct amdtp_stream *s,
194	__be32 *buffer,
195	unsigned int data_blocks,
196	unsigned int *syt)
197	{
198	struct amdtp_tscm p = (struct amdtp_tscm )s->protocol;
199	struct snd_pcm_substream *pcm;
200
201	/* This field is not used. */
202	*syt = 0x0000;
203
204	pcm = ACCESS_ONCE(s->pcm);
205	if (pcm)
206	p->transfer_samples(s, pcm, buffer, data_blocks);
207	else
208	write_pcm_silence(s, buffer, data_blocks);
209
210	return data_blocks;
211	}
212
213	int amdtp_tscm_init(struct amdtp_stream s, struct fw_unit unit,
214	enum amdtp_stream_direction dir, unsigned int pcm_channels)
215	{
216	amdtp_stream_process_data_blocks_t process_data_blocks;
217	struct amdtp_tscm *p;
218	unsigned int fmt;
219	int err;
220
221	if (dir == AMDTP_IN_STREAM) {
222	fmt = AMDTP_FMT_TSCM_TX;
223	process_data_blocks = process_tx_data_blocks;
224	} else {
225	fmt = AMDTP_FMT_TSCM_RX;
226	process_data_blocks = process_rx_data_blocks;
227	}
228
229	err = amdtp_stream_init(s, unit, dir,
230	CIP_NONBLOCKING \| CIP_SKIP_DBC_ZERO_CHECK, fmt,
231	process_data_blocks, sizeof(struct amdtp_tscm));
232	if (err < 0)
233	return 0;
234
235	/* Use fixed value for FDF field. */
236	s->fdf = 0x00;
237
238	/* This protocol uses fixed number of data channels for PCM samples. */
239	p = s->protocol;
240	p->pcm_channels = pcm_channels;
241
242	return 0;
243	}