1
2
3
4
5
6
7
8
9
10
11
12#include <linux/kernel.h>
13#include <linux/module.h>
14#include <linux/slab.h>
15#include <linux/device.h>
16#include <linux/delay.h>
17#include <linux/ctype.h>
18#include <linux/random.h>
19#include <linux/syscalls.h>
20
21#include "u_uac1.h"
22
23
24
25
26
27
28
29
30
31
32static int snd_interval_refine_set(struct snd_interval *i, unsigned int val)
33{
34 struct snd_interval t;
35 t.empty = 0;
36 t.min = t.max = val;
37 t.openmin = t.openmax = 0;
38 t.integer = 1;
39 return snd_interval_refine(i, &t);
40}
41
42static int _snd_pcm_hw_param_set(struct snd_pcm_hw_params *params,
43 snd_pcm_hw_param_t var, unsigned int val,
44 int dir)
45{
46 int changed;
47 if (hw_is_mask(var)) {
48 struct snd_mask *m = hw_param_mask(params, var);
49 if (val == 0 && dir < 0) {
50 changed = -EINVAL;
51 snd_mask_none(m);
52 } else {
53 if (dir > 0)
54 val++;
55 else if (dir < 0)
56 val--;
57 changed = snd_mask_refine_set(
58 hw_param_mask(params, var), val);
59 }
60 } else if (hw_is_interval(var)) {
61 struct snd_interval *i = hw_param_interval(params, var);
62 if (val == 0 && dir < 0) {
63 changed = -EINVAL;
64 snd_interval_none(i);
65 } else if (dir == 0)
66 changed = snd_interval_refine_set(i, val);
67 else {
68 struct snd_interval t;
69 t.openmin = 1;
70 t.openmax = 1;
71 t.empty = 0;
72 t.integer = 0;
73 if (dir < 0) {
74 t.min = val - 1;
75 t.max = val;
76 } else {
77 t.min = val;
78 t.max = val+1;
79 }
80 changed = snd_interval_refine(i, &t);
81 }
82 } else
83 return -EINVAL;
84 if (changed) {
85 params->cmask |= 1 << var;
86 params->rmask |= 1 << var;
87 }
88 return changed;
89}
90
91
92
93
94
95static int playback_default_hw_params(struct gaudio_snd_dev *snd)
96{
97 struct snd_pcm_substream *substream = snd->substream;
98 struct snd_pcm_hw_params *params;
99 snd_pcm_sframes_t result;
100
101
102
103
104
105
106
107 snd->access = SNDRV_PCM_ACCESS_RW_INTERLEAVED;
108 snd->format = SNDRV_PCM_FORMAT_S16_LE;
109 snd->channels = 2;
110 snd->rate = 48000;
111
112 params = kzalloc(sizeof(*params), GFP_KERNEL);
113 if (!params)
114 return -ENOMEM;
115
116 _snd_pcm_hw_params_any(params);
117 _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_ACCESS,
118 snd->access, 0);
119 _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_FORMAT,
120 snd->format, 0);
121 _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_CHANNELS,
122 snd->channels, 0);
123 _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_RATE,
124 snd->rate, 0);
125
126 snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL);
127 snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_HW_PARAMS, params);
128
129 result = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_PREPARE, NULL);
130 if (result < 0) {
131 ERROR(snd->card,
132 "Preparing sound card failed: %d\n", (int)result);
133 kfree(params);
134 return result;
135 }
136
137
138 snd->access = params_access(params);
139 snd->format = params_format(params);
140 snd->channels = params_channels(params);
141 snd->rate = params_rate(params);
142
143 kfree(params);
144
145 INFO(snd->card,
146 "Hardware params: access %x, format %x, channels %d, rate %d\n",
147 snd->access, snd->format, snd->channels, snd->rate);
148
149 return 0;
150}
151
152
153
154
155size_t u_audio_playback(struct gaudio *card, void *buf, size_t count)
156{
157 struct gaudio_snd_dev *snd = &card->playback;
158 struct snd_pcm_substream *substream = snd->substream;
159 struct snd_pcm_runtime *runtime = substream->runtime;
160 mm_segment_t old_fs;
161 ssize_t result;
162 snd_pcm_sframes_t frames;
163
164try_again:
165 if (runtime->status->state == SNDRV_PCM_STATE_XRUN ||
166 runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) {
167 result = snd_pcm_kernel_ioctl(substream,
168 SNDRV_PCM_IOCTL_PREPARE, NULL);
169 if (result < 0) {
170 ERROR(card, "Preparing sound card failed: %d\n",
171 (int)result);
172 return result;
173 }
174 }
175
176 frames = bytes_to_frames(runtime, count);
177 old_fs = get_fs();
178 set_fs(KERNEL_DS);
179 result = snd_pcm_lib_write(snd->substream, (void __user *)buf, frames);
180 if (result != frames) {
181 ERROR(card, "Playback error: %d\n", (int)result);
182 set_fs(old_fs);
183 goto try_again;
184 }
185 set_fs(old_fs);
186
187 return 0;
188}
189
190int u_audio_get_playback_channels(struct gaudio *card)
191{
192 return card->playback.channels;
193}
194
195int u_audio_get_playback_rate(struct gaudio *card)
196{
197 return card->playback.rate;
198}
199
200
201
202
203
204static int gaudio_open_snd_dev(struct gaudio *card)
205{
206 struct snd_pcm_file *pcm_file;
207 struct gaudio_snd_dev *snd;
208 struct f_uac1_opts *opts;
209 char *fn_play, *fn_cap, *fn_cntl;
210
211 opts = container_of(card->func.fi, struct f_uac1_opts, func_inst);
212 fn_play = opts->fn_play;
213 fn_cap = opts->fn_cap;
214 fn_cntl = opts->fn_cntl;
215
216
217 snd = &card->control;
218 snd->filp = filp_open(fn_cntl, O_RDWR, 0);
219 if (IS_ERR(snd->filp)) {
220 int ret = PTR_ERR(snd->filp);
221 ERROR(card, "unable to open sound control device file: %s\n",
222 fn_cntl);
223 snd->filp = NULL;
224 return ret;
225 }
226 snd->card = card;
227
228
229 snd = &card->playback;
230 snd->filp = filp_open(fn_play, O_WRONLY, 0);
231 if (IS_ERR(snd->filp)) {
232 int ret = PTR_ERR(snd->filp);
233
234 ERROR(card, "No such PCM playback device: %s\n", fn_play);
235 snd->filp = NULL;
236 return ret;
237 }
238 pcm_file = snd->filp->private_data;
239 snd->substream = pcm_file->substream;
240 snd->card = card;
241 playback_default_hw_params(snd);
242
243
244 snd = &card->capture;
245 snd->filp = filp_open(fn_cap, O_RDONLY, 0);
246 if (IS_ERR(snd->filp)) {
247 ERROR(card, "No such PCM capture device: %s\n", fn_cap);
248 snd->substream = NULL;
249 snd->card = NULL;
250 snd->filp = NULL;
251 } else {
252 pcm_file = snd->filp->private_data;
253 snd->substream = pcm_file->substream;
254 snd->card = card;
255 }
256
257 return 0;
258}
259
260
261
262
263static int gaudio_close_snd_dev(struct gaudio *gau)
264{
265 struct gaudio_snd_dev *snd;
266
267
268 snd = &gau->control;
269 if (snd->filp)
270 filp_close(snd->filp, NULL);
271
272
273 snd = &gau->playback;
274 if (snd->filp)
275 filp_close(snd->filp, NULL);
276
277
278 snd = &gau->capture;
279 if (snd->filp)
280 filp_close(snd->filp, NULL);
281
282 return 0;
283}
284
285
286
287
288
289
290
291
292int gaudio_setup(struct gaudio *card)
293{
294 int ret;
295
296 ret = gaudio_open_snd_dev(card);
297 if (ret)
298 ERROR(card, "we need at least one control device\n");
299
300 return ret;
301
302}
303
304
305
306
307
308
309void gaudio_cleanup(struct gaudio *the_card)
310{
311 if (the_card)
312 gaudio_close_snd_dev(the_card);
313}
314
315