pad.c revision 1.25.2.6 1 1.25.2.6 pgoyette /* $NetBSD: pad.c,v 1.25.2.6 2017/03/20 06:57:29 pgoyette Exp $ */
2 1.1 jmcneill
3 1.1 jmcneill /*-
4 1.1 jmcneill * Copyright (c) 2007 Jared D. McNeill <jmcneill (at) invisible.ca>
5 1.1 jmcneill * All rights reserved.
6 1.1 jmcneill *
7 1.1 jmcneill * Redistribution and use in source and binary forms, with or without
8 1.1 jmcneill * modification, are permitted provided that the following conditions
9 1.1 jmcneill * are met:
10 1.1 jmcneill * 1. Redistributions of source code must retain the above copyright
11 1.1 jmcneill * notice, this list of conditions and the following disclaimer.
12 1.1 jmcneill * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 jmcneill * notice, this list of conditions and the following disclaimer in the
14 1.1 jmcneill * documentation and/or other materials provided with the distribution.
15 1.1 jmcneill *
16 1.1 jmcneill * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17 1.1 jmcneill * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 1.1 jmcneill * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 1.1 jmcneill * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20 1.1 jmcneill * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 1.1 jmcneill * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 1.1 jmcneill * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 1.1 jmcneill * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 1.1 jmcneill * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 1.1 jmcneill * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 1.1 jmcneill * POSSIBILITY OF SUCH DAMAGE.
27 1.1 jmcneill */
28 1.1 jmcneill
29 1.1 jmcneill #include <sys/cdefs.h>
30 1.25.2.6 pgoyette __KERNEL_RCSID(0, "$NetBSD: pad.c,v 1.25.2.6 2017/03/20 06:57:29 pgoyette Exp $");
31 1.1 jmcneill
32 1.1 jmcneill #include <sys/types.h>
33 1.1 jmcneill #include <sys/param.h>
34 1.1 jmcneill #include <sys/conf.h>
35 1.1 jmcneill #include <sys/buf.h>
36 1.1 jmcneill #include <sys/kmem.h>
37 1.1 jmcneill #include <sys/kernel.h>
38 1.1 jmcneill #include <sys/device.h>
39 1.1 jmcneill #include <sys/proc.h>
40 1.1 jmcneill #include <sys/condvar.h>
41 1.1 jmcneill #include <sys/select.h>
42 1.1 jmcneill #include <sys/audioio.h>
43 1.5 dyoung #include <sys/vnode.h>
44 1.13 ahoka #include <sys/module.h>
45 1.17 jmcneill #include <sys/atomic.h>
46 1.24 nat #include <sys/time.h>
47 1.25.2.1 pgoyette #include <sys/localcount.h>
48 1.1 jmcneill
49 1.1 jmcneill #include <dev/audio_if.h>
50 1.1 jmcneill #include <dev/audiovar.h>
51 1.1 jmcneill #include <dev/auconv.h>
52 1.22 jmcneill #include <dev/auvolconv.h>
53 1.1 jmcneill
54 1.2 jmcneill #include <dev/pad/padvar.h>
55 1.2 jmcneill
56 1.1 jmcneill #define PADUNIT(x) minor(x)
57 1.1 jmcneill
58 1.1 jmcneill extern struct cfdriver pad_cd;
59 1.1 jmcneill
60 1.1 jmcneill typedef struct pad_block {
61 1.1 jmcneill uint8_t *pb_ptr;
62 1.1 jmcneill int pb_len;
63 1.1 jmcneill } pad_block_t;
64 1.1 jmcneill
65 1.2 jmcneill enum {
66 1.2 jmcneill PAD_OUTPUT_CLASS,
67 1.2 jmcneill PAD_INPUT_CLASS,
68 1.2 jmcneill PAD_OUTPUT_MASTER_VOLUME,
69 1.2 jmcneill PAD_INPUT_DAC_VOLUME,
70 1.2 jmcneill PAD_ENUM_LAST,
71 1.2 jmcneill };
72 1.1 jmcneill
73 1.10 christos static int pad_match(device_t, cfdata_t, void *);
74 1.5 dyoung static void pad_attach(device_t, device_t, void *);
75 1.5 dyoung static int pad_detach(device_t, int);
76 1.5 dyoung static void pad_childdet(device_t, device_t);
77 1.1 jmcneill
78 1.25.2.5 pgoyette static int pad_audio_open(void *, int);
79 1.1 jmcneill static int pad_query_encoding(void *, struct audio_encoding *);
80 1.1 jmcneill static int pad_set_params(void *, int, int,
81 1.1 jmcneill audio_params_t *, audio_params_t *,
82 1.1 jmcneill stream_filter_list_t *, stream_filter_list_t *);
83 1.1 jmcneill static int pad_start_output(void *, void *, int,
84 1.1 jmcneill void (*)(void *), void *);
85 1.1 jmcneill static int pad_start_input(void *, void *, int,
86 1.1 jmcneill void (*)(void *), void *);
87 1.1 jmcneill static int pad_halt_output(void *);
88 1.1 jmcneill static int pad_halt_input(void *);
89 1.1 jmcneill static int pad_getdev(void *, struct audio_device *);
90 1.1 jmcneill static int pad_set_port(void *, mixer_ctrl_t *);
91 1.1 jmcneill static int pad_get_port(void *, mixer_ctrl_t *);
92 1.1 jmcneill static int pad_query_devinfo(void *, mixer_devinfo_t *);
93 1.1 jmcneill static int pad_get_props(void *);
94 1.1 jmcneill static int pad_round_blocksize(void *, int, int, const audio_params_t *);
95 1.17 jmcneill static void pad_get_locks(void *, kmutex_t **, kmutex_t **);
96 1.1 jmcneill
97 1.22 jmcneill static stream_filter_t *pad_swvol_filter_le(struct audio_softc *,
98 1.22 jmcneill const audio_params_t *, const audio_params_t *);
99 1.22 jmcneill static stream_filter_t *pad_swvol_filter_be(struct audio_softc *,
100 1.22 jmcneill const audio_params_t *, const audio_params_t *);
101 1.22 jmcneill static void pad_swvol_dtor(stream_filter_t *);
102 1.22 jmcneill
103 1.1 jmcneill static const struct audio_hw_if pad_hw_if = {
104 1.25.2.5 pgoyette .open = pad_audio_open,
105 1.1 jmcneill .query_encoding = pad_query_encoding,
106 1.1 jmcneill .set_params = pad_set_params,
107 1.1 jmcneill .start_output = pad_start_output,
108 1.1 jmcneill .start_input = pad_start_input,
109 1.1 jmcneill .halt_output = pad_halt_output,
110 1.1 jmcneill .halt_input = pad_halt_input,
111 1.1 jmcneill .getdev = pad_getdev,
112 1.1 jmcneill .set_port = pad_set_port,
113 1.1 jmcneill .get_port = pad_get_port,
114 1.1 jmcneill .query_devinfo = pad_query_devinfo,
115 1.1 jmcneill .get_props = pad_get_props,
116 1.1 jmcneill .round_blocksize = pad_round_blocksize,
117 1.17 jmcneill .get_locks = pad_get_locks,
118 1.1 jmcneill };
119 1.1 jmcneill
120 1.1 jmcneill #define PAD_NFORMATS 1
121 1.1 jmcneill static const struct audio_format pad_formats[PAD_NFORMATS] = {
122 1.1 jmcneill { NULL, AUMODE_PLAY|AUMODE_RECORD, AUDIO_ENCODING_SLINEAR_LE, 16, 16,
123 1.1 jmcneill 2, AUFMT_STEREO, 1, { 44100 } },
124 1.1 jmcneill };
125 1.1 jmcneill
126 1.1 jmcneill extern void padattach(int);
127 1.1 jmcneill
128 1.25 msaitoh static int pad_add_block(pad_softc_t *, uint8_t *, int);
129 1.25 msaitoh static int pad_get_block(pad_softc_t *, pad_block_t *, int);
130 1.1 jmcneill
131 1.1 jmcneill dev_type_open(pad_open);
132 1.1 jmcneill dev_type_close(pad_close);
133 1.1 jmcneill dev_type_read(pad_read);
134 1.1 jmcneill
135 1.1 jmcneill const struct cdevsw pad_cdevsw = {
136 1.25.2.4 pgoyette DEVSW_MODULE_INIT
137 1.1 jmcneill .d_open = pad_open,
138 1.1 jmcneill .d_close = pad_close,
139 1.1 jmcneill .d_read = pad_read,
140 1.1 jmcneill .d_write = nowrite,
141 1.1 jmcneill .d_ioctl = noioctl,
142 1.1 jmcneill .d_stop = nostop,
143 1.1 jmcneill .d_tty = notty,
144 1.1 jmcneill .d_poll = nopoll,
145 1.1 jmcneill .d_mmap = nommap,
146 1.1 jmcneill .d_kqfilter = nokqfilter,
147 1.21 dholland .d_discard = nodiscard,
148 1.17 jmcneill .d_flag = D_OTHER | D_MPSAFE,
149 1.1 jmcneill };
150 1.1 jmcneill
151 1.10 christos CFATTACH_DECL2_NEW(pad, sizeof(pad_softc_t), pad_match, pad_attach, pad_detach,
152 1.5 dyoung NULL, NULL, pad_childdet);
153 1.1 jmcneill
154 1.1 jmcneill void
155 1.1 jmcneill padattach(int n)
156 1.1 jmcneill {
157 1.1 jmcneill int i, err;
158 1.10 christos cfdata_t cf;
159 1.1 jmcneill
160 1.11 ad aprint_debug("pad: requested %d units\n", n);
161 1.1 jmcneill
162 1.1 jmcneill err = config_cfattach_attach(pad_cd.cd_name, &pad_ca);
163 1.1 jmcneill if (err) {
164 1.1 jmcneill aprint_error("%s: couldn't register cfattach: %d\n",
165 1.1 jmcneill pad_cd.cd_name, err);
166 1.1 jmcneill config_cfdriver_detach(&pad_cd);
167 1.1 jmcneill return;
168 1.1 jmcneill }
169 1.1 jmcneill
170 1.1 jmcneill for (i = 0; i < n; i++) {
171 1.17 jmcneill cf = kmem_alloc(sizeof(struct cfdata), KM_SLEEP);
172 1.1 jmcneill if (cf == NULL) {
173 1.1 jmcneill aprint_error("%s: couldn't allocate cfdata\n",
174 1.1 jmcneill pad_cd.cd_name);
175 1.1 jmcneill continue;
176 1.1 jmcneill }
177 1.1 jmcneill cf->cf_name = pad_cd.cd_name;
178 1.1 jmcneill cf->cf_atname = pad_cd.cd_name;
179 1.1 jmcneill cf->cf_unit = i;
180 1.1 jmcneill cf->cf_fstate = FSTATE_STAR;
181 1.1 jmcneill
182 1.1 jmcneill (void)config_attach_pseudo(cf);
183 1.1 jmcneill }
184 1.1 jmcneill
185 1.1 jmcneill return;
186 1.1 jmcneill }
187 1.1 jmcneill
188 1.1 jmcneill static int
189 1.1 jmcneill pad_add_block(pad_softc_t *sc, uint8_t *blk, int blksize)
190 1.1 jmcneill {
191 1.1 jmcneill int l;
192 1.1 jmcneill
193 1.16 jmcneill if (sc->sc_open == 0)
194 1.16 jmcneill return EIO;
195 1.16 jmcneill
196 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
197 1.17 jmcneill
198 1.1 jmcneill if (sc->sc_buflen + blksize > PAD_BUFSIZE)
199 1.1 jmcneill return ENOBUFS;
200 1.1 jmcneill
201 1.1 jmcneill if (sc->sc_wpos + blksize <= PAD_BUFSIZE)
202 1.1 jmcneill memcpy(sc->sc_audiobuf + sc->sc_wpos, blk, blksize);
203 1.1 jmcneill else {
204 1.1 jmcneill l = PAD_BUFSIZE - sc->sc_wpos;
205 1.1 jmcneill memcpy(sc->sc_audiobuf + sc->sc_wpos, blk, l);
206 1.1 jmcneill memcpy(sc->sc_audiobuf, blk + l, blksize - l);
207 1.1 jmcneill }
208 1.1 jmcneill
209 1.1 jmcneill sc->sc_wpos += blksize;
210 1.1 jmcneill if (sc->sc_wpos > PAD_BUFSIZE)
211 1.1 jmcneill sc->sc_wpos -= PAD_BUFSIZE;
212 1.1 jmcneill
213 1.1 jmcneill sc->sc_buflen += blksize;
214 1.1 jmcneill
215 1.1 jmcneill return 0;
216 1.1 jmcneill }
217 1.1 jmcneill
218 1.1 jmcneill static int
219 1.1 jmcneill pad_get_block(pad_softc_t *sc, pad_block_t *pb, int blksize)
220 1.1 jmcneill {
221 1.1 jmcneill int l;
222 1.1 jmcneill
223 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
224 1.1 jmcneill KASSERT(pb != NULL);
225 1.1 jmcneill
226 1.1 jmcneill if (sc->sc_buflen < blksize)
227 1.1 jmcneill return ERESTART;
228 1.1 jmcneill
229 1.1 jmcneill pb->pb_ptr = (sc->sc_audiobuf + sc->sc_rpos);
230 1.1 jmcneill if (sc->sc_rpos + blksize < PAD_BUFSIZE) {
231 1.1 jmcneill pb->pb_len = blksize;
232 1.1 jmcneill sc->sc_rpos += blksize;
233 1.1 jmcneill } else {
234 1.1 jmcneill l = PAD_BUFSIZE - sc->sc_rpos;
235 1.1 jmcneill pb->pb_len = l;
236 1.1 jmcneill sc->sc_rpos = 0;
237 1.1 jmcneill }
238 1.1 jmcneill sc->sc_buflen -= pb->pb_len;
239 1.1 jmcneill
240 1.1 jmcneill return 0;
241 1.1 jmcneill }
242 1.1 jmcneill
243 1.1 jmcneill static int
244 1.10 christos pad_match(device_t parent, cfdata_t data, void *opaque)
245 1.1 jmcneill {
246 1.17 jmcneill
247 1.1 jmcneill return 1;
248 1.1 jmcneill }
249 1.1 jmcneill
250 1.1 jmcneill static void
251 1.5 dyoung pad_childdet(device_t self, device_t child)
252 1.1 jmcneill {
253 1.5 dyoung pad_softc_t *sc = device_private(self);
254 1.5 dyoung
255 1.5 dyoung sc->sc_audiodev = NULL;
256 1.5 dyoung }
257 1.1 jmcneill
258 1.5 dyoung static void
259 1.5 dyoung pad_attach(device_t parent, device_t self, void *opaque)
260 1.5 dyoung {
261 1.5 dyoung pad_softc_t *sc = device_private(self);
262 1.1 jmcneill
263 1.1 jmcneill aprint_normal_dev(self, "outputs: 44100Hz, 16-bit, stereo\n");
264 1.1 jmcneill
265 1.10 christos sc->sc_dev = self;
266 1.1 jmcneill sc->sc_open = 0;
267 1.1 jmcneill if (auconv_create_encodings(pad_formats, PAD_NFORMATS,
268 1.1 jmcneill &sc->sc_encodings) != 0) {
269 1.1 jmcneill aprint_error_dev(self, "couldn't create encodings\n");
270 1.1 jmcneill return;
271 1.1 jmcneill }
272 1.1 jmcneill
273 1.1 jmcneill cv_init(&sc->sc_condvar, device_xname(self));
274 1.17 jmcneill mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
275 1.17 jmcneill mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_NONE);
276 1.1 jmcneill
277 1.2 jmcneill sc->sc_swvol = 255;
278 1.1 jmcneill sc->sc_buflen = 0;
279 1.1 jmcneill sc->sc_rpos = sc->sc_wpos = 0;
280 1.10 christos sc->sc_audiodev = (void *)audio_attach_mi(&pad_hw_if, sc, sc->sc_dev);
281 1.1 jmcneill
282 1.4 jmcneill if (!pmf_device_register(self, NULL, NULL))
283 1.4 jmcneill aprint_error_dev(self, "couldn't establish power handler\n");
284 1.4 jmcneill
285 1.1 jmcneill return;
286 1.1 jmcneill }
287 1.1 jmcneill
288 1.5 dyoung static int
289 1.5 dyoung pad_detach(device_t self, int flags)
290 1.5 dyoung {
291 1.5 dyoung pad_softc_t *sc = device_private(self);
292 1.5 dyoung int cmaj, mn, rc;
293 1.5 dyoung
294 1.5 dyoung cmaj = cdevsw_lookup_major(&pad_cdevsw);
295 1.5 dyoung mn = device_unit(self);
296 1.5 dyoung vdevgone(cmaj, mn, mn, VCHR);
297 1.5 dyoung
298 1.5 dyoung if ((rc = config_detach_children(self, flags)) != 0)
299 1.5 dyoung return rc;
300 1.5 dyoung
301 1.5 dyoung pmf_device_deregister(self);
302 1.5 dyoung
303 1.17 jmcneill mutex_destroy(&sc->sc_lock);
304 1.17 jmcneill mutex_destroy(&sc->sc_intr_lock);
305 1.5 dyoung cv_destroy(&sc->sc_condvar);
306 1.5 dyoung
307 1.5 dyoung auconv_delete_encodings(sc->sc_encodings);
308 1.5 dyoung
309 1.5 dyoung return 0;
310 1.5 dyoung }
311 1.5 dyoung
312 1.1 jmcneill int
313 1.1 jmcneill pad_open(dev_t dev, int flags, int fmt, struct lwp *l)
314 1.1 jmcneill {
315 1.1 jmcneill pad_softc_t *sc;
316 1.1 jmcneill
317 1.8 tsutsui sc = device_lookup_private(&pad_cd, PADUNIT(dev));
318 1.1 jmcneill if (sc == NULL)
319 1.12 dyoung return ENXIO;
320 1.1 jmcneill
321 1.17 jmcneill if (atomic_swap_uint(&sc->sc_open, 1) != 0) {
322 1.1 jmcneill return EBUSY;
323 1.1 jmcneill }
324 1.24 nat
325 1.24 nat getmicrotime(&sc->sc_last);
326 1.1 jmcneill
327 1.1 jmcneill return 0;
328 1.1 jmcneill }
329 1.1 jmcneill
330 1.1 jmcneill int
331 1.1 jmcneill pad_close(dev_t dev, int flags, int fmt, struct lwp *l)
332 1.1 jmcneill {
333 1.1 jmcneill pad_softc_t *sc;
334 1.1 jmcneill
335 1.8 tsutsui sc = device_lookup_private(&pad_cd, PADUNIT(dev));
336 1.1 jmcneill if (sc == NULL)
337 1.12 dyoung return ENXIO;
338 1.1 jmcneill
339 1.1 jmcneill KASSERT(sc->sc_open > 0);
340 1.17 jmcneill sc->sc_open = 0;
341 1.1 jmcneill
342 1.1 jmcneill return 0;
343 1.1 jmcneill }
344 1.1 jmcneill
345 1.24 nat #define PAD_BYTES_PER_SEC (44100 * sizeof(int16_t) * 2)
346 1.25.2.6 pgoyette #define TIMENEXTREAD (PAD_BLKSIZE * 1000 / PAD_BYTES_PER_SEC)
347 1.24 nat
348 1.1 jmcneill int
349 1.1 jmcneill pad_read(dev_t dev, struct uio *uio, int flags)
350 1.1 jmcneill {
351 1.24 nat struct timeval now;
352 1.24 nat uint64_t nowusec, lastusec;
353 1.1 jmcneill pad_softc_t *sc;
354 1.1 jmcneill pad_block_t pb;
355 1.1 jmcneill void (*intr)(void *);
356 1.1 jmcneill void *intrarg;
357 1.24 nat int err, wait_ticks;
358 1.1 jmcneill
359 1.8 tsutsui sc = device_lookup_private(&pad_cd, PADUNIT(dev));
360 1.1 jmcneill if (sc == NULL)
361 1.12 dyoung return ENXIO;
362 1.1 jmcneill
363 1.1 jmcneill err = 0;
364 1.1 jmcneill
365 1.1 jmcneill while (uio->uio_resid > 0 && !err) {
366 1.25.2.6 pgoyette mutex_enter(&sc->sc_lock);
367 1.25.2.6 pgoyette intr = sc->sc_intr;
368 1.25.2.6 pgoyette intrarg = sc->sc_intrarg;
369 1.25.2.6 pgoyette
370 1.24 nat getmicrotime(&now);
371 1.24 nat nowusec = (now.tv_sec * 1000000) + now.tv_usec;
372 1.24 nat lastusec = (sc->sc_last.tv_sec * 1000000) +
373 1.24 nat sc->sc_last.tv_usec;
374 1.25.2.6 pgoyette if (lastusec + TIMENEXTREAD > nowusec) {
375 1.24 nat wait_ticks = (hz * ((lastusec + TIMENEXTREAD) -
376 1.24 nat nowusec)) / 1000000;
377 1.24 nat if (wait_ticks > 0) {
378 1.24 nat kpause("padwait", TRUE, wait_ticks,
379 1.25.2.6 pgoyette &sc->sc_lock);
380 1.24 nat }
381 1.25.2.6 pgoyette }
382 1.25.2.6 pgoyette sc->sc_last.tv_sec =
383 1.25.2.6 pgoyette (lastusec + TIMENEXTREAD) / 1000000;
384 1.25.2.6 pgoyette sc->sc_last.tv_usec =
385 1.25.2.6 pgoyette (lastusec + TIMENEXTREAD) % 1000000;
386 1.1 jmcneill err = pad_get_block(sc, &pb, min(uio->uio_resid, PAD_BLKSIZE));
387 1.17 jmcneill if (!err) {
388 1.17 jmcneill mutex_exit(&sc->sc_lock);
389 1.1 jmcneill err = uiomove(pb.pb_ptr, pb.pb_len, uio);
390 1.17 jmcneill continue;
391 1.17 jmcneill }
392 1.1 jmcneill
393 1.17 jmcneill if (intr) {
394 1.17 jmcneill mutex_enter(&sc->sc_intr_lock);
395 1.24 nat kpreempt_disable();
396 1.17 jmcneill (*intr)(intrarg);
397 1.24 nat kpreempt_enable();
398 1.17 jmcneill mutex_exit(&sc->sc_intr_lock);
399 1.1 jmcneill intr = sc->sc_intr;
400 1.1 jmcneill intrarg = sc->sc_intrarg;
401 1.1 jmcneill err = 0;
402 1.25.2.6 pgoyette mutex_exit(&sc->sc_lock);
403 1.17 jmcneill continue;
404 1.17 jmcneill }
405 1.17 jmcneill err = cv_wait_sig(&sc->sc_condvar, &sc->sc_lock);
406 1.25.2.6 pgoyette if (err != 0) {
407 1.25.2.6 pgoyette mutex_exit(&sc->sc_lock);
408 1.24 nat break;
409 1.25.2.6 pgoyette }
410 1.24 nat
411 1.25.2.6 pgoyette mutex_exit(&sc->sc_lock);
412 1.1 jmcneill }
413 1.1 jmcneill
414 1.1 jmcneill return err;
415 1.1 jmcneill }
416 1.1 jmcneill
417 1.1 jmcneill static int
418 1.25.2.5 pgoyette pad_audio_open(void *opaque, int flags)
419 1.25.2.5 pgoyette {
420 1.25.2.5 pgoyette pad_softc_t *sc;
421 1.25.2.5 pgoyette sc = opaque;
422 1.25.2.5 pgoyette
423 1.25.2.5 pgoyette if (sc->sc_open == 0)
424 1.25.2.5 pgoyette return EIO;
425 1.25.2.5 pgoyette
426 1.25.2.5 pgoyette getmicrotime(&sc->sc_last);
427 1.25.2.5 pgoyette return 0;
428 1.25.2.5 pgoyette }
429 1.25.2.5 pgoyette
430 1.25.2.5 pgoyette static int
431 1.1 jmcneill pad_query_encoding(void *opaque, struct audio_encoding *ae)
432 1.1 jmcneill {
433 1.1 jmcneill pad_softc_t *sc;
434 1.1 jmcneill
435 1.1 jmcneill sc = (pad_softc_t *)opaque;
436 1.1 jmcneill
437 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
438 1.17 jmcneill
439 1.1 jmcneill return auconv_query_encoding(sc->sc_encodings, ae);
440 1.1 jmcneill }
441 1.1 jmcneill
442 1.1 jmcneill static int
443 1.1 jmcneill pad_set_params(void *opaque, int setmode, int usemode,
444 1.1 jmcneill audio_params_t *play, audio_params_t *rec,
445 1.1 jmcneill stream_filter_list_t *pfil, stream_filter_list_t *rfil)
446 1.1 jmcneill {
447 1.20 christos pad_softc_t *sc __diagused;
448 1.1 jmcneill
449 1.1 jmcneill sc = (pad_softc_t *)opaque;
450 1.1 jmcneill
451 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
452 1.17 jmcneill
453 1.1 jmcneill if (auconv_set_converter(pad_formats, PAD_NFORMATS, AUMODE_PLAY,
454 1.1 jmcneill play, true, pfil) < 0)
455 1.1 jmcneill return EINVAL;
456 1.1 jmcneill if (auconv_set_converter(pad_formats, PAD_NFORMATS, AUMODE_RECORD,
457 1.1 jmcneill rec, true, rfil) < 0)
458 1.1 jmcneill return EINVAL;
459 1.1 jmcneill
460 1.2 jmcneill if (pfil->req_size > 0)
461 1.2 jmcneill play = &pfil->filters[0].param;
462 1.2 jmcneill switch (play->encoding) {
463 1.2 jmcneill case AUDIO_ENCODING_SLINEAR_LE:
464 1.2 jmcneill if (play->precision == 16 && play->validbits == 16)
465 1.22 jmcneill pfil->prepend(pfil, pad_swvol_filter_le, play);
466 1.2 jmcneill break;
467 1.2 jmcneill case AUDIO_ENCODING_SLINEAR_BE:
468 1.2 jmcneill if (play->precision == 16 && play->validbits == 16)
469 1.22 jmcneill pfil->prepend(pfil, pad_swvol_filter_be, play);
470 1.2 jmcneill break;
471 1.2 jmcneill default:
472 1.2 jmcneill break;
473 1.2 jmcneill }
474 1.2 jmcneill
475 1.1 jmcneill return 0;
476 1.1 jmcneill }
477 1.1 jmcneill
478 1.1 jmcneill static int
479 1.1 jmcneill pad_start_output(void *opaque, void *block, int blksize,
480 1.1 jmcneill void (*intr)(void *), void *intrarg)
481 1.1 jmcneill {
482 1.1 jmcneill pad_softc_t *sc;
483 1.1 jmcneill int err;
484 1.1 jmcneill
485 1.1 jmcneill sc = (pad_softc_t *)opaque;
486 1.1 jmcneill
487 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
488 1.25.2.5 pgoyette if (!sc->sc_open)
489 1.25.2.5 pgoyette return EIO;
490 1.1 jmcneill
491 1.1 jmcneill sc->sc_intr = intr;
492 1.1 jmcneill sc->sc_intrarg = intrarg;
493 1.1 jmcneill sc->sc_blksize = blksize;
494 1.1 jmcneill
495 1.1 jmcneill err = pad_add_block(sc, block, blksize);
496 1.1 jmcneill
497 1.17 jmcneill cv_broadcast(&sc->sc_condvar);
498 1.1 jmcneill
499 1.1 jmcneill return err;
500 1.1 jmcneill }
501 1.1 jmcneill
502 1.1 jmcneill static int
503 1.1 jmcneill pad_start_input(void *opaque, void *block, int blksize,
504 1.1 jmcneill void (*intr)(void *), void *intrarg)
505 1.1 jmcneill {
506 1.20 christos pad_softc_t *sc __diagused;
507 1.17 jmcneill
508 1.17 jmcneill sc = (pad_softc_t *)opaque;
509 1.17 jmcneill
510 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
511 1.17 jmcneill
512 1.17 jmcneill return EOPNOTSUPP;
513 1.1 jmcneill }
514 1.1 jmcneill
515 1.1 jmcneill static int
516 1.1 jmcneill pad_halt_output(void *opaque)
517 1.1 jmcneill {
518 1.1 jmcneill pad_softc_t *sc;
519 1.1 jmcneill
520 1.1 jmcneill sc = (pad_softc_t *)opaque;
521 1.17 jmcneill
522 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
523 1.17 jmcneill
524 1.1 jmcneill sc->sc_intr = NULL;
525 1.1 jmcneill sc->sc_intrarg = NULL;
526 1.1 jmcneill sc->sc_buflen = 0;
527 1.1 jmcneill sc->sc_rpos = sc->sc_wpos = 0;
528 1.1 jmcneill
529 1.1 jmcneill return 0;
530 1.1 jmcneill }
531 1.1 jmcneill
532 1.1 jmcneill static int
533 1.1 jmcneill pad_halt_input(void *opaque)
534 1.1 jmcneill {
535 1.20 christos pad_softc_t *sc __diagused;
536 1.17 jmcneill
537 1.17 jmcneill sc = (pad_softc_t *)opaque;
538 1.17 jmcneill
539 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
540 1.17 jmcneill
541 1.1 jmcneill return 0;
542 1.1 jmcneill }
543 1.1 jmcneill
544 1.1 jmcneill static int
545 1.1 jmcneill pad_getdev(void *opaque, struct audio_device *ret)
546 1.1 jmcneill {
547 1.16 jmcneill strlcpy(ret->name, "Virtual Audio", sizeof(ret->name));
548 1.16 jmcneill strlcpy(ret->version, osrelease, sizeof(ret->version));
549 1.16 jmcneill strlcpy(ret->config, "pad", sizeof(ret->config));
550 1.1 jmcneill
551 1.1 jmcneill return 0;
552 1.1 jmcneill }
553 1.1 jmcneill
554 1.1 jmcneill static int
555 1.1 jmcneill pad_set_port(void *opaque, mixer_ctrl_t *mc)
556 1.1 jmcneill {
557 1.2 jmcneill pad_softc_t *sc;
558 1.2 jmcneill
559 1.2 jmcneill sc = (pad_softc_t *)opaque;
560 1.2 jmcneill
561 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
562 1.17 jmcneill
563 1.2 jmcneill switch (mc->dev) {
564 1.2 jmcneill case PAD_OUTPUT_MASTER_VOLUME:
565 1.2 jmcneill case PAD_INPUT_DAC_VOLUME:
566 1.2 jmcneill sc->sc_swvol = mc->un.value.level[AUDIO_MIXER_LEVEL_MONO];
567 1.2 jmcneill return 0;
568 1.2 jmcneill }
569 1.2 jmcneill
570 1.1 jmcneill return ENXIO;
571 1.1 jmcneill }
572 1.1 jmcneill
573 1.1 jmcneill static int
574 1.1 jmcneill pad_get_port(void *opaque, mixer_ctrl_t *mc)
575 1.1 jmcneill {
576 1.2 jmcneill pad_softc_t *sc;
577 1.2 jmcneill
578 1.2 jmcneill sc = (pad_softc_t *)opaque;
579 1.2 jmcneill
580 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
581 1.17 jmcneill
582 1.2 jmcneill switch (mc->dev) {
583 1.2 jmcneill case PAD_OUTPUT_MASTER_VOLUME:
584 1.2 jmcneill case PAD_INPUT_DAC_VOLUME:
585 1.2 jmcneill mc->un.value.level[AUDIO_MIXER_LEVEL_MONO] = sc->sc_swvol;
586 1.2 jmcneill return 0;
587 1.2 jmcneill }
588 1.2 jmcneill
589 1.1 jmcneill return ENXIO;
590 1.1 jmcneill }
591 1.1 jmcneill
592 1.1 jmcneill static int
593 1.1 jmcneill pad_query_devinfo(void *opaque, mixer_devinfo_t *di)
594 1.1 jmcneill {
595 1.20 christos pad_softc_t *sc __diagused;
596 1.2 jmcneill
597 1.2 jmcneill sc = (pad_softc_t *)opaque;
598 1.2 jmcneill
599 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
600 1.17 jmcneill
601 1.2 jmcneill switch (di->index) {
602 1.2 jmcneill case PAD_OUTPUT_CLASS:
603 1.2 jmcneill di->mixer_class = PAD_OUTPUT_CLASS;
604 1.2 jmcneill strcpy(di->label.name, AudioCoutputs);
605 1.2 jmcneill di->type = AUDIO_MIXER_CLASS;
606 1.2 jmcneill di->next = di->prev = AUDIO_MIXER_LAST;
607 1.2 jmcneill return 0;
608 1.2 jmcneill case PAD_INPUT_CLASS:
609 1.2 jmcneill di->mixer_class = PAD_INPUT_CLASS;
610 1.2 jmcneill strcpy(di->label.name, AudioCinputs);
611 1.2 jmcneill di->type = AUDIO_MIXER_CLASS;
612 1.2 jmcneill di->next = di->prev = AUDIO_MIXER_LAST;
613 1.2 jmcneill return 0;
614 1.2 jmcneill case PAD_OUTPUT_MASTER_VOLUME:
615 1.2 jmcneill di->mixer_class = PAD_OUTPUT_CLASS;
616 1.2 jmcneill strcpy(di->label.name, AudioNmaster);
617 1.2 jmcneill di->type = AUDIO_MIXER_VALUE;
618 1.2 jmcneill di->next = di->prev = AUDIO_MIXER_LAST;
619 1.2 jmcneill di->un.v.num_channels = 1;
620 1.2 jmcneill strcpy(di->un.v.units.name, AudioNvolume);
621 1.2 jmcneill return 0;
622 1.2 jmcneill case PAD_INPUT_DAC_VOLUME:
623 1.2 jmcneill di->mixer_class = PAD_INPUT_CLASS;
624 1.2 jmcneill strcpy(di->label.name, AudioNdac);
625 1.2 jmcneill di->type = AUDIO_MIXER_VALUE;
626 1.2 jmcneill di->next = di->prev = AUDIO_MIXER_LAST;
627 1.2 jmcneill di->un.v.num_channels = 1;
628 1.2 jmcneill strcpy(di->un.v.units.name, AudioNvolume);
629 1.2 jmcneill return 0;
630 1.2 jmcneill }
631 1.2 jmcneill
632 1.1 jmcneill return ENXIO;
633 1.1 jmcneill }
634 1.1 jmcneill
635 1.1 jmcneill static int
636 1.1 jmcneill pad_get_props(void *opaque)
637 1.1 jmcneill {
638 1.20 christos pad_softc_t *sc __diagused;
639 1.17 jmcneill
640 1.17 jmcneill sc = (pad_softc_t *)opaque;
641 1.17 jmcneill
642 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
643 1.17 jmcneill
644 1.1 jmcneill return 0;
645 1.1 jmcneill }
646 1.1 jmcneill
647 1.1 jmcneill static int
648 1.1 jmcneill pad_round_blocksize(void *opaque, int blksize, int mode,
649 1.1 jmcneill const audio_params_t *p)
650 1.1 jmcneill {
651 1.20 christos pad_softc_t *sc __diagused;
652 1.17 jmcneill
653 1.17 jmcneill sc = (pad_softc_t *)opaque;
654 1.17 jmcneill KASSERT(mutex_owned(&sc->sc_lock));
655 1.17 jmcneill
656 1.1 jmcneill return PAD_BLKSIZE;
657 1.1 jmcneill }
658 1.13 ahoka
659 1.17 jmcneill static void
660 1.17 jmcneill pad_get_locks(void *opaque, kmutex_t **intr, kmutex_t **thread)
661 1.17 jmcneill {
662 1.17 jmcneill pad_softc_t *sc;
663 1.17 jmcneill
664 1.17 jmcneill sc = (pad_softc_t *)opaque;
665 1.17 jmcneill
666 1.17 jmcneill *intr = &sc->sc_intr_lock;
667 1.17 jmcneill *thread = &sc->sc_lock;
668 1.17 jmcneill }
669 1.17 jmcneill
670 1.22 jmcneill static stream_filter_t *
671 1.22 jmcneill pad_swvol_filter_le(struct audio_softc *asc,
672 1.22 jmcneill const audio_params_t *from, const audio_params_t *to)
673 1.22 jmcneill {
674 1.22 jmcneill auvolconv_filter_t *this;
675 1.22 jmcneill device_t dev = audio_get_device(asc);
676 1.22 jmcneill struct pad_softc *sc = device_private(dev);
677 1.22 jmcneill
678 1.22 jmcneill this = kmem_alloc(sizeof(auvolconv_filter_t), KM_SLEEP);
679 1.22 jmcneill this->base.base.fetch_to = auvolconv_slinear16_le_fetch_to;
680 1.22 jmcneill this->base.dtor = pad_swvol_dtor;
681 1.22 jmcneill this->base.set_fetcher = stream_filter_set_fetcher;
682 1.22 jmcneill this->base.set_inputbuffer = stream_filter_set_inputbuffer;
683 1.22 jmcneill this->vol = &sc->sc_swvol;
684 1.22 jmcneill
685 1.22 jmcneill return (stream_filter_t *)this;
686 1.22 jmcneill }
687 1.22 jmcneill
688 1.22 jmcneill static stream_filter_t *
689 1.22 jmcneill pad_swvol_filter_be(struct audio_softc *asc,
690 1.22 jmcneill const audio_params_t *from, const audio_params_t *to)
691 1.22 jmcneill {
692 1.22 jmcneill auvolconv_filter_t *this;
693 1.22 jmcneill device_t dev = audio_get_device(asc);
694 1.22 jmcneill struct pad_softc *sc = device_private(dev);
695 1.22 jmcneill
696 1.22 jmcneill this = kmem_alloc(sizeof(auvolconv_filter_t), KM_SLEEP);
697 1.22 jmcneill this->base.base.fetch_to = auvolconv_slinear16_be_fetch_to;
698 1.22 jmcneill this->base.dtor = pad_swvol_dtor;
699 1.22 jmcneill this->base.set_fetcher = stream_filter_set_fetcher;
700 1.22 jmcneill this->base.set_inputbuffer = stream_filter_set_inputbuffer;
701 1.22 jmcneill this->vol = &sc->sc_swvol;
702 1.22 jmcneill
703 1.22 jmcneill return (stream_filter_t *)this;
704 1.22 jmcneill }
705 1.22 jmcneill
706 1.22 jmcneill static void
707 1.22 jmcneill pad_swvol_dtor(stream_filter_t *this)
708 1.22 jmcneill {
709 1.22 jmcneill if (this)
710 1.22 jmcneill kmem_free(this, sizeof(auvolconv_filter_t));
711 1.22 jmcneill }
712 1.22 jmcneill
713 1.13 ahoka #ifdef _MODULE
714 1.13 ahoka
715 1.13 ahoka MODULE(MODULE_CLASS_DRIVER, pad, NULL);
716 1.13 ahoka
717 1.13 ahoka static const struct cfiattrdata audiobuscf_iattrdata = {
718 1.13 ahoka "audiobus", 0, { { NULL, NULL, 0 }, }
719 1.13 ahoka };
720 1.13 ahoka static const struct cfiattrdata * const pad_attrs[] = {
721 1.13 ahoka &audiobuscf_iattrdata, NULL
722 1.13 ahoka };
723 1.13 ahoka
724 1.13 ahoka CFDRIVER_DECL(pad, DV_DULL, pad_attrs);
725 1.13 ahoka extern struct cfattach pad_ca;
726 1.13 ahoka static int padloc[] = { -1, -1 };
727 1.13 ahoka
728 1.13 ahoka static struct cfdata pad_cfdata[] = {
729 1.13 ahoka {
730 1.13 ahoka .cf_name = "pad",
731 1.13 ahoka .cf_atname = "pad",
732 1.13 ahoka .cf_unit = 0,
733 1.13 ahoka .cf_fstate = FSTATE_STAR,
734 1.13 ahoka .cf_loc = padloc,
735 1.13 ahoka .cf_flags = 0,
736 1.13 ahoka .cf_pspec = NULL,
737 1.13 ahoka },
738 1.14 pooka { NULL, NULL, 0, 0, NULL, 0, NULL }
739 1.13 ahoka };
740 1.13 ahoka
741 1.13 ahoka static int
742 1.13 ahoka pad_modcmd(modcmd_t cmd, void *arg)
743 1.13 ahoka {
744 1.13 ahoka devmajor_t cmajor = NODEVMAJOR, bmajor = NODEVMAJOR;
745 1.19 agc int error;
746 1.13 ahoka
747 1.13 ahoka switch (cmd) {
748 1.13 ahoka case MODULE_CMD_INIT:
749 1.13 ahoka error = config_cfdriver_attach(&pad_cd);
750 1.13 ahoka if (error) {
751 1.13 ahoka return error;
752 1.13 ahoka }
753 1.13 ahoka
754 1.13 ahoka error = config_cfattach_attach(pad_cd.cd_name, &pad_ca);
755 1.13 ahoka if (error) {
756 1.13 ahoka config_cfdriver_detach(&pad_cd);
757 1.13 ahoka aprint_error("%s: unable to register cfattach\n",
758 1.13 ahoka pad_cd.cd_name);
759 1.13 ahoka
760 1.13 ahoka return error;
761 1.13 ahoka }
762 1.13 ahoka
763 1.13 ahoka error = config_cfdata_attach(pad_cfdata, 1);
764 1.13 ahoka if (error) {
765 1.13 ahoka config_cfattach_detach(pad_cd.cd_name, &pad_ca);
766 1.13 ahoka config_cfdriver_detach(&pad_cd);
767 1.13 ahoka aprint_error("%s: unable to register cfdata\n",
768 1.13 ahoka pad_cd.cd_name);
769 1.13 ahoka
770 1.13 ahoka return error;
771 1.13 ahoka }
772 1.13 ahoka
773 1.25 msaitoh error = devsw_attach(pad_cd.cd_name, NULL, &bmajor,
774 1.25 msaitoh &pad_cdevsw, &cmajor);
775 1.13 ahoka if (error) {
776 1.13 ahoka error = config_cfdata_detach(pad_cfdata);
777 1.13 ahoka if (error) {
778 1.13 ahoka return error;
779 1.13 ahoka }
780 1.13 ahoka config_cfattach_detach(pad_cd.cd_name, &pad_ca);
781 1.13 ahoka config_cfdriver_detach(&pad_cd);
782 1.13 ahoka aprint_error("%s: unable to register devsw\n",
783 1.13 ahoka pad_cd.cd_name);
784 1.13 ahoka
785 1.13 ahoka return error;
786 1.13 ahoka }
787 1.13 ahoka
788 1.13 ahoka (void)config_attach_pseudo(pad_cfdata);
789 1.13 ahoka
790 1.13 ahoka return 0;
791 1.13 ahoka case MODULE_CMD_FINI:
792 1.13 ahoka error = config_cfdata_detach(pad_cfdata);
793 1.13 ahoka if (error) {
794 1.13 ahoka return error;
795 1.13 ahoka }
796 1.13 ahoka
797 1.13 ahoka config_cfattach_detach(pad_cd.cd_name, &pad_ca);
798 1.13 ahoka config_cfdriver_detach(&pad_cd);
799 1.13 ahoka devsw_detach(NULL, &pad_cdevsw);
800 1.13 ahoka
801 1.13 ahoka return 0;
802 1.13 ahoka default:
803 1.13 ahoka return ENOTTY;
804 1.13 ahoka }
805 1.13 ahoka }
806 1.13 ahoka
807 1.13 ahoka #endif
808