harmony.c revision 1.6 1 1.6 isaki /* $NetBSD: harmony.c,v 1.6 2019/05/08 13:40:15 isaki Exp $ */
2 1.1 skrll
3 1.1 skrll /* $OpenBSD: harmony.c,v 1.23 2004/02/13 21:28:19 mickey Exp $ */
4 1.1 skrll
5 1.1 skrll /*-
6 1.1 skrll * Copyright (c) 2009 The NetBSD Foundation, Inc.
7 1.1 skrll * All rights reserved.
8 1.1 skrll *
9 1.1 skrll * This code is derived from software contributed to The NetBSD Foundation
10 1.1 skrll * by Matt Fleming.
11 1.1 skrll *
12 1.1 skrll * Redistribution and use in source and binary forms, with or without
13 1.1 skrll * modification, are permitted provided that the following conditions
14 1.1 skrll * are met:
15 1.1 skrll * 1. Redistributions of source code must retain the above copyright
16 1.1 skrll * notice, this list of conditions and the following disclaimer.
17 1.1 skrll * 2. Redistributions in binary form must reproduce the above copyright
18 1.1 skrll * notice, this list of conditions and the following disclaimer in the
19 1.1 skrll * documentation and/or other materials provided with the distribution.
20 1.1 skrll *
21 1.1 skrll * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
22 1.1 skrll * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
23 1.1 skrll * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
24 1.1 skrll * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
25 1.1 skrll * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
26 1.1 skrll * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
27 1.1 skrll * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
28 1.1 skrll * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
29 1.1 skrll * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30 1.1 skrll * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31 1.1 skrll * POSSIBILITY OF SUCH DAMAGE.
32 1.1 skrll */
33 1.1 skrll
34 1.1 skrll /*
35 1.1 skrll * Copyright (c) 2003 Jason L. Wright (jason (at) thought.net)
36 1.1 skrll * All rights reserved.
37 1.1 skrll *
38 1.1 skrll * Redistribution and use in source and binary forms, with or without
39 1.1 skrll * modification, are permitted provided that the following conditions
40 1.1 skrll * are met:
41 1.1 skrll * 1. Redistributions of source code must retain the above copyright
42 1.1 skrll * notice, this list of conditions and the following disclaimer.
43 1.1 skrll * 2. Redistributions in binary form must reproduce the above copyright
44 1.1 skrll * notice, this list of conditions and the following disclaimer in the
45 1.1 skrll * documentation and/or other materials provided with the distribution.
46 1.1 skrll *
47 1.1 skrll * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
48 1.1 skrll * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
49 1.1 skrll * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
50 1.1 skrll * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
51 1.1 skrll * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
52 1.1 skrll * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
53 1.1 skrll * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
54 1.1 skrll * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
55 1.1 skrll * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
56 1.1 skrll * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
57 1.1 skrll * POSSIBILITY OF SUCH DAMAGE.
58 1.1 skrll */
59 1.1 skrll
60 1.1 skrll /*
61 1.1 skrll * Harmony (CS4215/AD1849 LASI) audio interface.
62 1.1 skrll */
63 1.1 skrll
64 1.1 skrll
65 1.1 skrll
66 1.1 skrll #include <sys/param.h>
67 1.1 skrll #include <sys/kernel.h>
68 1.1 skrll #include <sys/systm.h>
69 1.1 skrll #include <sys/errno.h>
70 1.1 skrll #include <sys/ioctl.h>
71 1.1 skrll #include <sys/device.h>
72 1.1 skrll #include <sys/proc.h>
73 1.1 skrll #include <sys/kmem.h>
74 1.1 skrll #include <uvm/uvm_extern.h>
75 1.1 skrll
76 1.3 riastrad #include <sys/rndsource.h>
77 1.1 skrll
78 1.1 skrll #include <sys/audioio.h>
79 1.6 isaki #include <dev/audio/audio_if.h>
80 1.1 skrll
81 1.1 skrll #include <machine/cpu.h>
82 1.1 skrll #include <machine/intr.h>
83 1.1 skrll #include <machine/iomod.h>
84 1.1 skrll #include <machine/autoconf.h>
85 1.1 skrll #include <sys/bus.h>
86 1.1 skrll
87 1.1 skrll #include <hppa/dev/cpudevs.h>
88 1.1 skrll #include <hppa/gsc/gscbusvar.h>
89 1.1 skrll #include <hppa/gsc/harmonyreg.h>
90 1.1 skrll #include <hppa/gsc/harmonyvar.h>
91 1.1 skrll
92 1.1 skrll void harmony_close(void *);
93 1.6 isaki int harmony_query_format(void *, audio_format_query_t *);
94 1.6 isaki int harmony_set_format(void *, int,
95 1.6 isaki const audio_params_t *, const audio_params_t *,
96 1.6 isaki audio_filter_reg_t *, audio_filter_reg_t *);
97 1.1 skrll int harmony_round_blocksize(void *, int, int, const audio_params_t *);
98 1.1 skrll
99 1.1 skrll int harmony_control_wait(struct harmony_softc *);
100 1.1 skrll int harmony_commit_settings(void *);
101 1.1 skrll
102 1.1 skrll int harmony_halt_output(void *);
103 1.1 skrll int harmony_halt_input(void *);
104 1.1 skrll int harmony_getdev(void *, struct audio_device *);
105 1.1 skrll int harmony_set_port(void *, mixer_ctrl_t *);
106 1.1 skrll int harmony_get_port(void *, mixer_ctrl_t *);
107 1.1 skrll int harmony_query_devinfo(void *, mixer_devinfo_t *);
108 1.1 skrll void * harmony_allocm(void *, int, size_t);
109 1.1 skrll void harmony_freem(void *, void *, size_t);
110 1.1 skrll size_t harmony_round_buffersize(void *, int, size_t);
111 1.1 skrll int harmony_get_props(void *);
112 1.1 skrll int harmony_trigger_output(void *, void *, void *, int,
113 1.1 skrll void (*)(void *), void *, const audio_params_t *);
114 1.1 skrll int harmony_trigger_input(void *, void *, void *, int,
115 1.1 skrll void (*)(void *), void *, const audio_params_t *);
116 1.1 skrll void harmony_get_locks(void *, kmutex_t **, kmutex_t **);
117 1.1 skrll
118 1.1 skrll const struct audio_hw_if harmony_sa_hw_if = {
119 1.5 isaki .close = harmony_close,
120 1.6 isaki .query_format = harmony_query_format,
121 1.6 isaki .set_format = harmony_set_format,
122 1.5 isaki .round_blocksize = harmony_round_blocksize,
123 1.5 isaki .commit_settings = harmony_commit_settings,
124 1.5 isaki .halt_output = harmony_halt_output,
125 1.5 isaki .halt_input = harmony_halt_input,
126 1.5 isaki .getdev = harmony_getdev,
127 1.5 isaki .set_port = harmony_set_port,
128 1.5 isaki .get_port = harmony_get_port,
129 1.5 isaki .query_devinfo = harmony_query_devinfo,
130 1.5 isaki .allocm = harmony_allocm,
131 1.5 isaki .freem = harmony_freem,
132 1.5 isaki .round_buffersize = harmony_round_buffersize,
133 1.5 isaki .get_props = harmony_get_props,
134 1.5 isaki .trigger_output = harmony_trigger_output,
135 1.5 isaki .trigger_input = harmony_trigger_input,
136 1.5 isaki .get_locks = harmony_get_locks,
137 1.1 skrll };
138 1.1 skrll
139 1.6 isaki /* The HW actually supports more frequencies, but these looks enough. */
140 1.6 isaki #define HARMONY_FORMAT(enc, prec) \
141 1.6 isaki { \
142 1.6 isaki .mode = AUMODE_PLAY | AUMODE_RECORD, \
143 1.6 isaki .encoding = (enc), \
144 1.6 isaki .validbits = (prec), \
145 1.6 isaki .precision = (prec), \
146 1.6 isaki .channels = 2, \
147 1.6 isaki .channel_mask = AUFMT_STEREO, \
148 1.6 isaki .frequency_type = 4, \
149 1.6 isaki .frequency = { 16000, 32000, 44100, 48000 }, \
150 1.6 isaki }
151 1.6 isaki static struct audio_format harmony_formats[] = {
152 1.6 isaki HARMONY_FORMAT(AUDIO_ENCODING_ULAW, 8),
153 1.6 isaki HARMONY_FORMAT(AUDIO_ENCODING_ALAW, 8),
154 1.6 isaki HARMONY_FORMAT(AUDIO_ENCODING_SLINEAR_BE, 16),
155 1.6 isaki };
156 1.6 isaki #define HARMONY_NFORMATS __arraycount(harmony_formats)
157 1.6 isaki
158 1.1 skrll int harmony_match(device_t, struct cfdata *, void *);
159 1.1 skrll void harmony_attach(device_t, device_t, void *);
160 1.1 skrll
161 1.1 skrll
162 1.1 skrll CFATTACH_DECL_NEW(harmony, sizeof(struct harmony_softc),
163 1.1 skrll harmony_match, harmony_attach, NULL, NULL);
164 1.1 skrll
165 1.1 skrll int harmony_intr(void *);
166 1.1 skrll void harmony_intr_enable(struct harmony_softc *);
167 1.1 skrll void harmony_intr_disable(struct harmony_softc *);
168 1.1 skrll uint32_t harmony_speed_bits(struct harmony_softc *, u_int *);
169 1.1 skrll int harmony_set_gainctl(struct harmony_softc *);
170 1.1 skrll void harmony_reset_codec(struct harmony_softc *);
171 1.1 skrll void harmony_start_cp(struct harmony_softc *, int);
172 1.1 skrll void harmony_start_pp(struct harmony_softc *, int);
173 1.1 skrll void harmony_tick_pb(void *);
174 1.1 skrll void harmony_tick_cp(void *);
175 1.1 skrll void harmony_try_more(struct harmony_softc *, int, int,
176 1.1 skrll struct harmony_channel *);
177 1.1 skrll static void harmony_empty_input(struct harmony_softc *);
178 1.1 skrll static void harmony_empty_output(struct harmony_softc *);
179 1.1 skrll
180 1.1 skrll void harmony_acc_tmo(void *);
181 1.1 skrll #define ADD_CLKALLICA(sc) do { \
182 1.1 skrll (sc)->sc_acc <<= 1; \
183 1.1 skrll (sc)->sc_acc |= READ_REG((sc), HARMONY_DIAG) & DIAG_CO; \
184 1.1 skrll if ((sc)->sc_acc_cnt++ && !((sc)->sc_acc_cnt % 32)) \
185 1.1 skrll rnd_add_uint32(&(sc)->sc_rnd_source, \
186 1.1 skrll (sc)->sc_acc_num ^= (sc)->sc_acc); \
187 1.1 skrll } while(0)
188 1.1 skrll
189 1.1 skrll int
190 1.1 skrll harmony_match(device_t parent, struct cfdata *match, void *aux)
191 1.1 skrll {
192 1.1 skrll struct gsc_attach_args *ga;
193 1.1 skrll
194 1.1 skrll ga = aux;
195 1.1 skrll if (ga->ga_type.iodc_type == HPPA_TYPE_FIO) {
196 1.1 skrll if (ga->ga_type.iodc_sv_model == HPPA_FIO_A1 ||
197 1.1 skrll ga->ga_type.iodc_sv_model == HPPA_FIO_A2NB ||
198 1.1 skrll ga->ga_type.iodc_sv_model == HPPA_FIO_A1NB ||
199 1.1 skrll ga->ga_type.iodc_sv_model == HPPA_FIO_A2)
200 1.1 skrll return 1;
201 1.1 skrll }
202 1.1 skrll return 0;
203 1.1 skrll }
204 1.1 skrll
205 1.1 skrll void
206 1.1 skrll harmony_attach(device_t parent, device_t self, void *aux)
207 1.1 skrll {
208 1.1 skrll struct harmony_softc *sc = device_private(self);
209 1.1 skrll struct gsc_attach_args *ga;
210 1.1 skrll uint8_t rev;
211 1.1 skrll uint32_t cntl;
212 1.1 skrll int i;
213 1.1 skrll
214 1.1 skrll sc->sc_dv = self;
215 1.1 skrll ga = aux;
216 1.1 skrll sc->sc_bt = ga->ga_iot;
217 1.1 skrll sc->sc_dmat = ga->ga_dmatag;
218 1.1 skrll
219 1.1 skrll mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
220 1.1 skrll mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_AUDIO);
221 1.1 skrll
222 1.1 skrll if (bus_space_map(sc->sc_bt, ga->ga_hpa, HARMONY_NREGS, 0,
223 1.1 skrll &sc->sc_bh) != 0) {
224 1.1 skrll aprint_error(": couldn't map registers\n");
225 1.1 skrll return;
226 1.1 skrll }
227 1.1 skrll
228 1.1 skrll cntl = READ_REG(sc, HARMONY_ID);
229 1.1 skrll switch ((cntl & ID_REV_MASK)) {
230 1.1 skrll case ID_REV_TS:
231 1.1 skrll sc->sc_teleshare = 1;
232 1.1 skrll case ID_REV_NOTS:
233 1.1 skrll break;
234 1.1 skrll default:
235 1.1 skrll aprint_error(": unknown id == 0x%02x\n",
236 1.1 skrll (cntl & ID_REV_MASK) >> ID_REV_SHIFT);
237 1.1 skrll bus_space_unmap(sc->sc_bt, sc->sc_bh, HARMONY_NREGS);
238 1.1 skrll return;
239 1.1 skrll }
240 1.1 skrll
241 1.1 skrll if (bus_dmamem_alloc(sc->sc_dmat, sizeof(struct harmony_empty),
242 1.1 skrll PAGE_SIZE, 0, &sc->sc_empty_seg, 1, &sc->sc_empty_rseg,
243 1.1 skrll BUS_DMA_WAITOK) != 0) {
244 1.1 skrll aprint_error(": could not alloc DMA memory\n");
245 1.1 skrll bus_space_unmap(sc->sc_bt, sc->sc_bh, HARMONY_NREGS);
246 1.1 skrll return;
247 1.1 skrll }
248 1.1 skrll if (bus_dmamem_map(sc->sc_dmat, &sc->sc_empty_seg, 1,
249 1.1 skrll sizeof(struct harmony_empty), (void **)&sc->sc_empty_kva,
250 1.1 skrll BUS_DMA_WAITOK) != 0) {
251 1.1 skrll aprint_error(": couldn't map DMA memory\n");
252 1.1 skrll bus_dmamem_free(sc->sc_dmat, &sc->sc_empty_seg,
253 1.1 skrll sc->sc_empty_rseg);
254 1.1 skrll bus_space_unmap(sc->sc_bt, sc->sc_bh, HARMONY_NREGS);
255 1.1 skrll return;
256 1.1 skrll }
257 1.1 skrll if (bus_dmamap_create(sc->sc_dmat, sizeof(struct harmony_empty), 1,
258 1.1 skrll sizeof(struct harmony_empty), 0, BUS_DMA_WAITOK,
259 1.1 skrll &sc->sc_empty_map) != 0) {
260 1.1 skrll aprint_error(": can't create DMA map\n");
261 1.1 skrll bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_empty_kva,
262 1.1 skrll sizeof(struct harmony_empty));
263 1.1 skrll bus_dmamem_free(sc->sc_dmat, &sc->sc_empty_seg,
264 1.1 skrll sc->sc_empty_rseg);
265 1.1 skrll bus_space_unmap(sc->sc_bt, sc->sc_bh, HARMONY_NREGS);
266 1.1 skrll return;
267 1.1 skrll }
268 1.1 skrll if (bus_dmamap_load(sc->sc_dmat, sc->sc_empty_map, sc->sc_empty_kva,
269 1.1 skrll sizeof(struct harmony_empty), NULL, BUS_DMA_WAITOK) != 0) {
270 1.1 skrll aprint_error(": can't load DMA map\n");
271 1.1 skrll bus_dmamap_destroy(sc->sc_dmat, sc->sc_empty_map);
272 1.1 skrll bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_empty_kva,
273 1.1 skrll sizeof(struct harmony_empty));
274 1.1 skrll bus_dmamem_free(sc->sc_dmat, &sc->sc_empty_seg,
275 1.1 skrll sc->sc_empty_rseg);
276 1.1 skrll bus_space_unmap(sc->sc_bt, sc->sc_bh, HARMONY_NREGS);
277 1.1 skrll return;
278 1.1 skrll }
279 1.1 skrll
280 1.1 skrll sc->sc_playback_empty = 0;
281 1.1 skrll for (i = 0; i < PLAYBACK_EMPTYS; i++)
282 1.1 skrll sc->sc_playback_paddrs[i] =
283 1.1 skrll sc->sc_empty_map->dm_segs[0].ds_addr +
284 1.1 skrll offsetof(struct harmony_empty, playback[i][0]);
285 1.1 skrll
286 1.1 skrll sc->sc_capture_empty = 0;
287 1.1 skrll for (i = 0; i < CAPTURE_EMPTYS; i++)
288 1.1 skrll sc->sc_capture_paddrs[i] =
289 1.1 skrll sc->sc_empty_map->dm_segs[0].ds_addr +
290 1.1 skrll offsetof(struct harmony_empty, capture[i][0]);
291 1.1 skrll
292 1.1 skrll bus_dmamap_sync(sc->sc_dmat, sc->sc_empty_map,
293 1.1 skrll offsetof(struct harmony_empty, playback[0][0]),
294 1.1 skrll PLAYBACK_EMPTYS * HARMONY_BUFSIZE, BUS_DMASYNC_PREWRITE);
295 1.1 skrll
296 1.1 skrll (void) hppa_intr_establish(IPL_AUDIO, harmony_intr, sc, ga->ga_ir,
297 1.1 skrll ga->ga_irq);
298 1.1 skrll
299 1.1 skrll /* set defaults */
300 1.1 skrll sc->sc_in_port = HARMONY_IN_LINE;
301 1.1 skrll sc->sc_out_port = HARMONY_OUT_SPEAKER;
302 1.1 skrll sc->sc_input_lvl.left = sc->sc_input_lvl.right = 240;
303 1.1 skrll sc->sc_output_lvl.left = sc->sc_output_lvl.right = 244;
304 1.1 skrll sc->sc_monitor_lvl.left = sc->sc_monitor_lvl.right = 208;
305 1.1 skrll sc->sc_outputgain = 0;
306 1.1 skrll
307 1.1 skrll /* reset chip, and push default gain controls */
308 1.1 skrll harmony_reset_codec(sc);
309 1.1 skrll
310 1.1 skrll cntl = READ_REG(sc, HARMONY_CNTL);
311 1.1 skrll rev = (cntl & CNTL_CODEC_REV_MASK) >> CNTL_CODEC_REV_SHIFT;
312 1.1 skrll aprint_normal(": rev %u", rev);
313 1.1 skrll
314 1.1 skrll if (sc->sc_teleshare)
315 1.1 skrll printf(", teleshare");
316 1.1 skrll aprint_normal("\n");
317 1.1 skrll
318 1.1 skrll strlcpy(sc->sc_audev.name, ga->ga_name, sizeof(sc->sc_audev.name));
319 1.1 skrll snprintf(sc->sc_audev.version, sizeof sc->sc_audev.version,
320 1.1 skrll "%u.%u;%u", ga->ga_type.iodc_sv_rev,
321 1.1 skrll ga->ga_type.iodc_model, ga->ga_type.iodc_revision);
322 1.1 skrll strlcpy(sc->sc_audev.config, device_xname(sc->sc_dv),
323 1.1 skrll sizeof(sc->sc_audev.config));
324 1.1 skrll
325 1.1 skrll audio_attach_mi(&harmony_sa_hw_if, sc, sc->sc_dv);
326 1.1 skrll
327 1.1 skrll rnd_attach_source(&sc->sc_rnd_source, device_xname(sc->sc_dv),
328 1.2 tls RND_TYPE_UNKNOWN, RND_FLAG_DEFAULT);
329 1.1 skrll
330 1.1 skrll callout_init(&sc->sc_acc_tmo, 0);
331 1.1 skrll callout_setfunc(&sc->sc_acc_tmo, harmony_acc_tmo, sc);
332 1.1 skrll sc->sc_acc_num = 0xa5a5a5a5;
333 1.1 skrll }
334 1.1 skrll
335 1.1 skrll void
336 1.1 skrll harmony_reset_codec(struct harmony_softc *sc)
337 1.1 skrll {
338 1.1 skrll
339 1.1 skrll /* silence */
340 1.1 skrll WRITE_REG(sc, HARMONY_GAINCTL, GAINCTL_OUTPUT_LEFT_M |
341 1.1 skrll GAINCTL_OUTPUT_RIGHT_M | GAINCTL_MONITOR_M);
342 1.1 skrll
343 1.1 skrll /* start reset */
344 1.1 skrll WRITE_REG(sc, HARMONY_RESET, RESET_RST);
345 1.1 skrll
346 1.1 skrll DELAY(100000); /* wait at least 0.05 sec */
347 1.1 skrll
348 1.1 skrll harmony_set_gainctl(sc);
349 1.1 skrll WRITE_REG(sc, HARMONY_RESET, 0);
350 1.1 skrll }
351 1.1 skrll
352 1.1 skrll void
353 1.1 skrll harmony_acc_tmo(void *v)
354 1.1 skrll {
355 1.1 skrll struct harmony_softc *sc;
356 1.1 skrll
357 1.1 skrll sc = v;
358 1.1 skrll ADD_CLKALLICA(sc);
359 1.1 skrll callout_schedule(&sc->sc_acc_tmo, 1);
360 1.1 skrll }
361 1.1 skrll
362 1.1 skrll /*
363 1.1 skrll * interrupt handler
364 1.1 skrll */
365 1.1 skrll int
366 1.1 skrll harmony_intr(void *vsc)
367 1.1 skrll {
368 1.1 skrll struct harmony_softc *sc;
369 1.1 skrll uint32_t dstatus;
370 1.1 skrll int r;
371 1.1 skrll
372 1.1 skrll sc = vsc;
373 1.1 skrll r = 0;
374 1.1 skrll ADD_CLKALLICA(sc);
375 1.1 skrll
376 1.1 skrll mutex_spin_enter(&sc->sc_intr_lock);
377 1.1 skrll
378 1.1 skrll harmony_intr_disable(sc);
379 1.1 skrll
380 1.1 skrll dstatus = READ_REG(sc, HARMONY_DSTATUS);
381 1.1 skrll
382 1.1 skrll if (dstatus & DSTATUS_PN) {
383 1.1 skrll r = 1;
384 1.1 skrll harmony_start_pp(sc, 0);
385 1.1 skrll }
386 1.1 skrll
387 1.1 skrll if (dstatus & DSTATUS_RN) {
388 1.1 skrll r = 1;
389 1.1 skrll harmony_start_cp(sc, 0);
390 1.1 skrll }
391 1.1 skrll
392 1.1 skrll if (READ_REG(sc, HARMONY_OV) & OV_OV) {
393 1.1 skrll sc->sc_ov = 1;
394 1.1 skrll WRITE_REG(sc, HARMONY_OV, 0);
395 1.1 skrll } else
396 1.1 skrll sc->sc_ov = 0;
397 1.1 skrll
398 1.1 skrll harmony_intr_enable(sc);
399 1.1 skrll
400 1.1 skrll mutex_spin_exit(&sc->sc_intr_lock);
401 1.1 skrll
402 1.1 skrll return r;
403 1.1 skrll }
404 1.1 skrll
405 1.1 skrll void
406 1.1 skrll harmony_intr_enable(struct harmony_softc *sc)
407 1.1 skrll {
408 1.1 skrll
409 1.1 skrll WRITE_REG(sc, HARMONY_DSTATUS, DSTATUS_IE);
410 1.1 skrll SYNC_REG(sc, HARMONY_DSTATUS, BUS_SPACE_BARRIER_WRITE);
411 1.1 skrll }
412 1.1 skrll
413 1.1 skrll void
414 1.1 skrll harmony_intr_disable(struct harmony_softc *sc)
415 1.1 skrll {
416 1.1 skrll
417 1.1 skrll WRITE_REG(sc, HARMONY_DSTATUS, 0);
418 1.1 skrll SYNC_REG(sc, HARMONY_DSTATUS, BUS_SPACE_BARRIER_WRITE);
419 1.1 skrll }
420 1.1 skrll
421 1.1 skrll void
422 1.1 skrll harmony_close(void *vsc)
423 1.1 skrll {
424 1.1 skrll struct harmony_softc *sc;
425 1.1 skrll
426 1.1 skrll sc = vsc;
427 1.1 skrll harmony_intr_disable(sc);
428 1.1 skrll }
429 1.1 skrll
430 1.1 skrll int
431 1.6 isaki harmony_query_format(void *vsc, audio_format_query_t *afp)
432 1.1 skrll {
433 1.1 skrll
434 1.6 isaki return audio_query_format(harmony_formats, HARMONY_NFORMATS, afp);
435 1.1 skrll }
436 1.1 skrll
437 1.1 skrll int
438 1.6 isaki harmony_set_format(void *vsc, int setmode,
439 1.6 isaki const audio_params_t *play, const audio_params_t *rec,
440 1.6 isaki audio_filter_reg_t *pfil, audio_filter_reg_t *rfil)
441 1.1 skrll {
442 1.1 skrll struct harmony_softc *sc;
443 1.1 skrll uint32_t bits;
444 1.6 isaki int rate;
445 1.1 skrll
446 1.1 skrll sc = vsc;
447 1.6 isaki
448 1.6 isaki /* *play and *rec are the identical because !AUDIO_PROP_INDEPENDENT. */
449 1.6 isaki switch (play->encoding) {
450 1.1 skrll case AUDIO_ENCODING_ULAW:
451 1.1 skrll bits = CNTL_FORMAT_ULAW;
452 1.1 skrll break;
453 1.1 skrll case AUDIO_ENCODING_ALAW:
454 1.1 skrll bits = CNTL_FORMAT_ALAW;
455 1.1 skrll break;
456 1.1 skrll case AUDIO_ENCODING_SLINEAR_BE:
457 1.6 isaki bits = CNTL_FORMAT_SLINEAR16BE;
458 1.6 isaki break;
459 1.1 skrll default:
460 1.1 skrll return EINVAL;
461 1.1 skrll }
462 1.1 skrll
463 1.1 skrll if (sc->sc_outputgain)
464 1.1 skrll bits |= CNTL_OLB;
465 1.1 skrll
466 1.6 isaki bits |= CNTL_CHANS_STEREO;
467 1.1 skrll
468 1.6 isaki /* XXX modify harmony_speed_bits() not to rewrite rate */
469 1.6 isaki rate = play->sample_rate;
470 1.6 isaki sc->sc_cntlbits |= harmony_speed_bits(sc, &rate);
471 1.1 skrll sc->sc_need_commit = 1;
472 1.1 skrll
473 1.1 skrll return 0;
474 1.1 skrll }
475 1.1 skrll
476 1.1 skrll int
477 1.1 skrll harmony_round_blocksize(void *vsc, int blk,
478 1.1 skrll int mode, const audio_params_t *param)
479 1.1 skrll {
480 1.1 skrll
481 1.1 skrll return HARMONY_BUFSIZE;
482 1.1 skrll }
483 1.1 skrll
484 1.1 skrll int
485 1.1 skrll harmony_control_wait(struct harmony_softc *sc)
486 1.1 skrll {
487 1.1 skrll uint32_t reg;
488 1.1 skrll int j = 0;
489 1.1 skrll
490 1.1 skrll while (j < 10) {
491 1.1 skrll /* Wait for it to come out of control mode */
492 1.1 skrll reg = READ_REG(sc, HARMONY_CNTL);
493 1.1 skrll if ((reg & CNTL_C) == 0)
494 1.1 skrll return 0;
495 1.1 skrll DELAY(50000); /* wait 0.05 */
496 1.1 skrll j++;
497 1.1 skrll }
498 1.1 skrll
499 1.1 skrll return 1;
500 1.1 skrll }
501 1.1 skrll
502 1.1 skrll int
503 1.1 skrll harmony_commit_settings(void *vsc)
504 1.1 skrll {
505 1.1 skrll struct harmony_softc *sc;
506 1.1 skrll uint32_t reg;
507 1.1 skrll uint8_t quietchar;
508 1.1 skrll int i;
509 1.1 skrll
510 1.1 skrll sc = vsc;
511 1.1 skrll if (sc->sc_need_commit == 0)
512 1.1 skrll return 0;
513 1.1 skrll
514 1.1 skrll harmony_intr_disable(sc);
515 1.1 skrll
516 1.1 skrll for (;;) {
517 1.1 skrll reg = READ_REG(sc, HARMONY_DSTATUS);
518 1.1 skrll if ((reg & (DSTATUS_PC | DSTATUS_RC)) == 0)
519 1.1 skrll break;
520 1.1 skrll }
521 1.1 skrll
522 1.1 skrll /* Setting some bits in gainctl requires a reset */
523 1.1 skrll harmony_reset_codec(sc);
524 1.1 skrll
525 1.1 skrll /* set the silence character based on the encoding type */
526 1.1 skrll bus_dmamap_sync(sc->sc_dmat, sc->sc_empty_map,
527 1.1 skrll offsetof(struct harmony_empty, playback[0][0]),
528 1.1 skrll PLAYBACK_EMPTYS * HARMONY_BUFSIZE, BUS_DMASYNC_POSTWRITE);
529 1.1 skrll switch (sc->sc_cntlbits & CNTL_FORMAT_MASK) {
530 1.1 skrll case CNTL_FORMAT_ULAW:
531 1.1 skrll quietchar = 0x7f;
532 1.1 skrll break;
533 1.1 skrll case CNTL_FORMAT_ALAW:
534 1.1 skrll quietchar = 0x55;
535 1.1 skrll break;
536 1.1 skrll case CNTL_FORMAT_SLINEAR16BE:
537 1.1 skrll case CNTL_FORMAT_ULINEAR8:
538 1.1 skrll default:
539 1.1 skrll quietchar = 0;
540 1.1 skrll break;
541 1.1 skrll }
542 1.1 skrll for (i = 0; i < PLAYBACK_EMPTYS; i++)
543 1.1 skrll memset(&sc->sc_empty_kva->playback[i][0],
544 1.1 skrll quietchar, HARMONY_BUFSIZE);
545 1.1 skrll bus_dmamap_sync(sc->sc_dmat, sc->sc_empty_map,
546 1.1 skrll offsetof(struct harmony_empty, playback[0][0]),
547 1.1 skrll PLAYBACK_EMPTYS * HARMONY_BUFSIZE, BUS_DMASYNC_PREWRITE);
548 1.1 skrll
549 1.1 skrll harmony_control_wait(sc);
550 1.1 skrll
551 1.1 skrll bus_space_write_4(sc->sc_bt, sc->sc_bh, HARMONY_CNTL,
552 1.1 skrll sc->sc_cntlbits | CNTL_C);
553 1.1 skrll
554 1.1 skrll harmony_control_wait(sc);
555 1.1 skrll
556 1.1 skrll sc->sc_need_commit = 0;
557 1.1 skrll
558 1.1 skrll if (sc->sc_playing || sc->sc_capturing)
559 1.1 skrll harmony_intr_enable(sc);
560 1.1 skrll
561 1.1 skrll return 0;
562 1.1 skrll }
563 1.1 skrll
564 1.1 skrll static void
565 1.1 skrll harmony_empty_output(struct harmony_softc *sc)
566 1.1 skrll {
567 1.1 skrll
568 1.1 skrll WRITE_REG(sc, HARMONY_PNXTADD,
569 1.1 skrll sc->sc_playback_paddrs[sc->sc_playback_empty]);
570 1.1 skrll SYNC_REG(sc, HARMONY_PNXTADD, BUS_SPACE_BARRIER_WRITE);
571 1.1 skrll
572 1.1 skrll if (++sc->sc_playback_empty == PLAYBACK_EMPTYS)
573 1.1 skrll sc->sc_playback_empty = 0;
574 1.1 skrll }
575 1.1 skrll
576 1.1 skrll int
577 1.1 skrll harmony_halt_output(void *vsc)
578 1.1 skrll {
579 1.1 skrll struct harmony_softc *sc;
580 1.1 skrll
581 1.1 skrll sc = vsc;
582 1.1 skrll sc->sc_playing = 0;
583 1.1 skrll
584 1.1 skrll harmony_empty_output(sc);
585 1.1 skrll return 0;
586 1.1 skrll }
587 1.1 skrll
588 1.1 skrll static void
589 1.1 skrll harmony_empty_input(struct harmony_softc *sc)
590 1.1 skrll {
591 1.1 skrll
592 1.1 skrll WRITE_REG(sc, HARMONY_RNXTADD,
593 1.1 skrll sc->sc_capture_paddrs[sc->sc_capture_empty]);
594 1.1 skrll SYNC_REG(sc, HARMONY_RNXTADD, BUS_SPACE_BARRIER_WRITE);
595 1.1 skrll
596 1.1 skrll if (++sc->sc_capture_empty == CAPTURE_EMPTYS)
597 1.1 skrll sc->sc_capture_empty = 0;
598 1.1 skrll }
599 1.1 skrll
600 1.1 skrll int
601 1.1 skrll harmony_halt_input(void *vsc)
602 1.1 skrll {
603 1.1 skrll struct harmony_softc *sc;
604 1.1 skrll
605 1.1 skrll sc = vsc;
606 1.1 skrll sc->sc_capturing = 0;
607 1.1 skrll
608 1.1 skrll harmony_empty_input(sc);
609 1.1 skrll return 0;
610 1.1 skrll }
611 1.1 skrll
612 1.1 skrll int
613 1.1 skrll harmony_getdev(void *vsc, struct audio_device *retp)
614 1.1 skrll {
615 1.1 skrll struct harmony_softc *sc;
616 1.1 skrll
617 1.1 skrll sc = vsc;
618 1.1 skrll *retp = sc->sc_audev;
619 1.1 skrll return 0;
620 1.1 skrll }
621 1.1 skrll
622 1.1 skrll int
623 1.1 skrll harmony_set_port(void *vsc, mixer_ctrl_t *cp)
624 1.1 skrll {
625 1.1 skrll struct harmony_softc *sc;
626 1.1 skrll int err;
627 1.1 skrll
628 1.1 skrll sc = vsc;
629 1.1 skrll err = EINVAL;
630 1.1 skrll switch (cp->dev) {
631 1.1 skrll case HARMONY_PORT_INPUT_LVL:
632 1.1 skrll if (cp->type != AUDIO_MIXER_VALUE)
633 1.1 skrll break;
634 1.1 skrll if (cp->un.value.num_channels == 1)
635 1.1 skrll sc->sc_input_lvl.left = sc->sc_input_lvl.right =
636 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_MONO];
637 1.1 skrll else if (cp->un.value.num_channels == 2) {
638 1.1 skrll sc->sc_input_lvl.left =
639 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_LEFT];
640 1.1 skrll sc->sc_input_lvl.right =
641 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_RIGHT];
642 1.1 skrll } else
643 1.1 skrll break;
644 1.1 skrll sc->sc_need_commit = 1;
645 1.1 skrll err = 0;
646 1.1 skrll break;
647 1.1 skrll case HARMONY_PORT_OUTPUT_LVL:
648 1.1 skrll if (cp->type != AUDIO_MIXER_VALUE)
649 1.1 skrll break;
650 1.1 skrll if (cp->un.value.num_channels == 1)
651 1.1 skrll sc->sc_output_lvl.left = sc->sc_output_lvl.right =
652 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_MONO];
653 1.1 skrll else if (cp->un.value.num_channels == 2) {
654 1.1 skrll sc->sc_output_lvl.left =
655 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_LEFT];
656 1.1 skrll sc->sc_output_lvl.right =
657 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_RIGHT];
658 1.1 skrll } else
659 1.1 skrll break;
660 1.1 skrll sc->sc_need_commit = 1;
661 1.1 skrll err = 0;
662 1.1 skrll break;
663 1.1 skrll case HARMONY_PORT_OUTPUT_GAIN:
664 1.1 skrll if (cp->type != AUDIO_MIXER_ENUM)
665 1.1 skrll break;
666 1.1 skrll sc->sc_outputgain = cp->un.ord ? 1 : 0;
667 1.1 skrll err = 0;
668 1.1 skrll break;
669 1.1 skrll case HARMONY_PORT_MONITOR_LVL:
670 1.1 skrll if (cp->type != AUDIO_MIXER_VALUE)
671 1.1 skrll break;
672 1.1 skrll if (cp->un.value.num_channels != 1)
673 1.1 skrll break;
674 1.1 skrll sc->sc_monitor_lvl.left = sc->sc_input_lvl.right =
675 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_MONO];
676 1.1 skrll sc->sc_need_commit = 1;
677 1.1 skrll err = 0;
678 1.1 skrll break;
679 1.1 skrll case HARMONY_PORT_RECORD_SOURCE:
680 1.1 skrll if (cp->type != AUDIO_MIXER_ENUM)
681 1.1 skrll break;
682 1.1 skrll if (cp->un.ord != HARMONY_IN_LINE &&
683 1.1 skrll cp->un.ord != HARMONY_IN_MIC)
684 1.1 skrll break;
685 1.1 skrll sc->sc_in_port = cp->un.ord;
686 1.1 skrll err = 0;
687 1.1 skrll sc->sc_need_commit = 1;
688 1.1 skrll break;
689 1.1 skrll case HARMONY_PORT_OUTPUT_SOURCE:
690 1.1 skrll if (cp->type != AUDIO_MIXER_ENUM)
691 1.1 skrll break;
692 1.1 skrll if (cp->un.ord != HARMONY_OUT_LINE &&
693 1.1 skrll cp->un.ord != HARMONY_OUT_SPEAKER &&
694 1.1 skrll cp->un.ord != HARMONY_OUT_HEADPHONE)
695 1.1 skrll break;
696 1.1 skrll sc->sc_out_port = cp->un.ord;
697 1.1 skrll err = 0;
698 1.1 skrll sc->sc_need_commit = 1;
699 1.1 skrll break;
700 1.1 skrll }
701 1.1 skrll
702 1.1 skrll return err;
703 1.1 skrll }
704 1.1 skrll
705 1.1 skrll int
706 1.1 skrll harmony_get_port(void *vsc, mixer_ctrl_t *cp)
707 1.1 skrll {
708 1.1 skrll struct harmony_softc *sc;
709 1.1 skrll int err;
710 1.1 skrll
711 1.1 skrll sc = vsc;
712 1.1 skrll err = EINVAL;
713 1.1 skrll switch (cp->dev) {
714 1.1 skrll case HARMONY_PORT_INPUT_LVL:
715 1.1 skrll if (cp->type != AUDIO_MIXER_VALUE)
716 1.1 skrll break;
717 1.1 skrll if (cp->un.value.num_channels == 1) {
718 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_MONO] =
719 1.1 skrll sc->sc_input_lvl.left;
720 1.1 skrll } else if (cp->un.value.num_channels == 2) {
721 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_LEFT] =
722 1.1 skrll sc->sc_input_lvl.left;
723 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] =
724 1.1 skrll sc->sc_input_lvl.right;
725 1.1 skrll } else
726 1.1 skrll break;
727 1.1 skrll err = 0;
728 1.1 skrll break;
729 1.1 skrll case HARMONY_PORT_INPUT_OV:
730 1.1 skrll if (cp->type != AUDIO_MIXER_ENUM)
731 1.1 skrll break;
732 1.1 skrll cp->un.ord = sc->sc_ov ? 1 : 0;
733 1.1 skrll err = 0;
734 1.1 skrll break;
735 1.1 skrll case HARMONY_PORT_OUTPUT_LVL:
736 1.1 skrll if (cp->type != AUDIO_MIXER_VALUE)
737 1.1 skrll break;
738 1.1 skrll if (cp->un.value.num_channels == 1) {
739 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_MONO] =
740 1.1 skrll sc->sc_output_lvl.left;
741 1.1 skrll } else if (cp->un.value.num_channels == 2) {
742 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_LEFT] =
743 1.1 skrll sc->sc_output_lvl.left;
744 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] =
745 1.1 skrll sc->sc_output_lvl.right;
746 1.1 skrll } else
747 1.1 skrll break;
748 1.1 skrll err = 0;
749 1.1 skrll break;
750 1.1 skrll case HARMONY_PORT_OUTPUT_GAIN:
751 1.1 skrll if (cp->type != AUDIO_MIXER_ENUM)
752 1.1 skrll break;
753 1.1 skrll cp->un.ord = sc->sc_outputgain ? 1 : 0;
754 1.1 skrll err = 0;
755 1.1 skrll break;
756 1.1 skrll case HARMONY_PORT_MONITOR_LVL:
757 1.1 skrll if (cp->type != AUDIO_MIXER_VALUE)
758 1.1 skrll break;
759 1.1 skrll if (cp->un.value.num_channels != 1)
760 1.1 skrll break;
761 1.1 skrll cp->un.value.level[AUDIO_MIXER_LEVEL_MONO] =
762 1.1 skrll sc->sc_monitor_lvl.left;
763 1.1 skrll err = 0;
764 1.1 skrll break;
765 1.1 skrll case HARMONY_PORT_RECORD_SOURCE:
766 1.1 skrll if (cp->type != AUDIO_MIXER_ENUM)
767 1.1 skrll break;
768 1.1 skrll cp->un.ord = sc->sc_in_port;
769 1.1 skrll err = 0;
770 1.1 skrll break;
771 1.1 skrll case HARMONY_PORT_OUTPUT_SOURCE:
772 1.1 skrll if (cp->type != AUDIO_MIXER_ENUM)
773 1.1 skrll break;
774 1.1 skrll cp->un.ord = sc->sc_out_port;
775 1.1 skrll err = 0;
776 1.1 skrll break;
777 1.1 skrll }
778 1.1 skrll return err;
779 1.1 skrll }
780 1.1 skrll
781 1.1 skrll int
782 1.1 skrll harmony_query_devinfo(void *vsc, mixer_devinfo_t *dip)
783 1.1 skrll {
784 1.1 skrll int err;
785 1.1 skrll
786 1.1 skrll err = 0;
787 1.1 skrll switch (dip->index) {
788 1.1 skrll case HARMONY_PORT_INPUT_LVL:
789 1.1 skrll dip->type = AUDIO_MIXER_VALUE;
790 1.1 skrll dip->mixer_class = HARMONY_PORT_INPUT_CLASS;
791 1.1 skrll dip->prev = dip->next = AUDIO_MIXER_LAST;
792 1.1 skrll strlcpy(dip->label.name, AudioNinput, sizeof dip->label.name);
793 1.1 skrll dip->un.v.num_channels = 2;
794 1.1 skrll strlcpy(dip->un.v.units.name, AudioNvolume,
795 1.1 skrll sizeof dip->un.v.units.name);
796 1.1 skrll break;
797 1.1 skrll case HARMONY_PORT_INPUT_OV:
798 1.1 skrll dip->type = AUDIO_MIXER_ENUM;
799 1.1 skrll dip->mixer_class = HARMONY_PORT_INPUT_CLASS;
800 1.1 skrll dip->prev = dip->next = AUDIO_MIXER_LAST;
801 1.1 skrll strlcpy(dip->label.name, "overrange", sizeof dip->label.name);
802 1.1 skrll dip->un.e.num_mem = 2;
803 1.1 skrll strlcpy(dip->un.e.member[0].label.name, AudioNoff,
804 1.1 skrll sizeof dip->un.e.member[0].label.name);
805 1.1 skrll dip->un.e.member[0].ord = 0;
806 1.1 skrll strlcpy(dip->un.e.member[1].label.name, AudioNon,
807 1.1 skrll sizeof dip->un.e.member[1].label.name);
808 1.1 skrll dip->un.e.member[1].ord = 1;
809 1.1 skrll break;
810 1.1 skrll case HARMONY_PORT_OUTPUT_LVL:
811 1.1 skrll dip->type = AUDIO_MIXER_VALUE;
812 1.1 skrll dip->mixer_class = HARMONY_PORT_OUTPUT_CLASS;
813 1.1 skrll dip->prev = dip->next = AUDIO_MIXER_LAST;
814 1.1 skrll strlcpy(dip->label.name, AudioNoutput, sizeof dip->label.name);
815 1.1 skrll dip->un.v.num_channels = 2;
816 1.1 skrll strlcpy(dip->un.v.units.name, AudioNvolume,
817 1.1 skrll sizeof dip->un.v.units.name);
818 1.1 skrll break;
819 1.1 skrll case HARMONY_PORT_OUTPUT_GAIN:
820 1.1 skrll dip->type = AUDIO_MIXER_ENUM;
821 1.1 skrll dip->mixer_class = HARMONY_PORT_OUTPUT_CLASS;
822 1.1 skrll dip->prev = dip->next = AUDIO_MIXER_LAST;
823 1.1 skrll strlcpy(dip->label.name, "gain", sizeof dip->label.name);
824 1.1 skrll dip->un.e.num_mem = 2;
825 1.1 skrll strlcpy(dip->un.e.member[0].label.name, AudioNoff,
826 1.1 skrll sizeof dip->un.e.member[0].label.name);
827 1.1 skrll dip->un.e.member[0].ord = 0;
828 1.1 skrll strlcpy(dip->un.e.member[1].label.name, AudioNon,
829 1.1 skrll sizeof dip->un.e.member[1].label.name);
830 1.1 skrll dip->un.e.member[1].ord = 1;
831 1.1 skrll break;
832 1.1 skrll case HARMONY_PORT_MONITOR_LVL:
833 1.1 skrll dip->type = AUDIO_MIXER_VALUE;
834 1.1 skrll dip->mixer_class = HARMONY_PORT_MONITOR_CLASS;
835 1.1 skrll dip->prev = dip->next = AUDIO_MIXER_LAST;
836 1.1 skrll strlcpy(dip->label.name, AudioNmonitor, sizeof dip->label.name);
837 1.1 skrll dip->un.v.num_channels = 1;
838 1.1 skrll strlcpy(dip->un.v.units.name, AudioNvolume,
839 1.1 skrll sizeof dip->un.v.units.name);
840 1.1 skrll break;
841 1.1 skrll case HARMONY_PORT_RECORD_SOURCE:
842 1.1 skrll dip->type = AUDIO_MIXER_ENUM;
843 1.1 skrll dip->mixer_class = HARMONY_PORT_RECORD_CLASS;
844 1.1 skrll dip->prev = dip->next = AUDIO_MIXER_LAST;
845 1.1 skrll strlcpy(dip->label.name, AudioNsource, sizeof dip->label.name);
846 1.1 skrll dip->un.e.num_mem = 2;
847 1.1 skrll strlcpy(dip->un.e.member[0].label.name, AudioNmicrophone,
848 1.1 skrll sizeof dip->un.e.member[0].label.name);
849 1.1 skrll dip->un.e.member[0].ord = HARMONY_IN_MIC;
850 1.1 skrll strlcpy(dip->un.e.member[1].label.name, AudioNline,
851 1.1 skrll sizeof dip->un.e.member[1].label.name);
852 1.1 skrll dip->un.e.member[1].ord = HARMONY_IN_LINE;
853 1.1 skrll break;
854 1.1 skrll case HARMONY_PORT_OUTPUT_SOURCE:
855 1.1 skrll dip->type = AUDIO_MIXER_ENUM;
856 1.1 skrll dip->mixer_class = HARMONY_PORT_MONITOR_CLASS;
857 1.1 skrll dip->prev = dip->next = AUDIO_MIXER_LAST;
858 1.1 skrll strlcpy(dip->label.name, AudioNoutput, sizeof dip->label.name);
859 1.1 skrll dip->un.e.num_mem = 3;
860 1.1 skrll strlcpy(dip->un.e.member[0].label.name, AudioNline,
861 1.1 skrll sizeof dip->un.e.member[0].label.name);
862 1.1 skrll dip->un.e.member[0].ord = HARMONY_OUT_LINE;
863 1.1 skrll strlcpy(dip->un.e.member[1].label.name, AudioNspeaker,
864 1.1 skrll sizeof dip->un.e.member[1].label.name);
865 1.1 skrll dip->un.e.member[1].ord = HARMONY_OUT_SPEAKER;
866 1.1 skrll strlcpy(dip->un.e.member[2].label.name, AudioNheadphone,
867 1.1 skrll sizeof dip->un.e.member[2].label.name);
868 1.1 skrll dip->un.e.member[2].ord = HARMONY_OUT_HEADPHONE;
869 1.1 skrll break;
870 1.1 skrll case HARMONY_PORT_INPUT_CLASS:
871 1.1 skrll dip->type = AUDIO_MIXER_CLASS;
872 1.1 skrll dip->mixer_class = HARMONY_PORT_INPUT_CLASS;
873 1.1 skrll dip->prev = dip->next = AUDIO_MIXER_LAST;
874 1.1 skrll strlcpy(dip->label.name, AudioCinputs, sizeof dip->label.name);
875 1.1 skrll break;
876 1.1 skrll case HARMONY_PORT_OUTPUT_CLASS:
877 1.1 skrll dip->type = AUDIO_MIXER_CLASS;
878 1.1 skrll dip->mixer_class = HARMONY_PORT_INPUT_CLASS;
879 1.1 skrll dip->prev = dip->next = AUDIO_MIXER_LAST;
880 1.1 skrll strlcpy(dip->label.name, AudioCoutputs, sizeof dip->label.name);
881 1.1 skrll break;
882 1.1 skrll case HARMONY_PORT_MONITOR_CLASS:
883 1.1 skrll dip->type = AUDIO_MIXER_CLASS;
884 1.1 skrll dip->mixer_class = HARMONY_PORT_INPUT_CLASS;
885 1.1 skrll dip->prev = dip->next = AUDIO_MIXER_LAST;
886 1.1 skrll strlcpy(dip->label.name, AudioCmonitor, sizeof dip->label.name);
887 1.1 skrll break;
888 1.1 skrll case HARMONY_PORT_RECORD_CLASS:
889 1.1 skrll dip->type = AUDIO_MIXER_CLASS;
890 1.1 skrll dip->mixer_class = HARMONY_PORT_RECORD_CLASS;
891 1.1 skrll dip->prev = dip->next = AUDIO_MIXER_LAST;
892 1.1 skrll strlcpy(dip->label.name, AudioCrecord, sizeof dip->label.name);
893 1.1 skrll break;
894 1.1 skrll default:
895 1.1 skrll err = ENXIO;
896 1.1 skrll break;
897 1.1 skrll }
898 1.1 skrll
899 1.1 skrll return err;
900 1.1 skrll }
901 1.1 skrll
902 1.1 skrll void *
903 1.1 skrll harmony_allocm(void *vsc, int dir, size_t size)
904 1.1 skrll {
905 1.1 skrll struct harmony_softc *sc;
906 1.1 skrll struct harmony_dma *d;
907 1.1 skrll int rseg;
908 1.1 skrll
909 1.1 skrll sc = vsc;
910 1.1 skrll d = kmem_alloc(sizeof(*d), KM_SLEEP);
911 1.1 skrll
912 1.1 skrll if (bus_dmamap_create(sc->sc_dmat, size, 1, size, 0, BUS_DMA_WAITOK,
913 1.1 skrll &d->d_map) != 0)
914 1.1 skrll goto fail1;
915 1.1 skrll
916 1.1 skrll if (bus_dmamem_alloc(sc->sc_dmat, size, PAGE_SIZE, 0, &d->d_seg, 1,
917 1.1 skrll &rseg, BUS_DMA_WAITOK) != 0)
918 1.1 skrll goto fail2;
919 1.1 skrll
920 1.1 skrll if (bus_dmamem_map(sc->sc_dmat, &d->d_seg, 1, size, &d->d_kva,
921 1.1 skrll BUS_DMA_WAITOK) != 0)
922 1.1 skrll goto fail3;
923 1.1 skrll
924 1.1 skrll if (bus_dmamap_load(sc->sc_dmat, d->d_map, d->d_kva, size, NULL,
925 1.1 skrll BUS_DMA_WAITOK) != 0)
926 1.1 skrll goto fail4;
927 1.1 skrll
928 1.1 skrll d->d_next = sc->sc_dmas;
929 1.1 skrll sc->sc_dmas = d;
930 1.1 skrll d->d_size = size;
931 1.1 skrll return (d->d_kva);
932 1.1 skrll
933 1.1 skrll fail4:
934 1.1 skrll bus_dmamem_unmap(sc->sc_dmat, d->d_kva, size);
935 1.1 skrll fail3:
936 1.1 skrll bus_dmamem_free(sc->sc_dmat, &d->d_seg, 1);
937 1.1 skrll fail2:
938 1.1 skrll bus_dmamap_destroy(sc->sc_dmat, d->d_map);
939 1.1 skrll fail1:
940 1.1 skrll kmem_free(d, sizeof(*d));
941 1.1 skrll return (NULL);
942 1.1 skrll }
943 1.1 skrll
944 1.1 skrll void
945 1.1 skrll harmony_freem(void *vsc, void *ptr, size_t size)
946 1.1 skrll {
947 1.1 skrll struct harmony_softc *sc;
948 1.1 skrll struct harmony_dma *d, **dd;
949 1.1 skrll
950 1.1 skrll sc = vsc;
951 1.1 skrll for (dd = &sc->sc_dmas; (d = *dd) != NULL; dd = &(*dd)->d_next) {
952 1.1 skrll if (d->d_kva != ptr)
953 1.1 skrll continue;
954 1.1 skrll bus_dmamap_unload(sc->sc_dmat, d->d_map);
955 1.1 skrll bus_dmamem_unmap(sc->sc_dmat, d->d_kva, d->d_size);
956 1.1 skrll bus_dmamem_free(sc->sc_dmat, &d->d_seg, 1);
957 1.1 skrll bus_dmamap_destroy(sc->sc_dmat, d->d_map);
958 1.1 skrll kmem_free(d, sizeof(*d));
959 1.1 skrll return;
960 1.1 skrll }
961 1.1 skrll printf("%s: free rogue pointer\n", device_xname(sc->sc_dv));
962 1.1 skrll }
963 1.1 skrll
964 1.1 skrll size_t
965 1.1 skrll harmony_round_buffersize(void *vsc, int direction, size_t size)
966 1.1 skrll {
967 1.1 skrll
968 1.1 skrll return ((size + HARMONY_BUFSIZE - 1) & (size_t)(-HARMONY_BUFSIZE));
969 1.1 skrll }
970 1.1 skrll
971 1.1 skrll int
972 1.1 skrll harmony_get_props(void *vsc)
973 1.1 skrll {
974 1.1 skrll
975 1.1 skrll return AUDIO_PROP_FULLDUPLEX;
976 1.1 skrll }
977 1.1 skrll
978 1.1 skrll void
979 1.1 skrll harmony_get_locks(void *vsc, kmutex_t **intr, kmutex_t **thread)
980 1.1 skrll {
981 1.1 skrll struct harmony_softc *sc;
982 1.1 skrll
983 1.1 skrll sc = vsc;
984 1.1 skrll *intr = &sc->sc_intr_lock;
985 1.1 skrll *thread = &sc->sc_lock;
986 1.1 skrll }
987 1.1 skrll
988 1.1 skrll int
989 1.1 skrll harmony_trigger_output(void *vsc, void *start, void *end, int blksize,
990 1.1 skrll void (*intr)(void *), void *intrarg, const audio_params_t *param)
991 1.1 skrll {
992 1.1 skrll struct harmony_softc *sc;
993 1.1 skrll struct harmony_channel *c;
994 1.1 skrll struct harmony_dma *d;
995 1.1 skrll
996 1.1 skrll sc = vsc;
997 1.1 skrll c = &sc->sc_playback;
998 1.1 skrll for (d = sc->sc_dmas; d->d_kva != start; d = d->d_next)
999 1.1 skrll continue;
1000 1.1 skrll if (d == NULL) {
1001 1.1 skrll printf("%s: trigger_output: bad addr: %p\n",
1002 1.1 skrll device_xname(sc->sc_dv), start);
1003 1.1 skrll return EINVAL;
1004 1.1 skrll }
1005 1.1 skrll
1006 1.1 skrll mutex_spin_enter(&sc->sc_intr_lock);
1007 1.1 skrll
1008 1.1 skrll c->c_intr = intr;
1009 1.1 skrll c->c_intrarg = intrarg;
1010 1.1 skrll c->c_blksz = blksize;
1011 1.1 skrll c->c_current = d;
1012 1.1 skrll c->c_segsz = (char *)end - (char *)start;
1013 1.1 skrll c->c_cnt = 0;
1014 1.1 skrll c->c_lastaddr = d->d_map->dm_segs[0].ds_addr;
1015 1.1 skrll
1016 1.1 skrll sc->sc_playing = 1;
1017 1.1 skrll
1018 1.1 skrll harmony_start_pp(sc, 1);
1019 1.1 skrll harmony_start_cp(sc, 0);
1020 1.1 skrll harmony_intr_enable(sc);
1021 1.1 skrll
1022 1.1 skrll mutex_spin_exit(&sc->sc_intr_lock);
1023 1.1 skrll
1024 1.1 skrll return 0;
1025 1.1 skrll }
1026 1.1 skrll
1027 1.1 skrll void
1028 1.1 skrll harmony_start_cp(struct harmony_softc *sc, int start)
1029 1.1 skrll {
1030 1.1 skrll struct harmony_channel *c;
1031 1.1 skrll struct harmony_dma *d;
1032 1.1 skrll bus_addr_t nextaddr;
1033 1.1 skrll bus_size_t togo;
1034 1.1 skrll
1035 1.1 skrll KASSERT(mutex_owned(&sc->sc_intr_lock));
1036 1.1 skrll
1037 1.1 skrll c = &sc->sc_capture;
1038 1.1 skrll if (sc->sc_capturing == 0)
1039 1.1 skrll harmony_empty_input(sc);
1040 1.1 skrll else {
1041 1.1 skrll d = c->c_current;
1042 1.1 skrll togo = c->c_segsz - c->c_cnt;
1043 1.1 skrll if (togo == 0) {
1044 1.1 skrll nextaddr = d->d_map->dm_segs[0].ds_addr;
1045 1.1 skrll c->c_cnt = togo = c->c_blksz;
1046 1.1 skrll } else {
1047 1.1 skrll nextaddr = c->c_lastaddr;
1048 1.1 skrll if (togo > c->c_blksz)
1049 1.1 skrll togo = c->c_blksz;
1050 1.1 skrll c->c_cnt += togo;
1051 1.1 skrll }
1052 1.1 skrll
1053 1.1 skrll bus_dmamap_sync(sc->sc_dmat, d->d_map,
1054 1.1 skrll nextaddr - d->d_map->dm_segs[0].ds_addr,
1055 1.1 skrll c->c_blksz, BUS_DMASYNC_PREWRITE);
1056 1.1 skrll
1057 1.1 skrll WRITE_REG(sc, HARMONY_RNXTADD, nextaddr);
1058 1.1 skrll if (start)
1059 1.1 skrll c->c_theaddr = nextaddr;
1060 1.1 skrll SYNC_REG(sc, HARMONY_RNXTADD, BUS_SPACE_BARRIER_WRITE);
1061 1.1 skrll c->c_lastaddr = nextaddr + togo;
1062 1.1 skrll
1063 1.1 skrll harmony_try_more(sc, HARMONY_RCURADD,
1064 1.1 skrll RCURADD_BUFMASK, &sc->sc_capture);
1065 1.1 skrll }
1066 1.1 skrll
1067 1.1 skrll callout_schedule(&sc->sc_acc_tmo, 1);
1068 1.1 skrll }
1069 1.1 skrll
1070 1.1 skrll void
1071 1.1 skrll harmony_start_pp(struct harmony_softc *sc, int start)
1072 1.1 skrll {
1073 1.1 skrll struct harmony_channel *c;
1074 1.1 skrll struct harmony_dma *d;
1075 1.1 skrll bus_addr_t nextaddr;
1076 1.1 skrll bus_size_t togo;
1077 1.1 skrll
1078 1.1 skrll KASSERT(mutex_owned(&sc->sc_intr_lock));
1079 1.1 skrll
1080 1.1 skrll c = &sc->sc_playback;
1081 1.1 skrll if (sc->sc_playing == 0)
1082 1.1 skrll harmony_empty_output(sc);
1083 1.1 skrll else {
1084 1.1 skrll d = c->c_current;
1085 1.1 skrll togo = c->c_segsz - c->c_cnt;
1086 1.1 skrll if (togo == 0) {
1087 1.1 skrll nextaddr = d->d_map->dm_segs[0].ds_addr;
1088 1.1 skrll c->c_cnt = togo = c->c_blksz;
1089 1.1 skrll } else {
1090 1.1 skrll nextaddr = c->c_lastaddr;
1091 1.1 skrll if (togo > c->c_blksz)
1092 1.1 skrll togo = c->c_blksz;
1093 1.1 skrll c->c_cnt += togo;
1094 1.1 skrll }
1095 1.1 skrll
1096 1.1 skrll bus_dmamap_sync(sc->sc_dmat, d->d_map,
1097 1.1 skrll nextaddr - d->d_map->dm_segs[0].ds_addr,
1098 1.1 skrll c->c_blksz, BUS_DMASYNC_PREWRITE);
1099 1.1 skrll
1100 1.1 skrll WRITE_REG(sc, HARMONY_PNXTADD, nextaddr);
1101 1.1 skrll if (start)
1102 1.1 skrll c->c_theaddr = nextaddr;
1103 1.1 skrll SYNC_REG(sc, HARMONY_PNXTADD, BUS_SPACE_BARRIER_WRITE);
1104 1.1 skrll c->c_lastaddr = nextaddr + togo;
1105 1.1 skrll
1106 1.1 skrll harmony_try_more(sc, HARMONY_PCURADD,
1107 1.1 skrll PCURADD_BUFMASK, &sc->sc_playback);
1108 1.1 skrll }
1109 1.1 skrll }
1110 1.1 skrll
1111 1.1 skrll int
1112 1.1 skrll harmony_trigger_input(void *vsc, void *start, void *end, int blksize,
1113 1.1 skrll void (*intr)(void *), void *intrarg, const audio_params_t *param)
1114 1.1 skrll {
1115 1.1 skrll struct harmony_softc *sc = vsc;
1116 1.1 skrll struct harmony_channel *c = &sc->sc_capture;
1117 1.1 skrll struct harmony_dma *d;
1118 1.1 skrll
1119 1.1 skrll KASSERT(mutex_owned(&sc->sc_intr_lock));
1120 1.1 skrll
1121 1.1 skrll for (d = sc->sc_dmas; d->d_kva != start; d = d->d_next)
1122 1.1 skrll continue;
1123 1.1 skrll if (d == NULL) {
1124 1.1 skrll printf("%s: trigger_input: bad addr: %p\n",
1125 1.1 skrll device_xname(sc->sc_dv), start);
1126 1.1 skrll return EINVAL;
1127 1.1 skrll }
1128 1.1 skrll
1129 1.1 skrll c->c_intr = intr;
1130 1.1 skrll c->c_intrarg = intrarg;
1131 1.1 skrll c->c_blksz = blksize;
1132 1.1 skrll c->c_current = d;
1133 1.1 skrll c->c_segsz = (char *)end - (char *)start;
1134 1.1 skrll c->c_cnt = 0;
1135 1.1 skrll c->c_lastaddr = d->d_map->dm_segs[0].ds_addr;
1136 1.1 skrll
1137 1.1 skrll sc->sc_capturing = 1;
1138 1.1 skrll
1139 1.1 skrll harmony_start_cp(sc, 1);
1140 1.1 skrll harmony_intr_enable(sc);
1141 1.1 skrll
1142 1.1 skrll return 0;
1143 1.1 skrll }
1144 1.1 skrll
1145 1.1 skrll static const struct speed_struct {
1146 1.1 skrll uint32_t speed;
1147 1.1 skrll uint32_t bits;
1148 1.1 skrll } harmony_speeds[] = {
1149 1.1 skrll { 5125, CNTL_RATE_5125 },
1150 1.1 skrll { 6615, CNTL_RATE_6615 },
1151 1.1 skrll { 8000, CNTL_RATE_8000 },
1152 1.1 skrll { 9600, CNTL_RATE_9600 },
1153 1.1 skrll { 11025, CNTL_RATE_11025 },
1154 1.1 skrll { 16000, CNTL_RATE_16000 },
1155 1.1 skrll { 18900, CNTL_RATE_18900 },
1156 1.1 skrll { 22050, CNTL_RATE_22050 },
1157 1.1 skrll { 27428, CNTL_RATE_27428 },
1158 1.1 skrll { 32000, CNTL_RATE_32000 },
1159 1.1 skrll { 33075, CNTL_RATE_33075 },
1160 1.1 skrll { 37800, CNTL_RATE_37800 },
1161 1.1 skrll { 44100, CNTL_RATE_44100 },
1162 1.1 skrll { 48000, CNTL_RATE_48000 },
1163 1.1 skrll };
1164 1.1 skrll
1165 1.1 skrll uint32_t
1166 1.1 skrll harmony_speed_bits(struct harmony_softc *sc, u_int *speedp)
1167 1.1 skrll {
1168 1.1 skrll int i, n, selected;
1169 1.1 skrll
1170 1.1 skrll selected = -1;
1171 1.1 skrll n = sizeof(harmony_speeds) / sizeof(harmony_speeds[0]);
1172 1.1 skrll
1173 1.1 skrll if ((*speedp) <= harmony_speeds[0].speed)
1174 1.1 skrll selected = 0;
1175 1.1 skrll else if ((*speedp) >= harmony_speeds[n - 1].speed)
1176 1.1 skrll selected = n - 1;
1177 1.1 skrll else {
1178 1.1 skrll for (i = 1; selected == -1 && i < n; i++) {
1179 1.1 skrll if ((*speedp) == harmony_speeds[i].speed)
1180 1.1 skrll selected = i;
1181 1.1 skrll else if ((*speedp) < harmony_speeds[i].speed) {
1182 1.1 skrll int diff1, diff2;
1183 1.1 skrll
1184 1.1 skrll diff1 = (*speedp) - harmony_speeds[i - 1].speed;
1185 1.1 skrll diff2 = harmony_speeds[i].speed - (*speedp);
1186 1.1 skrll if (diff1 < diff2)
1187 1.1 skrll selected = i - 1;
1188 1.1 skrll else
1189 1.1 skrll selected = i;
1190 1.1 skrll }
1191 1.1 skrll }
1192 1.1 skrll }
1193 1.1 skrll
1194 1.1 skrll if (selected == -1)
1195 1.1 skrll selected = 2;
1196 1.1 skrll
1197 1.1 skrll *speedp = harmony_speeds[selected].speed;
1198 1.1 skrll return harmony_speeds[selected].bits;
1199 1.1 skrll }
1200 1.1 skrll
1201 1.1 skrll int
1202 1.1 skrll harmony_set_gainctl(struct harmony_softc *sc)
1203 1.1 skrll {
1204 1.1 skrll uint32_t bits, mask, val, old;
1205 1.1 skrll
1206 1.1 skrll /* XXX leave these bits alone or the chip will not come out of CNTL */
1207 1.1 skrll bits = GAINCTL_LE | GAINCTL_HE | GAINCTL_SE | GAINCTL_IS_MASK;
1208 1.1 skrll
1209 1.1 skrll /* input level */
1210 1.1 skrll bits |= ((sc->sc_input_lvl.left >> (8 - GAINCTL_INPUT_BITS)) <<
1211 1.1 skrll GAINCTL_INPUT_LEFT_S) & GAINCTL_INPUT_LEFT_M;
1212 1.1 skrll bits |= ((sc->sc_input_lvl.right >> (8 - GAINCTL_INPUT_BITS)) <<
1213 1.1 skrll GAINCTL_INPUT_RIGHT_S) & GAINCTL_INPUT_RIGHT_M;
1214 1.1 skrll
1215 1.1 skrll /* output level (inverted) */
1216 1.1 skrll mask = (1 << GAINCTL_OUTPUT_BITS) - 1;
1217 1.1 skrll val = mask - (sc->sc_output_lvl.left >> (8 - GAINCTL_OUTPUT_BITS));
1218 1.1 skrll bits |= (val << GAINCTL_OUTPUT_LEFT_S) & GAINCTL_OUTPUT_LEFT_M;
1219 1.1 skrll val = mask - (sc->sc_output_lvl.right >> (8 - GAINCTL_OUTPUT_BITS));
1220 1.1 skrll bits |= (val << GAINCTL_OUTPUT_RIGHT_S) & GAINCTL_OUTPUT_RIGHT_M;
1221 1.1 skrll
1222 1.1 skrll /* monitor level (inverted) */
1223 1.1 skrll mask = (1 << GAINCTL_MONITOR_BITS) - 1;
1224 1.1 skrll val = mask - (sc->sc_monitor_lvl.left >> (8 - GAINCTL_MONITOR_BITS));
1225 1.1 skrll bits |= (val << GAINCTL_MONITOR_S) & GAINCTL_MONITOR_M;
1226 1.1 skrll
1227 1.1 skrll /* XXX messing with these causes CNTL_C to get stuck... grr. */
1228 1.1 skrll bits &= ~GAINCTL_IS_MASK;
1229 1.1 skrll if (sc->sc_in_port == HARMONY_IN_MIC)
1230 1.1 skrll bits |= GAINCTL_IS_LINE;
1231 1.1 skrll else
1232 1.1 skrll bits |= GAINCTL_IS_MICROPHONE;
1233 1.1 skrll
1234 1.1 skrll /* XXX messing with these causes CNTL_C to get stuck... grr. */
1235 1.1 skrll bits &= ~(GAINCTL_LE | GAINCTL_HE | GAINCTL_SE);
1236 1.1 skrll if (sc->sc_out_port == HARMONY_OUT_LINE)
1237 1.1 skrll bits |= GAINCTL_LE;
1238 1.1 skrll else if (sc->sc_out_port == HARMONY_OUT_SPEAKER)
1239 1.1 skrll bits |= GAINCTL_SE;
1240 1.1 skrll else
1241 1.1 skrll bits |= GAINCTL_HE;
1242 1.1 skrll
1243 1.1 skrll mask = GAINCTL_LE | GAINCTL_HE | GAINCTL_SE | GAINCTL_IS_MASK;
1244 1.1 skrll old = bus_space_read_4(sc->sc_bt, sc->sc_bh, HARMONY_GAINCTL);
1245 1.1 skrll bus_space_write_4(sc->sc_bt, sc->sc_bh, HARMONY_GAINCTL, bits);
1246 1.1 skrll if ((old & mask) != (bits & mask))
1247 1.1 skrll return 1;
1248 1.1 skrll return 0;
1249 1.1 skrll }
1250 1.1 skrll
1251 1.1 skrll void
1252 1.1 skrll harmony_try_more(struct harmony_softc *sc, int curadd, int bufmask,
1253 1.1 skrll struct harmony_channel *c)
1254 1.1 skrll {
1255 1.1 skrll struct harmony_dma *d;
1256 1.1 skrll uint32_t cur;
1257 1.1 skrll int i, nsegs;
1258 1.1 skrll
1259 1.1 skrll d = c->c_current;
1260 1.1 skrll cur = bus_space_read_4(sc->sc_bt, sc->sc_bh, curadd);
1261 1.1 skrll cur &= bufmask;
1262 1.1 skrll nsegs = 0;
1263 1.1 skrll
1264 1.1 skrll #ifdef DIAGNOSTIC
1265 1.1 skrll if (cur < d->d_map->dm_segs[0].ds_addr ||
1266 1.1 skrll cur >= (d->d_map->dm_segs[0].ds_addr + c->c_segsz))
1267 1.1 skrll panic("%s: bad current %x < %lx || %x > %lx",
1268 1.1 skrll device_xname(sc->sc_dv), cur,
1269 1.1 skrll d->d_map->dm_segs[0].ds_addr, cur,
1270 1.1 skrll d->d_map->dm_segs[0].ds_addr + c->c_segsz);
1271 1.1 skrll #endif /* DIAGNOSTIC */
1272 1.1 skrll
1273 1.1 skrll if (cur > c->c_theaddr) {
1274 1.1 skrll nsegs = (cur - c->c_theaddr) / HARMONY_BUFSIZE;
1275 1.1 skrll } else if (cur < c->c_theaddr) {
1276 1.1 skrll nsegs = (d->d_map->dm_segs[0].ds_addr + c->c_segsz -
1277 1.1 skrll c->c_theaddr) / HARMONY_BUFSIZE;
1278 1.1 skrll nsegs += (cur - d->d_map->dm_segs[0].ds_addr) /
1279 1.1 skrll HARMONY_BUFSIZE;
1280 1.1 skrll }
1281 1.1 skrll
1282 1.1 skrll if (nsegs != 0 && c->c_intr != NULL) {
1283 1.1 skrll for (i = 0; i < nsegs; i++)
1284 1.1 skrll (*c->c_intr)(c->c_intrarg);
1285 1.1 skrll c->c_theaddr = cur;
1286 1.1 skrll }
1287 1.1 skrll }
1288