1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * amdtp-ff.c - a part of driver for RME Fireface series |
4 | * |
5 | * Copyright (c) 2015-2017 Takashi Sakamoto |
6 | */ |
7 | |
8 | #include <sound/pcm.h> |
9 | #include "ff.h" |
10 | |
11 | struct amdtp_ff { |
12 | unsigned int pcm_channels; |
13 | }; |
14 | |
15 | int amdtp_ff_set_parameters(struct amdtp_stream *s, unsigned int rate, |
16 | unsigned int pcm_channels) |
17 | { |
18 | struct amdtp_ff *p = s->protocol; |
19 | unsigned int data_channels; |
20 | |
21 | if (amdtp_stream_running(s)) |
22 | return -EBUSY; |
23 | |
24 | p->pcm_channels = pcm_channels; |
25 | data_channels = pcm_channels; |
26 | |
27 | return amdtp_stream_set_parameters(s, rate, data_block_quadlets: data_channels, pcm_frame_multiplier: 1); |
28 | } |
29 | |
30 | static void write_pcm_s32(struct amdtp_stream *s, struct snd_pcm_substream *pcm, |
31 | __le32 *buffer, unsigned int frames, |
32 | unsigned int pcm_frames) |
33 | { |
34 | struct amdtp_ff *p = s->protocol; |
35 | unsigned int channels = p->pcm_channels; |
36 | struct snd_pcm_runtime *runtime = pcm->runtime; |
37 | unsigned int pcm_buffer_pointer; |
38 | int remaining_frames; |
39 | const u32 *src; |
40 | int i, c; |
41 | |
42 | pcm_buffer_pointer = s->pcm_buffer_pointer + pcm_frames; |
43 | pcm_buffer_pointer %= runtime->buffer_size; |
44 | |
45 | src = (void *)runtime->dma_area + |
46 | frames_to_bytes(runtime, size: pcm_buffer_pointer); |
47 | remaining_frames = runtime->buffer_size - pcm_buffer_pointer; |
48 | |
49 | for (i = 0; i < frames; ++i) { |
50 | for (c = 0; c < channels; ++c) { |
51 | buffer[c] = cpu_to_le32(*src); |
52 | src++; |
53 | } |
54 | buffer += s->data_block_quadlets; |
55 | if (--remaining_frames == 0) |
56 | src = (void *)runtime->dma_area; |
57 | } |
58 | } |
59 | |
60 | static void read_pcm_s32(struct amdtp_stream *s, struct snd_pcm_substream *pcm, |
61 | __le32 *buffer, unsigned int frames, |
62 | unsigned int pcm_frames) |
63 | { |
64 | struct amdtp_ff *p = s->protocol; |
65 | unsigned int channels = p->pcm_channels; |
66 | struct snd_pcm_runtime *runtime = pcm->runtime; |
67 | unsigned int pcm_buffer_pointer; |
68 | int remaining_frames; |
69 | u32 *dst; |
70 | int i, c; |
71 | |
72 | pcm_buffer_pointer = s->pcm_buffer_pointer + pcm_frames; |
73 | pcm_buffer_pointer %= runtime->buffer_size; |
74 | |
75 | dst = (void *)runtime->dma_area + |
76 | frames_to_bytes(runtime, size: pcm_buffer_pointer); |
77 | remaining_frames = runtime->buffer_size - pcm_buffer_pointer; |
78 | |
79 | for (i = 0; i < frames; ++i) { |
80 | for (c = 0; c < channels; ++c) { |
81 | *dst = le32_to_cpu(buffer[c]) & 0xffffff00; |
82 | dst++; |
83 | } |
84 | buffer += s->data_block_quadlets; |
85 | if (--remaining_frames == 0) |
86 | dst = (void *)runtime->dma_area; |
87 | } |
88 | } |
89 | |
90 | static void write_pcm_silence(struct amdtp_stream *s, |
91 | __le32 *buffer, unsigned int frames) |
92 | { |
93 | struct amdtp_ff *p = s->protocol; |
94 | unsigned int i, c, channels = p->pcm_channels; |
95 | |
96 | for (i = 0; i < frames; ++i) { |
97 | for (c = 0; c < channels; ++c) |
98 | buffer[c] = cpu_to_le32(0x00000000); |
99 | buffer += s->data_block_quadlets; |
100 | } |
101 | } |
102 | |
103 | int amdtp_ff_add_pcm_hw_constraints(struct amdtp_stream *s, |
104 | struct snd_pcm_runtime *runtime) |
105 | { |
106 | int err; |
107 | |
108 | err = snd_pcm_hw_constraint_msbits(runtime, cond: 0, width: 32, msbits: 24); |
109 | if (err < 0) |
110 | return err; |
111 | |
112 | return amdtp_stream_add_pcm_hw_constraints(s, runtime); |
113 | } |
114 | |
115 | static void process_it_ctx_payloads(struct amdtp_stream *s, const struct pkt_desc *desc, |
116 | unsigned int count, struct snd_pcm_substream *pcm) |
117 | { |
118 | unsigned int pcm_frames = 0; |
119 | int i; |
120 | |
121 | for (i = 0; i < count; ++i) { |
122 | __le32 *buf = (__le32 *)desc->ctx_payload; |
123 | unsigned int data_blocks = desc->data_blocks; |
124 | |
125 | if (pcm) { |
126 | write_pcm_s32(s, pcm, buffer: buf, frames: data_blocks, pcm_frames); |
127 | pcm_frames += data_blocks; |
128 | } else { |
129 | write_pcm_silence(s, buffer: buf, frames: data_blocks); |
130 | } |
131 | |
132 | desc = amdtp_stream_next_packet_desc(s, desc); |
133 | } |
134 | } |
135 | |
136 | static void process_ir_ctx_payloads(struct amdtp_stream *s, const struct pkt_desc *desc, |
137 | unsigned int count, struct snd_pcm_substream *pcm) |
138 | { |
139 | unsigned int pcm_frames = 0; |
140 | int i; |
141 | |
142 | for (i = 0; i < count; ++i) { |
143 | __le32 *buf = (__le32 *)desc->ctx_payload; |
144 | unsigned int data_blocks = desc->data_blocks; |
145 | |
146 | if (pcm) { |
147 | read_pcm_s32(s, pcm, buffer: buf, frames: data_blocks, pcm_frames); |
148 | pcm_frames += data_blocks; |
149 | } |
150 | |
151 | desc = amdtp_stream_next_packet_desc(s, desc); |
152 | } |
153 | } |
154 | |
155 | int amdtp_ff_init(struct amdtp_stream *s, struct fw_unit *unit, |
156 | enum amdtp_stream_direction dir) |
157 | { |
158 | amdtp_stream_process_ctx_payloads_t process_ctx_payloads; |
159 | |
160 | if (dir == AMDTP_IN_STREAM) |
161 | process_ctx_payloads = process_ir_ctx_payloads; |
162 | else |
163 | process_ctx_payloads = process_it_ctx_payloads; |
164 | |
165 | return amdtp_stream_init(s, unit, dir, flags: CIP_BLOCKING | CIP_UNAWARE_SYT | CIP_NO_HEADER, fmt: 0, |
166 | process_ctx_payloads, protocol_size: sizeof(struct amdtp_ff)); |
167 | } |
168 | |