cs4280.c revision 1.51.4.1 1 1.51.4.1 yamt /* $NetBSD: cs4280.c,v 1.51.4.1 2009/05/16 10:41:33 yamt Exp $ */
2 1.1 augustss
3 1.1 augustss /*
4 1.2 augustss * Copyright (c) 1999, 2000 Tatoku Ogaito. All rights reserved.
5 1.1 augustss *
6 1.1 augustss * Redistribution and use in source and binary forms, with or without
7 1.1 augustss * modification, are permitted provided that the following conditions
8 1.1 augustss * are met:
9 1.1 augustss * 1. Redistributions of source code must retain the above copyright
10 1.1 augustss * notice, this list of conditions and the following disclaimer.
11 1.1 augustss * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 augustss * notice, this list of conditions and the following disclaimer in the
13 1.1 augustss * documentation and/or other materials provided with the distribution.
14 1.1 augustss * 3. All advertising materials mentioning features or use of this software
15 1.1 augustss * must display the following acknowledgement:
16 1.1 augustss * This product includes software developed by Tatoku Ogaito
17 1.1 augustss * for the NetBSD Project.
18 1.1 augustss * 4. The name of the author may not be used to endorse or promote products
19 1.1 augustss * derived from this software without specific prior written permission
20 1.1 augustss *
21 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
22 1.1 augustss * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
23 1.1 augustss * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
24 1.1 augustss * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
25 1.1 augustss * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
26 1.1 augustss * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27 1.1 augustss * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 1.1 augustss * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 1.1 augustss * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
30 1.1 augustss * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 1.1 augustss */
32 1.1 augustss
33 1.1 augustss /*
34 1.1 augustss * Cirrus Logic CS4280 (and maybe CS461x) driver.
35 1.1 augustss * Data sheets can be found
36 1.1 augustss * http://www.cirrus.com/ftp/pubs/4280.pdf
37 1.1 augustss * http://www.cirrus.com/ftp/pubs/4297.pdf
38 1.1 augustss * ftp://ftp.alsa-project.org/pub/manuals/cirrus/embedded_audio_spec.pdf
39 1.1 augustss * ftp://ftp.alsa-project.org/pub/manuals/cirrus/embedded_audio_spec.doc
40 1.6 augustss *
41 1.14 tacha * Note: CS4610/CS4611 + CS423x ISA codec should be worked with
42 1.6 augustss * wss* at pnpbios?
43 1.14 tacha * or
44 1.14 tacha * sb* at pnpbios?
45 1.14 tacha * Since I could not find any documents on handling ISA codec,
46 1.14 tacha * clcs does not support those chips.
47 1.1 augustss */
48 1.1 augustss
49 1.1 augustss /*
50 1.1 augustss * TODO
51 1.1 augustss * Joystick support
52 1.1 augustss */
53 1.18 lukem
54 1.18 lukem #include <sys/cdefs.h>
55 1.51.4.1 yamt __KERNEL_RCSID(0, "$NetBSD: cs4280.c,v 1.51.4.1 2009/05/16 10:41:33 yamt Exp $");
56 1.1 augustss
57 1.6 augustss #include "midi.h"
58 1.6 augustss
59 1.1 augustss #include <sys/param.h>
60 1.1 augustss #include <sys/systm.h>
61 1.1 augustss #include <sys/kernel.h>
62 1.1 augustss #include <sys/fcntl.h>
63 1.1 augustss #include <sys/malloc.h>
64 1.1 augustss #include <sys/device.h>
65 1.13 augustss #include <sys/proc.h>
66 1.1 augustss #include <sys/systm.h>
67 1.1 augustss
68 1.1 augustss #include <dev/pci/pcidevs.h>
69 1.1 augustss #include <dev/pci/pcivar.h>
70 1.1 augustss #include <dev/pci/cs4280reg.h>
71 1.1 augustss #include <dev/pci/cs4280_image.h>
72 1.14 tacha #include <dev/pci/cs428xreg.h>
73 1.1 augustss
74 1.1 augustss #include <sys/audioio.h>
75 1.1 augustss #include <dev/audio_if.h>
76 1.1 augustss #include <dev/midi_if.h>
77 1.1 augustss #include <dev/mulaw.h>
78 1.1 augustss #include <dev/auconv.h>
79 1.4 thorpej
80 1.4 thorpej #include <dev/ic/ac97reg.h>
81 1.3 thorpej #include <dev/ic/ac97var.h>
82 1.1 augustss
83 1.14 tacha #include <dev/pci/cs428x.h>
84 1.14 tacha
85 1.47 ad #include <sys/bus.h>
86 1.37 dsl #include <sys/bswap.h>
87 1.1 augustss
88 1.1 augustss #define BA1READ4(sc, r) bus_space_read_4((sc)->ba1t, (sc)->ba1h, (r))
89 1.1 augustss #define BA1WRITE4(sc, r, x) bus_space_write_4((sc)->ba1t, (sc)->ba1h, (r), (x))
90 1.1 augustss
91 1.14 tacha /* IF functions for audio driver */
92 1.51.4.1 yamt static int cs4280_match(device_t, cfdata_t, void *);
93 1.51.4.1 yamt static void cs4280_attach(device_t, device_t, void *);
94 1.35 thorpej static int cs4280_intr(void *);
95 1.35 thorpej static int cs4280_query_encoding(void *, struct audio_encoding *);
96 1.35 thorpej static int cs4280_set_params(void *, int, int, audio_params_t *,
97 1.35 thorpej audio_params_t *, stream_filter_list_t *,
98 1.35 thorpej stream_filter_list_t *);
99 1.35 thorpej static int cs4280_halt_output(void *);
100 1.35 thorpej static int cs4280_halt_input(void *);
101 1.35 thorpej static int cs4280_getdev(void *, struct audio_device *);
102 1.35 thorpej static int cs4280_trigger_output(void *, void *, void *, int, void (*)(void *),
103 1.35 thorpej void *, const audio_params_t *);
104 1.35 thorpej static int cs4280_trigger_input(void *, void *, void *, int, void (*)(void *),
105 1.35 thorpej void *, const audio_params_t *);
106 1.40 jmcneill static int cs4280_read_codec(void *, u_int8_t, u_int16_t *);
107 1.40 jmcneill static int cs4280_write_codec(void *, u_int8_t, u_int16_t);
108 1.38 jmcneill #if 0
109 1.35 thorpej static int cs4280_reset_codec(void *);
110 1.38 jmcneill #endif
111 1.38 jmcneill static enum ac97_host_flags cs4280_flags_codec(void *);
112 1.14 tacha
113 1.49 dyoung static bool cs4280_resume(device_t PMF_FN_PROTO);
114 1.49 dyoung static bool cs4280_suspend(device_t PMF_FN_PROTO);
115 1.14 tacha
116 1.14 tacha /* Internal functions */
117 1.38 jmcneill static const struct cs4280_card_t * cs4280_identify_card(struct pci_attach_args *);
118 1.40 jmcneill static int cs4280_piix4_match(struct pci_attach_args *);
119 1.40 jmcneill static void cs4280_clkrun_hack(struct cs428x_softc *, int);
120 1.40 jmcneill static void cs4280_clkrun_hack_init(struct cs428x_softc *);
121 1.35 thorpej static void cs4280_set_adc_rate(struct cs428x_softc *, int );
122 1.35 thorpej static void cs4280_set_dac_rate(struct cs428x_softc *, int );
123 1.35 thorpej static int cs4280_download(struct cs428x_softc *, const uint32_t *, uint32_t,
124 1.35 thorpej uint32_t);
125 1.35 thorpej static int cs4280_download_image(struct cs428x_softc *);
126 1.35 thorpej static void cs4280_reset(void *);
127 1.35 thorpej static int cs4280_init(struct cs428x_softc *, int);
128 1.35 thorpej static void cs4280_clear_fifos(struct cs428x_softc *);
129 1.14 tacha
130 1.14 tacha #if CS4280_DEBUG > 10
131 1.14 tacha /* Thease two function is only for checking image loading is succeeded or not. */
132 1.35 thorpej static int cs4280_check_images(struct cs428x_softc *);
133 1.35 thorpej static int cs4280_checkimage(struct cs428x_softc *, uint32_t *, uint32_t,
134 1.35 thorpej uint32_t);
135 1.1 augustss #endif
136 1.1 augustss
137 1.38 jmcneill /* Special cards */
138 1.38 jmcneill struct cs4280_card_t
139 1.38 jmcneill {
140 1.38 jmcneill pcireg_t id;
141 1.38 jmcneill enum cs428x_flags flags;
142 1.38 jmcneill };
143 1.38 jmcneill
144 1.38 jmcneill #define _card(vend, prod, flags) \
145 1.38 jmcneill {PCI_ID_CODE(vend, prod), flags}
146 1.38 jmcneill
147 1.38 jmcneill static const struct cs4280_card_t cs4280_cards[] = {
148 1.38 jmcneill #if 0 /* untested, from ALSA driver */
149 1.38 jmcneill _card(PCI_VENDOR_MITAC, PCI_PRODUCT_MITAC_MI6020,
150 1.38 jmcneill CS428X_FLAG_INVAC97EAMP),
151 1.38 jmcneill #endif
152 1.38 jmcneill _card(PCI_VENDOR_TURTLE_BEACH, PCI_PRODUCT_TURTLE_BEACH_SANTA_CRUZ,
153 1.40 jmcneill CS428X_FLAG_INVAC97EAMP),
154 1.40 jmcneill _card(PCI_VENDOR_IBM, PCI_PRODUCT_IBM_TPAUDIO,
155 1.40 jmcneill CS428X_FLAG_CLKRUNHACK)
156 1.38 jmcneill };
157 1.38 jmcneill
158 1.38 jmcneill #undef _card
159 1.38 jmcneill
160 1.38 jmcneill #define CS4280_CARDS_SIZE (sizeof(cs4280_cards)/sizeof(cs4280_cards[0]))
161 1.38 jmcneill
162 1.35 thorpej static const struct audio_hw_if cs4280_hw_if = {
163 1.33 kent NULL, /* open */
164 1.33 kent NULL, /* close */
165 1.1 augustss NULL,
166 1.1 augustss cs4280_query_encoding,
167 1.1 augustss cs4280_set_params,
168 1.14 tacha cs428x_round_blocksize,
169 1.1 augustss NULL,
170 1.1 augustss NULL,
171 1.1 augustss NULL,
172 1.1 augustss NULL,
173 1.1 augustss NULL,
174 1.1 augustss cs4280_halt_output,
175 1.1 augustss cs4280_halt_input,
176 1.1 augustss NULL,
177 1.1 augustss cs4280_getdev,
178 1.1 augustss NULL,
179 1.14 tacha cs428x_mixer_set_port,
180 1.14 tacha cs428x_mixer_get_port,
181 1.14 tacha cs428x_query_devinfo,
182 1.14 tacha cs428x_malloc,
183 1.14 tacha cs428x_free,
184 1.14 tacha cs428x_round_buffersize,
185 1.14 tacha cs428x_mappage,
186 1.14 tacha cs428x_get_props,
187 1.1 augustss cs4280_trigger_output,
188 1.1 augustss cs4280_trigger_input,
189 1.17 augustss NULL,
190 1.42 christos NULL,
191 1.1 augustss };
192 1.1 augustss
193 1.1 augustss #if NMIDI > 0
194 1.14 tacha /* Midi Interface */
195 1.35 thorpej static int cs4280_midi_open(void *, int, void (*)(void *, int),
196 1.34 kent void (*)(void *), void *);
197 1.35 thorpej static void cs4280_midi_close(void*);
198 1.35 thorpej static int cs4280_midi_output(void *, int);
199 1.35 thorpej static void cs4280_midi_getinfo(void *, struct midi_info *);
200 1.14 tacha
201 1.35 thorpej static const struct midi_hw_if cs4280_midi_hw_if = {
202 1.1 augustss cs4280_midi_open,
203 1.1 augustss cs4280_midi_close,
204 1.1 augustss cs4280_midi_output,
205 1.1 augustss cs4280_midi_getinfo,
206 1.1 augustss 0,
207 1.1 augustss };
208 1.1 augustss #endif
209 1.1 augustss
210 1.22 thorpej CFATTACH_DECL(clcs, sizeof(struct cs428x_softc),
211 1.23 thorpej cs4280_match, cs4280_attach, NULL, NULL);
212 1.1 augustss
213 1.35 thorpej static struct audio_device cs4280_device = {
214 1.1 augustss "CS4280",
215 1.1 augustss "",
216 1.1 augustss "cs4280"
217 1.1 augustss };
218 1.1 augustss
219 1.1 augustss
220 1.35 thorpej static int
221 1.51.4.1 yamt cs4280_match(device_t parent, cfdata_t match, void *aux)
222 1.1 augustss {
223 1.34 kent struct pci_attach_args *pa;
224 1.34 kent
225 1.34 kent pa = (struct pci_attach_args *)aux;
226 1.1 augustss if (PCI_VENDOR(pa->pa_id) != PCI_VENDOR_CIRRUS)
227 1.14 tacha return 0;
228 1.1 augustss if (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_CIRRUS_CS4280
229 1.1 augustss #if 0 /* I can't confirm */
230 1.1 augustss || PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_CIRRUS_CS4610
231 1.1 augustss #endif
232 1.6 augustss )
233 1.14 tacha return 1;
234 1.14 tacha return 0;
235 1.1 augustss }
236 1.1 augustss
237 1.35 thorpej static void
238 1.51.4.1 yamt cs4280_attach(device_t parent, device_t self, void *aux)
239 1.34 kent {
240 1.34 kent struct cs428x_softc *sc;
241 1.34 kent struct pci_attach_args *pa;
242 1.34 kent pci_chipset_tag_t pc;
243 1.38 jmcneill const struct cs4280_card_t *cs_card;
244 1.1 augustss char const *intrstr;
245 1.15 tacha pcireg_t reg;
246 1.1 augustss char devinfo[256];
247 1.34 kent uint32_t mem;
248 1.39 christos int error;
249 1.14 tacha
250 1.51.4.1 yamt sc = device_private(self);
251 1.34 kent pa = (struct pci_attach_args *)aux;
252 1.34 kent pc = pa->pa_pc;
253 1.25 thorpej aprint_naive(": Audio controller\n");
254 1.25 thorpej
255 1.27 itojun pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo, sizeof(devinfo));
256 1.25 thorpej aprint_normal(": %s (rev. 0x%02x)\n", devinfo,
257 1.25 thorpej PCI_REVISION(pa->pa_class));
258 1.1 augustss
259 1.38 jmcneill cs_card = cs4280_identify_card(pa);
260 1.38 jmcneill if (cs_card != NULL) {
261 1.51 dyoung aprint_normal_dev(&sc->sc_dev, "%s %s\n",
262 1.38 jmcneill pci_findvendor(cs_card->id),
263 1.38 jmcneill pci_findproduct(cs_card->id));
264 1.38 jmcneill sc->sc_flags = cs_card->flags;
265 1.38 jmcneill } else {
266 1.38 jmcneill sc->sc_flags = CS428X_FLAG_NONE;
267 1.38 jmcneill }
268 1.38 jmcneill
269 1.46 joerg sc->sc_pc = pa->pa_pc;
270 1.46 joerg sc->sc_pt = pa->pa_tag;
271 1.46 joerg
272 1.1 augustss /* Map I/O register */
273 1.34 kent if (pci_mapreg_map(pa, PCI_BA0,
274 1.14 tacha PCI_MAPREG_TYPE_MEM|PCI_MAPREG_MEM_TYPE_32BIT, 0,
275 1.14 tacha &sc->ba0t, &sc->ba0h, NULL, NULL)) {
276 1.51 dyoung aprint_error_dev(&sc->sc_dev, "can't map BA0 space\n");
277 1.1 augustss return;
278 1.1 augustss }
279 1.14 tacha if (pci_mapreg_map(pa, PCI_BA1,
280 1.14 tacha PCI_MAPREG_TYPE_MEM|PCI_MAPREG_MEM_TYPE_32BIT, 0,
281 1.14 tacha &sc->ba1t, &sc->ba1h, NULL, NULL)) {
282 1.51 dyoung aprint_error_dev(&sc->sc_dev, "can't map BA1 space\n");
283 1.1 augustss return;
284 1.1 augustss }
285 1.1 augustss
286 1.1 augustss sc->sc_dmatag = pa->pa_dmat;
287 1.1 augustss
288 1.39 christos /* power up chip */
289 1.50 dyoung if ((error = pci_activate(pa->pa_pc, pa->pa_tag, self,
290 1.39 christos pci_activate_null)) && error != EOPNOTSUPP) {
291 1.51 dyoung aprint_error_dev(&sc->sc_dev, "cannot activate %d\n", error);
292 1.39 christos return;
293 1.15 tacha }
294 1.15 tacha
295 1.1 augustss /* Enable the device (set bus master flag) */
296 1.15 tacha reg = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
297 1.1 augustss pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG,
298 1.15 tacha reg | PCI_COMMAND_MASTER_ENABLE);
299 1.1 augustss
300 1.1 augustss /* LATENCY_TIMER setting */
301 1.1 augustss mem = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_BHLC_REG);
302 1.1 augustss if ( PCI_LATTIMER(mem) < 32 ) {
303 1.1 augustss mem &= 0xffff00ff;
304 1.1 augustss mem |= 0x00002000;
305 1.1 augustss pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_BHLC_REG, mem);
306 1.1 augustss }
307 1.34 kent
308 1.40 jmcneill /* CLKRUN hack initialization */
309 1.40 jmcneill cs4280_clkrun_hack_init(sc);
310 1.40 jmcneill
311 1.1 augustss /* Map and establish the interrupt. */
312 1.46 joerg if (pci_intr_map(pa, &sc->intrh)) {
313 1.51 dyoung aprint_error_dev(&sc->sc_dev, "couldn't map interrupt\n");
314 1.1 augustss return;
315 1.1 augustss }
316 1.46 joerg intrstr = pci_intr_string(pc, sc->intrh);
317 1.1 augustss
318 1.46 joerg sc->sc_ih = pci_intr_establish(sc->sc_pc, sc->intrh, IPL_AUDIO,
319 1.46 joerg cs4280_intr, sc);
320 1.1 augustss if (sc->sc_ih == NULL) {
321 1.51 dyoung aprint_error_dev(&sc->sc_dev, "couldn't establish interrupt");
322 1.1 augustss if (intrstr != NULL)
323 1.25 thorpej aprint_normal(" at %s", intrstr);
324 1.25 thorpej aprint_normal("\n");
325 1.1 augustss return;
326 1.1 augustss }
327 1.51 dyoung aprint_normal_dev(&sc->sc_dev, "interrupting at %s\n", intrstr);
328 1.1 augustss
329 1.1 augustss /* Initialization */
330 1.2 augustss if(cs4280_init(sc, 1) != 0)
331 1.2 augustss return;
332 1.1 augustss
333 1.14 tacha sc->type = TYPE_CS4280;
334 1.14 tacha sc->halt_input = cs4280_halt_input;
335 1.14 tacha sc->halt_output = cs4280_halt_output;
336 1.14 tacha
337 1.14 tacha /* setup buffer related parameters */
338 1.14 tacha sc->dma_size = CS4280_DCHUNK;
339 1.14 tacha sc->dma_align = CS4280_DALIGN;
340 1.14 tacha sc->hw_blocksize = CS4280_ICHUNK;
341 1.14 tacha
342 1.14 tacha /* AC 97 attachment */
343 1.1 augustss sc->host_if.arg = sc;
344 1.14 tacha sc->host_if.attach = cs428x_attach_codec;
345 1.40 jmcneill sc->host_if.read = cs4280_read_codec;
346 1.40 jmcneill sc->host_if.write = cs4280_write_codec;
347 1.38 jmcneill #if 0
348 1.1 augustss sc->host_if.reset = cs4280_reset_codec;
349 1.38 jmcneill #else
350 1.38 jmcneill sc->host_if.reset = NULL;
351 1.38 jmcneill #endif
352 1.38 jmcneill sc->host_if.flags = cs4280_flags_codec;
353 1.33 kent if (ac97_attach(&sc->host_if, self) != 0) {
354 1.51 dyoung aprint_error_dev(&sc->sc_dev, "ac97_attach failed\n");
355 1.1 augustss return;
356 1.1 augustss }
357 1.1 augustss
358 1.1 augustss audio_attach_mi(&cs4280_hw_if, sc, &sc->sc_dev);
359 1.2 augustss
360 1.1 augustss #if NMIDI > 0
361 1.1 augustss midi_attach_mi(&cs4280_midi_hw_if, sc, &sc->sc_dev);
362 1.1 augustss #endif
363 1.14 tacha
364 1.48 jmcneill if (!pmf_device_register(self, cs4280_suspend, cs4280_resume))
365 1.48 jmcneill aprint_error_dev(self, "couldn't establish power handler\n");
366 1.1 augustss }
367 1.1 augustss
368 1.14 tacha /* Interrupt handling function */
369 1.35 thorpej static int
370 1.34 kent cs4280_intr(void *p)
371 1.1 augustss {
372 1.1 augustss /*
373 1.1 augustss * XXX
374 1.1 augustss *
375 1.26 wiz * Since CS4280 has only 4kB DMA buffer and
376 1.1 augustss * interrupt occurs every 2kB block, I create dummy buffer
377 1.26 wiz * which returns to audio driver and actual DMA buffer
378 1.1 augustss * using in DMA transfer.
379 1.1 augustss *
380 1.1 augustss *
381 1.1 augustss * ring buffer in audio.c is pointed by BUFADDR
382 1.1 augustss * <------ ring buffer size == 64kB ------>
383 1.34 kent * <-----> blksize == 2048*(sc->sc_[pr]count) kB
384 1.1 augustss * |= = = =|= = = =|= = = =|= = = =|= = = =|
385 1.1 augustss * | | | | | | <- call audio_intp every
386 1.1 augustss * sc->sc_[pr]_count time.
387 1.1 augustss *
388 1.26 wiz * actual DMA buffer is pointed by KERNADDR
389 1.26 wiz * <-> DMA buffer size = 4kB
390 1.1 augustss * |= =|
391 1.1 augustss *
392 1.1 augustss *
393 1.1 augustss */
394 1.34 kent struct cs428x_softc *sc;
395 1.34 kent uint32_t intr, mem;
396 1.1 augustss char * empty_dma;
397 1.34 kent int handled;
398 1.1 augustss
399 1.34 kent sc = p;
400 1.34 kent handled = 0;
401 1.7 augustss /* grab interrupt register then clear it */
402 1.1 augustss intr = BA0READ4(sc, CS4280_HISR);
403 1.7 augustss BA0WRITE4(sc, CS4280_HICR, HICR_CHGM | HICR_IEV);
404 1.7 augustss
405 1.38 jmcneill /* not for us ? */
406 1.38 jmcneill if ((intr & HISR_INTENA) == 0)
407 1.38 jmcneill return 0;
408 1.38 jmcneill
409 1.1 augustss /* Playback Interrupt */
410 1.1 augustss if (intr & HISR_PINT) {
411 1.10 perry handled = 1;
412 1.1 augustss mem = BA1READ4(sc, CS4280_PFIE);
413 1.1 augustss BA1WRITE4(sc, CS4280_PFIE, (mem & ~PFIE_PI_MASK) | PFIE_PI_DISABLE);
414 1.28 mycroft if (sc->sc_prun) {
415 1.1 augustss if ((sc->sc_pi%sc->sc_pcount) == 0)
416 1.1 augustss sc->sc_pintr(sc->sc_parg);
417 1.38 jmcneill /* copy buffer */
418 1.38 jmcneill ++sc->sc_pi;
419 1.38 jmcneill empty_dma = sc->sc_pdma->addr;
420 1.38 jmcneill if (sc->sc_pi&1)
421 1.38 jmcneill empty_dma += sc->hw_blocksize;
422 1.38 jmcneill memcpy(empty_dma, sc->sc_pn, sc->hw_blocksize);
423 1.38 jmcneill sc->sc_pn += sc->hw_blocksize;
424 1.38 jmcneill if (sc->sc_pn >= sc->sc_pe)
425 1.38 jmcneill sc->sc_pn = sc->sc_ps;
426 1.1 augustss } else {
427 1.51 dyoung aprint_error_dev(&sc->sc_dev, "unexpected play intr\n");
428 1.1 augustss }
429 1.1 augustss BA1WRITE4(sc, CS4280_PFIE, mem);
430 1.1 augustss }
431 1.1 augustss /* Capture Interrupt */
432 1.1 augustss if (intr & HISR_CINT) {
433 1.1 augustss int i;
434 1.1 augustss int16_t rdata;
435 1.34 kent
436 1.10 perry handled = 1;
437 1.1 augustss mem = BA1READ4(sc, CS4280_CIE);
438 1.1 augustss BA1WRITE4(sc, CS4280_CIE, (mem & ~CIE_CI_MASK) | CIE_CI_DISABLE);
439 1.38 jmcneill
440 1.38 jmcneill if (sc->sc_rrun) {
441 1.38 jmcneill ++sc->sc_ri;
442 1.38 jmcneill empty_dma = sc->sc_rdma->addr;
443 1.38 jmcneill if ((sc->sc_ri&1) == 0)
444 1.38 jmcneill empty_dma += sc->hw_blocksize;
445 1.38 jmcneill
446 1.38 jmcneill /*
447 1.38 jmcneill * XXX
448 1.38 jmcneill * I think this audio data conversion should be
449 1.38 jmcneill * happend in upper layer, but I put this here
450 1.38 jmcneill * since there is no conversion function available.
451 1.38 jmcneill */
452 1.38 jmcneill switch(sc->sc_rparam) {
453 1.38 jmcneill case CF_16BIT_STEREO:
454 1.38 jmcneill /* just copy it */
455 1.38 jmcneill memcpy(sc->sc_rn, empty_dma, sc->hw_blocksize);
456 1.38 jmcneill sc->sc_rn += sc->hw_blocksize;
457 1.38 jmcneill break;
458 1.38 jmcneill case CF_16BIT_MONO:
459 1.38 jmcneill for (i = 0; i < 512; i++) {
460 1.38 jmcneill rdata = *((int16_t *)empty_dma)>>1;
461 1.38 jmcneill empty_dma += 2;
462 1.38 jmcneill rdata += *((int16_t *)empty_dma)>>1;
463 1.38 jmcneill empty_dma += 2;
464 1.38 jmcneill *((int16_t *)sc->sc_rn) = rdata;
465 1.38 jmcneill sc->sc_rn += 2;
466 1.38 jmcneill }
467 1.38 jmcneill break;
468 1.38 jmcneill case CF_8BIT_STEREO:
469 1.38 jmcneill for (i = 0; i < 512; i++) {
470 1.38 jmcneill rdata = *((int16_t*)empty_dma);
471 1.38 jmcneill empty_dma += 2;
472 1.38 jmcneill *sc->sc_rn++ = rdata >> 8;
473 1.38 jmcneill rdata = *((int16_t*)empty_dma);
474 1.38 jmcneill empty_dma += 2;
475 1.38 jmcneill *sc->sc_rn++ = rdata >> 8;
476 1.38 jmcneill }
477 1.38 jmcneill break;
478 1.38 jmcneill case CF_8BIT_MONO:
479 1.38 jmcneill for (i = 0; i < 512; i++) {
480 1.38 jmcneill rdata = *((int16_t*)empty_dma) >>1;
481 1.38 jmcneill empty_dma += 2;
482 1.38 jmcneill rdata += *((int16_t*)empty_dma) >>1;
483 1.38 jmcneill empty_dma += 2;
484 1.38 jmcneill *sc->sc_rn++ = rdata >>8;
485 1.38 jmcneill }
486 1.38 jmcneill break;
487 1.38 jmcneill default:
488 1.38 jmcneill /* Should not reach here */
489 1.51 dyoung aprint_error_dev(&sc->sc_dev,
490 1.51 dyoung "unknown sc->sc_rparam: %d\n",
491 1.51 dyoung sc->sc_rparam);
492 1.1 augustss }
493 1.38 jmcneill if (sc->sc_rn >= sc->sc_re)
494 1.38 jmcneill sc->sc_rn = sc->sc_rs;
495 1.1 augustss }
496 1.1 augustss BA1WRITE4(sc, CS4280_CIE, mem);
497 1.38 jmcneill
498 1.28 mycroft if (sc->sc_rrun) {
499 1.1 augustss if ((sc->sc_ri%(sc->sc_rcount)) == 0)
500 1.1 augustss sc->sc_rintr(sc->sc_rarg);
501 1.1 augustss } else {
502 1.51 dyoung aprint_error_dev(&sc->sc_dev,
503 1.51 dyoung "unexpected record intr\n");
504 1.1 augustss }
505 1.1 augustss }
506 1.1 augustss
507 1.1 augustss #if NMIDI > 0
508 1.1 augustss /* Midi port Interrupt */
509 1.1 augustss if (intr & HISR_MIDI) {
510 1.2 augustss int data;
511 1.2 augustss
512 1.10 perry handled = 1;
513 1.34 kent DPRINTF(("i: %d: ",
514 1.2 augustss BA0READ4(sc, CS4280_MIDSR)));
515 1.2 augustss /* Read the received data */
516 1.2 augustss while ((sc->sc_iintr != NULL) &&
517 1.2 augustss ((BA0READ4(sc, CS4280_MIDSR) & MIDSR_RBE) == 0)) {
518 1.2 augustss data = BA0READ4(sc, CS4280_MIDRP) & MIDRP_MASK;
519 1.2 augustss DPRINTF(("r:%x\n",data));
520 1.2 augustss sc->sc_iintr(sc->sc_arg, data);
521 1.2 augustss }
522 1.34 kent
523 1.2 augustss /* Write the data */
524 1.2 augustss #if 1
525 1.2 augustss /* XXX:
526 1.2 augustss * It seems "Transmit Buffer Full" never activate until EOI
527 1.2 augustss * is deliverd. Shall I throw EOI top of this routine ?
528 1.2 augustss */
529 1.2 augustss if ((BA0READ4(sc, CS4280_MIDSR) & MIDSR_TBF) == 0) {
530 1.2 augustss DPRINTF(("w: "));
531 1.2 augustss if (sc->sc_ointr != NULL)
532 1.2 augustss sc->sc_ointr(sc->sc_arg);
533 1.2 augustss }
534 1.2 augustss #else
535 1.34 kent while ((sc->sc_ointr != NULL) &&
536 1.2 augustss ((BA0READ4(sc, CS4280_MIDSR) & MIDSR_TBF) == 0)) {
537 1.2 augustss DPRINTF(("w: "));
538 1.2 augustss sc->sc_ointr(sc->sc_arg);
539 1.2 augustss }
540 1.2 augustss #endif
541 1.2 augustss DPRINTF(("\n"));
542 1.1 augustss }
543 1.1 augustss #endif
544 1.7 augustss
545 1.14 tacha return handled;
546 1.1 augustss }
547 1.1 augustss
548 1.35 thorpej static int
549 1.45 christos cs4280_query_encoding(void *addr, struct audio_encoding *fp)
550 1.1 augustss {
551 1.14 tacha switch (fp->index) {
552 1.14 tacha case 0:
553 1.14 tacha strcpy(fp->name, AudioEulinear);
554 1.14 tacha fp->encoding = AUDIO_ENCODING_ULINEAR;
555 1.14 tacha fp->precision = 8;
556 1.14 tacha fp->flags = 0;
557 1.1 augustss break;
558 1.1 augustss case 1:
559 1.1 augustss strcpy(fp->name, AudioEmulaw);
560 1.1 augustss fp->encoding = AUDIO_ENCODING_ULAW;
561 1.1 augustss fp->precision = 8;
562 1.1 augustss fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
563 1.1 augustss break;
564 1.1 augustss case 2:
565 1.1 augustss strcpy(fp->name, AudioEalaw);
566 1.1 augustss fp->encoding = AUDIO_ENCODING_ALAW;
567 1.1 augustss fp->precision = 8;
568 1.1 augustss fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
569 1.1 augustss break;
570 1.1 augustss case 3:
571 1.1 augustss strcpy(fp->name, AudioEslinear);
572 1.1 augustss fp->encoding = AUDIO_ENCODING_SLINEAR;
573 1.1 augustss fp->precision = 8;
574 1.1 augustss fp->flags = 0;
575 1.1 augustss break;
576 1.1 augustss case 4:
577 1.1 augustss strcpy(fp->name, AudioEslinear_le);
578 1.1 augustss fp->encoding = AUDIO_ENCODING_SLINEAR_LE;
579 1.1 augustss fp->precision = 16;
580 1.1 augustss fp->flags = 0;
581 1.1 augustss break;
582 1.1 augustss case 5:
583 1.1 augustss strcpy(fp->name, AudioEulinear_le);
584 1.1 augustss fp->encoding = AUDIO_ENCODING_ULINEAR_LE;
585 1.1 augustss fp->precision = 16;
586 1.1 augustss fp->flags = 0;
587 1.1 augustss break;
588 1.1 augustss case 6:
589 1.1 augustss strcpy(fp->name, AudioEslinear_be);
590 1.1 augustss fp->encoding = AUDIO_ENCODING_SLINEAR_BE;
591 1.1 augustss fp->precision = 16;
592 1.1 augustss fp->flags = 0;
593 1.1 augustss break;
594 1.1 augustss case 7:
595 1.1 augustss strcpy(fp->name, AudioEulinear_be);
596 1.1 augustss fp->encoding = AUDIO_ENCODING_ULINEAR_BE;
597 1.1 augustss fp->precision = 16;
598 1.1 augustss fp->flags = 0;
599 1.1 augustss break;
600 1.1 augustss default:
601 1.14 tacha return EINVAL;
602 1.1 augustss }
603 1.14 tacha return 0;
604 1.1 augustss }
605 1.1 augustss
606 1.35 thorpej static int
607 1.45 christos cs4280_set_params(void *addr, int setmode, int usemode,
608 1.44 christos audio_params_t *play, audio_params_t *rec, stream_filter_list_t *pfil,
609 1.44 christos stream_filter_list_t *rfil)
610 1.1 augustss {
611 1.33 kent audio_params_t hw;
612 1.34 kent struct cs428x_softc *sc;
613 1.1 augustss struct audio_params *p;
614 1.33 kent stream_filter_list_t *fil;
615 1.1 augustss int mode;
616 1.1 augustss
617 1.34 kent sc = addr;
618 1.1 augustss for (mode = AUMODE_RECORD; mode != -1;
619 1.1 augustss mode = mode == AUMODE_RECORD ? AUMODE_PLAY : -1 ) {
620 1.1 augustss if ((setmode & mode) == 0)
621 1.1 augustss continue;
622 1.33 kent
623 1.1 augustss p = mode == AUMODE_PLAY ? play : rec;
624 1.33 kent
625 1.1 augustss if (p == play) {
626 1.41 christos DPRINTFN(5,("play: sample=%d precision=%d channels=%d\n",
627 1.1 augustss p->sample_rate, p->precision, p->channels));
628 1.1 augustss /* play back data format may be 8- or 16-bit and
629 1.1 augustss * either stereo or mono.
630 1.34 kent * playback rate may range from 8000Hz to 48000Hz
631 1.1 augustss */
632 1.1 augustss if (p->sample_rate < 8000 || p->sample_rate > 48000 ||
633 1.1 augustss (p->precision != 8 && p->precision != 16) ||
634 1.1 augustss (p->channels != 1 && p->channels != 2) ) {
635 1.14 tacha return EINVAL;
636 1.1 augustss }
637 1.1 augustss } else {
638 1.41 christos DPRINTFN(5,("rec: sample=%d precision=%d channels=%d\n",
639 1.1 augustss p->sample_rate, p->precision, p->channels));
640 1.1 augustss /* capture data format must be 16bit stereo
641 1.1 augustss * and sample rate range from 11025Hz to 48000Hz.
642 1.1 augustss *
643 1.1 augustss * XXX: it looks like to work with 8000Hz,
644 1.1 augustss * although data sheets say lower limit is
645 1.1 augustss * 11025 Hz.
646 1.1 augustss */
647 1.1 augustss
648 1.1 augustss if (p->sample_rate < 8000 || p->sample_rate > 48000 ||
649 1.1 augustss (p->precision != 8 && p->precision != 16) ||
650 1.1 augustss (p->channels != 1 && p->channels != 2) ) {
651 1.14 tacha return EINVAL;
652 1.1 augustss }
653 1.1 augustss }
654 1.33 kent fil = mode == AUMODE_PLAY ? pfil : rfil;
655 1.33 kent hw = *p;
656 1.33 kent hw.encoding = AUDIO_ENCODING_SLINEAR_LE;
657 1.1 augustss
658 1.1 augustss /* capturing data is slinear */
659 1.1 augustss switch (p->encoding) {
660 1.1 augustss case AUDIO_ENCODING_SLINEAR_BE:
661 1.33 kent if (mode == AUMODE_RECORD && p->precision == 16) {
662 1.33 kent fil->append(fil, swap_bytes, &hw);
663 1.1 augustss }
664 1.1 augustss break;
665 1.1 augustss case AUDIO_ENCODING_SLINEAR_LE:
666 1.1 augustss break;
667 1.1 augustss case AUDIO_ENCODING_ULINEAR_BE:
668 1.1 augustss if (mode == AUMODE_RECORD) {
669 1.33 kent fil->append(fil, p->precision == 16
670 1.33 kent ? swap_bytes_change_sign16
671 1.33 kent : change_sign8, &hw);
672 1.1 augustss }
673 1.1 augustss break;
674 1.1 augustss case AUDIO_ENCODING_ULINEAR_LE:
675 1.1 augustss if (mode == AUMODE_RECORD) {
676 1.33 kent fil->append(fil, p->precision == 16
677 1.33 kent ? change_sign16 : change_sign8,
678 1.33 kent &hw);
679 1.1 augustss }
680 1.1 augustss break;
681 1.1 augustss case AUDIO_ENCODING_ULAW:
682 1.1 augustss if (mode == AUMODE_PLAY) {
683 1.33 kent hw.precision = 16;
684 1.33 kent hw.validbits = 16;
685 1.33 kent fil->append(fil, mulaw_to_linear16, &hw);
686 1.1 augustss } else {
687 1.33 kent fil->append(fil, linear8_to_mulaw, &hw);
688 1.1 augustss }
689 1.1 augustss break;
690 1.1 augustss case AUDIO_ENCODING_ALAW:
691 1.1 augustss if (mode == AUMODE_PLAY) {
692 1.33 kent hw.precision = 16;
693 1.33 kent hw.validbits = 16;
694 1.33 kent fil->append(fil, alaw_to_linear16, &hw);
695 1.1 augustss } else {
696 1.33 kent fil->append(fil, linear8_to_alaw, &hw);
697 1.1 augustss }
698 1.1 augustss break;
699 1.1 augustss default:
700 1.14 tacha return EINVAL;
701 1.1 augustss }
702 1.1 augustss }
703 1.1 augustss
704 1.1 augustss /* set sample rate */
705 1.1 augustss cs4280_set_dac_rate(sc, play->sample_rate);
706 1.1 augustss cs4280_set_adc_rate(sc, rec->sample_rate);
707 1.14 tacha return 0;
708 1.1 augustss }
709 1.1 augustss
710 1.35 thorpej static int
711 1.34 kent cs4280_halt_output(void *addr)
712 1.1 augustss {
713 1.34 kent struct cs428x_softc *sc;
714 1.34 kent uint32_t mem;
715 1.33 kent
716 1.34 kent sc = addr;
717 1.1 augustss mem = BA1READ4(sc, CS4280_PCTL);
718 1.1 augustss BA1WRITE4(sc, CS4280_PCTL, mem & ~PCTL_MASK);
719 1.1 augustss sc->sc_prun = 0;
720 1.40 jmcneill cs4280_clkrun_hack(sc, -1);
721 1.40 jmcneill
722 1.14 tacha return 0;
723 1.1 augustss }
724 1.1 augustss
725 1.35 thorpej static int
726 1.34 kent cs4280_halt_input(void *addr)
727 1.1 augustss {
728 1.34 kent struct cs428x_softc *sc;
729 1.34 kent uint32_t mem;
730 1.1 augustss
731 1.34 kent sc = addr;
732 1.1 augustss mem = BA1READ4(sc, CS4280_CCTL);
733 1.1 augustss BA1WRITE4(sc, CS4280_CCTL, mem & ~CCTL_MASK);
734 1.1 augustss sc->sc_rrun = 0;
735 1.40 jmcneill cs4280_clkrun_hack(sc, -1);
736 1.40 jmcneill
737 1.14 tacha return 0;
738 1.1 augustss }
739 1.1 augustss
740 1.35 thorpej static int
741 1.45 christos cs4280_getdev(void *addr, struct audio_device *retp)
742 1.1 augustss {
743 1.34 kent
744 1.1 augustss *retp = cs4280_device;
745 1.14 tacha return 0;
746 1.1 augustss }
747 1.1 augustss
748 1.35 thorpej static int
749 1.34 kent cs4280_trigger_output(void *addr, void *start, void *end, int blksize,
750 1.34 kent void (*intr)(void *), void *arg,
751 1.34 kent const audio_params_t *param)
752 1.1 augustss {
753 1.34 kent struct cs428x_softc *sc;
754 1.34 kent uint32_t pfie, pctl, pdtc;
755 1.14 tacha struct cs428x_dma *p;
756 1.33 kent
757 1.34 kent sc = addr;
758 1.14 tacha #ifdef DIAGNOSTIC
759 1.14 tacha if (sc->sc_prun)
760 1.14 tacha printf("cs4280_trigger_output: already running\n");
761 1.16 tacha #endif
762 1.14 tacha sc->sc_prun = 1;
763 1.40 jmcneill cs4280_clkrun_hack(sc, 1);
764 1.1 augustss
765 1.14 tacha DPRINTF(("cs4280_trigger_output: sc=%p start=%p end=%p "
766 1.14 tacha "blksize=%d intr=%p(%p)\n", addr, start, end, blksize, intr, arg));
767 1.14 tacha sc->sc_pintr = intr;
768 1.14 tacha sc->sc_parg = arg;
769 1.1 augustss
770 1.14 tacha /* stop playback DMA */
771 1.14 tacha BA1WRITE4(sc, CS4280_PCTL, BA1READ4(sc, CS4280_PCTL) & ~PCTL_MASK);
772 1.1 augustss
773 1.14 tacha /* setup PDTC */
774 1.14 tacha pdtc = BA1READ4(sc, CS4280_PDTC);
775 1.14 tacha pdtc &= ~PDTC_MASK;
776 1.14 tacha pdtc |= CS4280_MK_PDTC(param->precision * param->channels);
777 1.14 tacha BA1WRITE4(sc, CS4280_PDTC, pdtc);
778 1.33 kent
779 1.33 kent DPRINTF(("param: precision=%d channels=%d encoding=%d\n",
780 1.33 kent param->precision, param->channels, param->encoding));
781 1.14 tacha for (p = sc->sc_dmas; p != NULL && BUFADDR(p) != start; p = p->next)
782 1.34 kent continue;
783 1.14 tacha if (p == NULL) {
784 1.14 tacha printf("cs4280_trigger_output: bad addr %p\n", start);
785 1.14 tacha return EINVAL;
786 1.14 tacha }
787 1.14 tacha if (DMAADDR(p) % sc->dma_align != 0 ) {
788 1.14 tacha printf("cs4280_trigger_output: DMAADDR(p)=0x%lx does not start"
789 1.20 augustss "4kB align\n", (ulong)DMAADDR(p));
790 1.14 tacha return EINVAL;
791 1.14 tacha }
792 1.14 tacha
793 1.14 tacha sc->sc_pcount = blksize / sc->hw_blocksize; /* sc->hw_blocksize is fixed hardware blksize*/
794 1.14 tacha sc->sc_ps = (char *)start;
795 1.14 tacha sc->sc_pe = (char *)end;
796 1.14 tacha sc->sc_pdma = p;
797 1.14 tacha sc->sc_pbuf = KERNADDR(p);
798 1.14 tacha sc->sc_pi = 0;
799 1.14 tacha sc->sc_pn = sc->sc_ps;
800 1.14 tacha if (blksize >= sc->dma_size) {
801 1.14 tacha sc->sc_pn = sc->sc_ps + sc->dma_size;
802 1.14 tacha memcpy(sc->sc_pbuf, start, sc->dma_size);
803 1.14 tacha ++sc->sc_pi;
804 1.14 tacha } else {
805 1.14 tacha sc->sc_pn = sc->sc_ps + sc->hw_blocksize;
806 1.14 tacha memcpy(sc->sc_pbuf, start, sc->hw_blocksize);
807 1.14 tacha }
808 1.14 tacha
809 1.26 wiz /* initiate playback DMA */
810 1.14 tacha BA1WRITE4(sc, CS4280_PBA, DMAADDR(p));
811 1.14 tacha
812 1.14 tacha /* set PFIE */
813 1.14 tacha pfie = BA1READ4(sc, CS4280_PFIE) & ~PFIE_MASK;
814 1.14 tacha
815 1.33 kent if (param->precision == 8)
816 1.14 tacha pfie |= PFIE_8BIT;
817 1.14 tacha if (param->channels == 1)
818 1.14 tacha pfie |= PFIE_MONO;
819 1.14 tacha
820 1.14 tacha if (param->encoding == AUDIO_ENCODING_ULINEAR_BE ||
821 1.14 tacha param->encoding == AUDIO_ENCODING_SLINEAR_BE)
822 1.14 tacha pfie |= PFIE_SWAPPED;
823 1.14 tacha if (param->encoding == AUDIO_ENCODING_ULINEAR_BE ||
824 1.14 tacha param->encoding == AUDIO_ENCODING_ULINEAR_LE)
825 1.14 tacha pfie |= PFIE_UNSIGNED;
826 1.14 tacha
827 1.14 tacha BA1WRITE4(sc, CS4280_PFIE, pfie | PFIE_PI_ENABLE);
828 1.14 tacha
829 1.16 tacha sc->sc_prate = param->sample_rate;
830 1.14 tacha cs4280_set_dac_rate(sc, param->sample_rate);
831 1.14 tacha
832 1.14 tacha pctl = BA1READ4(sc, CS4280_PCTL) & ~PCTL_MASK;
833 1.14 tacha pctl |= sc->pctl;
834 1.14 tacha BA1WRITE4(sc, CS4280_PCTL, pctl);
835 1.14 tacha return 0;
836 1.14 tacha }
837 1.1 augustss
838 1.35 thorpej static int
839 1.34 kent cs4280_trigger_input(void *addr, void *start, void *end, int blksize,
840 1.34 kent void (*intr)(void *), void *arg,
841 1.34 kent const audio_params_t *param)
842 1.14 tacha {
843 1.34 kent struct cs428x_softc *sc;
844 1.34 kent uint32_t cctl, cie;
845 1.14 tacha struct cs428x_dma *p;
846 1.33 kent
847 1.34 kent sc = addr;
848 1.14 tacha #ifdef DIAGNOSTIC
849 1.14 tacha if (sc->sc_rrun)
850 1.14 tacha printf("cs4280_trigger_input: already running\n");
851 1.16 tacha #endif
852 1.14 tacha sc->sc_rrun = 1;
853 1.40 jmcneill cs4280_clkrun_hack(sc, 1);
854 1.16 tacha
855 1.14 tacha DPRINTF(("cs4280_trigger_input: sc=%p start=%p end=%p "
856 1.14 tacha "blksize=%d intr=%p(%p)\n", addr, start, end, blksize, intr, arg));
857 1.14 tacha sc->sc_rintr = intr;
858 1.14 tacha sc->sc_rarg = arg;
859 1.14 tacha
860 1.14 tacha /* stop capture DMA */
861 1.14 tacha BA1WRITE4(sc, CS4280_CCTL, BA1READ4(sc, CS4280_CCTL) & ~CCTL_MASK);
862 1.33 kent
863 1.14 tacha for (p = sc->sc_dmas; p && BUFADDR(p) != start; p = p->next)
864 1.34 kent continue;
865 1.14 tacha if (p == NULL) {
866 1.14 tacha printf("cs4280_trigger_input: bad addr %p\n", start);
867 1.14 tacha return EINVAL;
868 1.14 tacha }
869 1.14 tacha if (DMAADDR(p) % sc->dma_align != 0) {
870 1.14 tacha printf("cs4280_trigger_input: DMAADDR(p)=0x%lx does not start"
871 1.20 augustss "4kB align\n", (ulong)DMAADDR(p));
872 1.14 tacha return EINVAL;
873 1.14 tacha }
874 1.14 tacha
875 1.14 tacha sc->sc_rcount = blksize / sc->hw_blocksize; /* sc->hw_blocksize is fixed hardware blksize*/
876 1.14 tacha sc->sc_rs = (char *)start;
877 1.14 tacha sc->sc_re = (char *)end;
878 1.14 tacha sc->sc_rdma = p;
879 1.14 tacha sc->sc_rbuf = KERNADDR(p);
880 1.14 tacha sc->sc_ri = 0;
881 1.14 tacha sc->sc_rn = sc->sc_rs;
882 1.14 tacha
883 1.26 wiz /* initiate capture DMA */
884 1.14 tacha BA1WRITE4(sc, CS4280_CBA, DMAADDR(p));
885 1.14 tacha
886 1.14 tacha /* setup format information for internal converter */
887 1.14 tacha sc->sc_rparam = 0;
888 1.14 tacha if (param->precision == 8) {
889 1.14 tacha sc->sc_rparam += CF_8BIT;
890 1.14 tacha sc->sc_rcount <<= 1;
891 1.14 tacha }
892 1.14 tacha if (param->channels == 1) {
893 1.14 tacha sc->sc_rparam += CF_MONO;
894 1.14 tacha sc->sc_rcount <<= 1;
895 1.14 tacha }
896 1.14 tacha
897 1.14 tacha /* set CIE */
898 1.14 tacha cie = BA1READ4(sc, CS4280_CIE) & ~CIE_CI_MASK;
899 1.14 tacha BA1WRITE4(sc, CS4280_CIE, cie | CIE_CI_ENABLE);
900 1.14 tacha
901 1.16 tacha sc->sc_rrate = param->sample_rate;
902 1.14 tacha cs4280_set_adc_rate(sc, param->sample_rate);
903 1.14 tacha
904 1.14 tacha cctl = BA1READ4(sc, CS4280_CCTL) & ~CCTL_MASK;
905 1.14 tacha cctl |= sc->cctl;
906 1.14 tacha BA1WRITE4(sc, CS4280_CCTL, cctl);
907 1.14 tacha return 0;
908 1.1 augustss }
909 1.1 augustss
910 1.48 jmcneill static bool
911 1.49 dyoung cs4280_suspend(device_t dv PMF_FN_ARGS)
912 1.34 kent {
913 1.48 jmcneill struct cs428x_softc *sc = device_private(dv);
914 1.14 tacha
915 1.48 jmcneill if (sc->sc_prun) {
916 1.48 jmcneill sc->sc_suspend_state.cs4280.pctl = BA1READ4(sc, CS4280_PCTL);
917 1.48 jmcneill sc->sc_suspend_state.cs4280.pfie = BA1READ4(sc, CS4280_PFIE);
918 1.48 jmcneill sc->sc_suspend_state.cs4280.pba = BA1READ4(sc, CS4280_PBA);
919 1.48 jmcneill sc->sc_suspend_state.cs4280.pdtc = BA1READ4(sc, CS4280_PDTC);
920 1.48 jmcneill DPRINTF(("pctl=0x%08x pfie=0x%08x pba=0x%08x pdtc=0x%08x\n",
921 1.48 jmcneill sc->sc_suspend_state.cs4280.pctl,
922 1.48 jmcneill sc->sc_suspend_state.cs4280.pfie,
923 1.48 jmcneill sc->sc_suspend_state.cs4280.pba,
924 1.48 jmcneill sc->sc_suspend_state.cs4280.pdtc));
925 1.48 jmcneill }
926 1.48 jmcneill
927 1.48 jmcneill /* save current capture status */
928 1.48 jmcneill if (sc->sc_rrun) {
929 1.48 jmcneill sc->sc_suspend_state.cs4280.cctl = BA1READ4(sc, CS4280_CCTL);
930 1.48 jmcneill sc->sc_suspend_state.cs4280.cie = BA1READ4(sc, CS4280_CIE);
931 1.48 jmcneill sc->sc_suspend_state.cs4280.cba = BA1READ4(sc, CS4280_CBA);
932 1.48 jmcneill DPRINTF(("cctl=0x%08x cie=0x%08x cba=0x%08x\n",
933 1.48 jmcneill sc->sc_suspend_state.cs4280.cctl,
934 1.48 jmcneill sc->sc_suspend_state.cs4280.cie,
935 1.48 jmcneill sc->sc_suspend_state.cs4280.cba));
936 1.48 jmcneill }
937 1.14 tacha
938 1.48 jmcneill /* Stop DMA */
939 1.48 jmcneill BA1WRITE4(sc, CS4280_PCTL, sc->sc_suspend_state.cs4280.pctl & ~PCTL_MASK);
940 1.48 jmcneill BA1WRITE4(sc, CS4280_CCTL, BA1READ4(sc, CS4280_CCTL) & ~CCTL_MASK);
941 1.16 tacha
942 1.48 jmcneill return true;
943 1.48 jmcneill }
944 1.16 tacha
945 1.48 jmcneill static bool
946 1.49 dyoung cs4280_resume(device_t dv PMF_FN_ARGS)
947 1.48 jmcneill {
948 1.48 jmcneill struct cs428x_softc *sc = device_private(dv);
949 1.46 joerg
950 1.48 jmcneill cs4280_init(sc, 0);
951 1.38 jmcneill #if 0
952 1.48 jmcneill cs4280_reset_codec(sc);
953 1.38 jmcneill #endif
954 1.48 jmcneill /* restore ac97 registers */
955 1.48 jmcneill (*sc->codec_if->vtbl->restore_ports)(sc->codec_if);
956 1.16 tacha
957 1.48 jmcneill /* restore DMA related status */
958 1.48 jmcneill if(sc->sc_prun) {
959 1.48 jmcneill DPRINTF(("pctl=0x%08x pfie=0x%08x pba=0x%08x pdtc=0x%08x\n",
960 1.48 jmcneill sc->sc_suspend_state.cs4280.pctl,
961 1.48 jmcneill sc->sc_suspend_state.cs4280.pfie,
962 1.48 jmcneill sc->sc_suspend_state.cs4280.pba,
963 1.48 jmcneill sc->sc_suspend_state.cs4280.pdtc));
964 1.48 jmcneill cs4280_set_dac_rate(sc, sc->sc_prate);
965 1.48 jmcneill BA1WRITE4(sc, CS4280_PDTC, sc->sc_suspend_state.cs4280.pdtc);
966 1.48 jmcneill BA1WRITE4(sc, CS4280_PBA, sc->sc_suspend_state.cs4280.pba);
967 1.48 jmcneill BA1WRITE4(sc, CS4280_PFIE, sc->sc_suspend_state.cs4280.pfie);
968 1.48 jmcneill BA1WRITE4(sc, CS4280_PCTL, sc->sc_suspend_state.cs4280.pctl);
969 1.48 jmcneill }
970 1.48 jmcneill
971 1.48 jmcneill if (sc->sc_rrun) {
972 1.48 jmcneill DPRINTF(("cctl=0x%08x cie=0x%08x cba=0x%08x\n",
973 1.48 jmcneill sc->sc_suspend_state.cs4280.cctl,
974 1.48 jmcneill sc->sc_suspend_state.cs4280.cie,
975 1.48 jmcneill sc->sc_suspend_state.cs4280.cba));
976 1.48 jmcneill cs4280_set_adc_rate(sc, sc->sc_rrate);
977 1.48 jmcneill BA1WRITE4(sc, CS4280_CBA, sc->sc_suspend_state.cs4280.cba);
978 1.48 jmcneill BA1WRITE4(sc, CS4280_CIE, sc->sc_suspend_state.cs4280.cie);
979 1.48 jmcneill BA1WRITE4(sc, CS4280_CCTL, sc->sc_suspend_state.cs4280.cctl);
980 1.48 jmcneill }
981 1.16 tacha
982 1.48 jmcneill return true;
983 1.14 tacha }
984 1.14 tacha
985 1.40 jmcneill static int
986 1.40 jmcneill cs4280_read_codec(void *addr, u_int8_t reg, u_int16_t *result)
987 1.40 jmcneill {
988 1.40 jmcneill struct cs428x_softc *sc = addr;
989 1.40 jmcneill int rv;
990 1.40 jmcneill
991 1.40 jmcneill cs4280_clkrun_hack(sc, 1);
992 1.40 jmcneill rv = cs428x_read_codec(addr, reg, result);
993 1.40 jmcneill cs4280_clkrun_hack(sc, -1);
994 1.40 jmcneill
995 1.40 jmcneill return rv;
996 1.40 jmcneill }
997 1.40 jmcneill
998 1.40 jmcneill static int
999 1.40 jmcneill cs4280_write_codec(void *addr, u_int8_t reg, u_int16_t data)
1000 1.40 jmcneill {
1001 1.40 jmcneill struct cs428x_softc *sc = addr;
1002 1.40 jmcneill int rv;
1003 1.40 jmcneill
1004 1.40 jmcneill cs4280_clkrun_hack(sc, 1);
1005 1.40 jmcneill rv = cs428x_write_codec(addr, reg, data);
1006 1.40 jmcneill cs4280_clkrun_hack(sc, -1);
1007 1.40 jmcneill
1008 1.40 jmcneill return rv;
1009 1.40 jmcneill }
1010 1.40 jmcneill
1011 1.38 jmcneill #if 0 /* XXX buggy and not required */
1012 1.14 tacha /* control AC97 codec */
1013 1.35 thorpej static int
1014 1.14 tacha cs4280_reset_codec(void *addr)
1015 1.14 tacha {
1016 1.14 tacha struct cs428x_softc *sc;
1017 1.14 tacha int n;
1018 1.14 tacha
1019 1.14 tacha sc = addr;
1020 1.14 tacha
1021 1.14 tacha /* Reset codec */
1022 1.14 tacha BA0WRITE4(sc, CS428X_ACCTL, 0);
1023 1.14 tacha delay(100); /* delay 100us */
1024 1.14 tacha BA0WRITE4(sc, CS428X_ACCTL, ACCTL_RSTN);
1025 1.14 tacha
1026 1.34 kent /*
1027 1.14 tacha * It looks like we do the following procedure, too
1028 1.14 tacha */
1029 1.14 tacha
1030 1.14 tacha /* Enable AC-link sync generation */
1031 1.14 tacha BA0WRITE4(sc, CS428X_ACCTL, ACCTL_ESYN | ACCTL_RSTN);
1032 1.14 tacha delay(50*1000); /* XXX delay 50ms */
1033 1.34 kent
1034 1.14 tacha /* Assert valid frame signal */
1035 1.14 tacha BA0WRITE4(sc, CS428X_ACCTL, ACCTL_VFRM | ACCTL_ESYN | ACCTL_RSTN);
1036 1.14 tacha
1037 1.14 tacha /* Wait for valid AC97 input slot */
1038 1.14 tacha n = 0;
1039 1.14 tacha while ((BA0READ4(sc, CS428X_ACISV) & (ACISV_ISV3 | ACISV_ISV4)) !=
1040 1.14 tacha (ACISV_ISV3 | ACISV_ISV4)) {
1041 1.14 tacha delay(1000);
1042 1.14 tacha if (++n > 1000) {
1043 1.14 tacha printf("reset_codec: AC97 inputs slot ready timeout\n");
1044 1.30 kent return ETIMEDOUT;
1045 1.14 tacha }
1046 1.14 tacha }
1047 1.38 jmcneill
1048 1.38 jmcneill return 0;
1049 1.38 jmcneill }
1050 1.38 jmcneill #endif
1051 1.38 jmcneill
1052 1.38 jmcneill static enum ac97_host_flags cs4280_flags_codec(void *addr)
1053 1.38 jmcneill {
1054 1.38 jmcneill struct cs428x_softc *sc;
1055 1.38 jmcneill
1056 1.38 jmcneill sc = addr;
1057 1.38 jmcneill if (sc->sc_flags & CS428X_FLAG_INVAC97EAMP)
1058 1.38 jmcneill return AC97_HOST_INVERTED_EAMP;
1059 1.38 jmcneill
1060 1.30 kent return 0;
1061 1.14 tacha }
1062 1.14 tacha
1063 1.14 tacha /* Internal functions */
1064 1.14 tacha
1065 1.38 jmcneill static const struct cs4280_card_t *
1066 1.38 jmcneill cs4280_identify_card(struct pci_attach_args *pa)
1067 1.38 jmcneill {
1068 1.38 jmcneill pcireg_t idreg;
1069 1.38 jmcneill u_int16_t i;
1070 1.38 jmcneill
1071 1.38 jmcneill idreg = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_SUBSYS_ID_REG);
1072 1.38 jmcneill for (i = 0; i < CS4280_CARDS_SIZE; i++) {
1073 1.38 jmcneill if (idreg == cs4280_cards[i].id)
1074 1.38 jmcneill return &cs4280_cards[i];
1075 1.38 jmcneill }
1076 1.38 jmcneill
1077 1.38 jmcneill return NULL;
1078 1.38 jmcneill }
1079 1.38 jmcneill
1080 1.40 jmcneill static int
1081 1.40 jmcneill cs4280_piix4_match(struct pci_attach_args *pa)
1082 1.40 jmcneill {
1083 1.40 jmcneill if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_INTEL &&
1084 1.40 jmcneill PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_INTEL_82371AB_PMC) {
1085 1.40 jmcneill return 1;
1086 1.40 jmcneill }
1087 1.40 jmcneill
1088 1.40 jmcneill return 0;
1089 1.40 jmcneill }
1090 1.40 jmcneill
1091 1.40 jmcneill static void
1092 1.40 jmcneill cs4280_clkrun_hack(struct cs428x_softc *sc, int change)
1093 1.40 jmcneill {
1094 1.40 jmcneill uint16_t control, val;
1095 1.40 jmcneill
1096 1.40 jmcneill if (!(sc->sc_flags & CS428X_FLAG_CLKRUNHACK))
1097 1.40 jmcneill return;
1098 1.40 jmcneill
1099 1.40 jmcneill sc->sc_active += change;
1100 1.40 jmcneill val = control = bus_space_read_2(sc->sc_pm_iot, sc->sc_pm_ioh, 0x10);
1101 1.40 jmcneill if (!sc->sc_active)
1102 1.40 jmcneill val |= 0x2000;
1103 1.40 jmcneill else
1104 1.40 jmcneill val &= ~0x2000;
1105 1.40 jmcneill if (val != control)
1106 1.40 jmcneill bus_space_write_2(sc->sc_pm_iot, sc->sc_pm_ioh, 0x10, val);
1107 1.40 jmcneill }
1108 1.40 jmcneill
1109 1.40 jmcneill static void
1110 1.40 jmcneill cs4280_clkrun_hack_init(struct cs428x_softc *sc)
1111 1.40 jmcneill {
1112 1.40 jmcneill struct pci_attach_args smbuspa;
1113 1.40 jmcneill uint16_t reg;
1114 1.40 jmcneill pcireg_t port;
1115 1.40 jmcneill
1116 1.40 jmcneill if (!(sc->sc_flags & CS428X_FLAG_CLKRUNHACK))
1117 1.40 jmcneill return;
1118 1.40 jmcneill
1119 1.40 jmcneill if (pci_find_device(&smbuspa, cs4280_piix4_match)) {
1120 1.40 jmcneill sc->sc_active = 0;
1121 1.51 dyoung aprint_normal_dev(&sc->sc_dev, "enabling CLKRUN hack\n");
1122 1.40 jmcneill
1123 1.40 jmcneill reg = pci_conf_read(smbuspa.pa_pc, smbuspa.pa_tag, 0x40);
1124 1.40 jmcneill port = reg & 0xffc0;
1125 1.51 dyoung aprint_normal_dev(&sc->sc_dev, "power management port 0x%x\n",
1126 1.40 jmcneill port);
1127 1.40 jmcneill
1128 1.40 jmcneill sc->sc_pm_iot = smbuspa.pa_iot;
1129 1.40 jmcneill if (bus_space_map(sc->sc_pm_iot, port, 0x20 /* XXX */, 0,
1130 1.40 jmcneill &sc->sc_pm_ioh) == 0)
1131 1.40 jmcneill return;
1132 1.40 jmcneill }
1133 1.40 jmcneill
1134 1.40 jmcneill /* handle error */
1135 1.40 jmcneill sc->sc_flags &= ~CS428X_FLAG_CLKRUNHACK;
1136 1.51 dyoung aprint_normal_dev(&sc->sc_dev, "disabling CLKRUN hack\n");
1137 1.40 jmcneill }
1138 1.40 jmcneill
1139 1.35 thorpej static void
1140 1.34 kent cs4280_set_adc_rate(struct cs428x_softc *sc, int rate)
1141 1.14 tacha {
1142 1.14 tacha /* calculate capture rate:
1143 1.14 tacha *
1144 1.14 tacha * capture_coefficient_increment = -round(rate*128*65536/48000;
1145 1.14 tacha * capture_phase_increment = floor(48000*65536*1024/rate);
1146 1.14 tacha * cx = round(48000*65536*1024 - capture_phase_increment*rate);
1147 1.14 tacha * cy = floor(cx/200);
1148 1.14 tacha * capture_sample_rate_correction = cx - 200*cy;
1149 1.14 tacha * capture_delay = ceil(24*48000/rate);
1150 1.14 tacha * capture_num_triplets = floor(65536*rate/24000);
1151 1.14 tacha * capture_group_length = 24000/GCD(rate, 24000);
1152 1.14 tacha * where GCD means "Greatest Common Divisor".
1153 1.14 tacha *
1154 1.14 tacha * capture_coefficient_increment, capture_phase_increment and
1155 1.14 tacha * capture_num_triplets are 32-bit signed quantities.
1156 1.14 tacha * capture_sample_rate_correction and capture_group_length are
1157 1.14 tacha * 16-bit signed quantities.
1158 1.14 tacha * capture_delay is a 14-bit unsigned quantity.
1159 1.14 tacha */
1160 1.34 kent uint32_t cci, cpi, cnt, cx, cy, tmp1;
1161 1.34 kent uint16_t csrc, cgl, cdlay;
1162 1.34 kent
1163 1.14 tacha /* XXX
1164 1.14 tacha * Even though, embedded_audio_spec says capture rate range 11025 to
1165 1.14 tacha * 48000, dhwiface.cpp says,
1166 1.14 tacha *
1167 1.14 tacha * "We can only decimate by up to a factor of 1/9th the hardware rate.
1168 1.14 tacha * Return an error if an attempt is made to stray outside that limit."
1169 1.14 tacha *
1170 1.14 tacha * so assume range as 48000/9 to 48000
1171 1.34 kent */
1172 1.14 tacha
1173 1.14 tacha if (rate < 8000)
1174 1.14 tacha rate = 8000;
1175 1.14 tacha if (rate > 48000)
1176 1.14 tacha rate = 48000;
1177 1.14 tacha
1178 1.14 tacha cx = rate << 16;
1179 1.14 tacha cci = cx / 48000;
1180 1.14 tacha cx -= cci * 48000;
1181 1.14 tacha cx <<= 7;
1182 1.14 tacha cci <<= 7;
1183 1.14 tacha cci += cx / 48000;
1184 1.14 tacha cci = - cci;
1185 1.14 tacha
1186 1.14 tacha cx = 48000 << 16;
1187 1.14 tacha cpi = cx / rate;
1188 1.14 tacha cx -= cpi * rate;
1189 1.14 tacha cx <<= 10;
1190 1.14 tacha cpi <<= 10;
1191 1.14 tacha cy = cx / rate;
1192 1.14 tacha cpi += cy;
1193 1.14 tacha cx -= cy * rate;
1194 1.14 tacha
1195 1.14 tacha cy = cx / 200;
1196 1.14 tacha csrc = cx - 200*cy;
1197 1.14 tacha
1198 1.14 tacha cdlay = ((48000 * 24) + rate - 1) / rate;
1199 1.14 tacha #if 0
1200 1.14 tacha cdlay &= 0x3fff; /* make sure cdlay is 14-bit */
1201 1.14 tacha #endif
1202 1.14 tacha
1203 1.14 tacha cnt = rate << 16;
1204 1.14 tacha cnt /= 24000;
1205 1.14 tacha
1206 1.14 tacha cgl = 1;
1207 1.14 tacha for (tmp1 = 2; tmp1 <= 64; tmp1 *= 2) {
1208 1.14 tacha if (((rate / tmp1) * tmp1) != rate)
1209 1.14 tacha cgl *= 2;
1210 1.14 tacha }
1211 1.14 tacha if (((rate / 3) * 3) != rate)
1212 1.14 tacha cgl *= 3;
1213 1.14 tacha for (tmp1 = 5; tmp1 <= 125; tmp1 *= 5) {
1214 1.34 kent if (((rate / tmp1) * tmp1) != rate)
1215 1.14 tacha cgl *= 5;
1216 1.14 tacha }
1217 1.14 tacha #if 0
1218 1.14 tacha /* XXX what manual says */
1219 1.14 tacha tmp1 = BA1READ4(sc, CS4280_CSRC) & ~CSRC_MASK;
1220 1.14 tacha tmp1 |= csrc<<16;
1221 1.14 tacha BA1WRITE4(sc, CS4280_CSRC, tmp1);
1222 1.14 tacha #else
1223 1.14 tacha /* suggested by cs461x.c (ALSA driver) */
1224 1.14 tacha BA1WRITE4(sc, CS4280_CSRC, CS4280_MK_CSRC(csrc, cy));
1225 1.14 tacha #endif
1226 1.14 tacha
1227 1.14 tacha #if 0
1228 1.14 tacha /* I am confused. The sample rate calculation section says
1229 1.14 tacha * cci *is* 32-bit signed quantity but in the parameter description
1230 1.14 tacha * section, CCI only assigned 16bit.
1231 1.14 tacha * I believe size of the variable.
1232 1.14 tacha */
1233 1.14 tacha tmp1 = BA1READ4(sc, CS4280_CCI) & ~CCI_MASK;
1234 1.14 tacha tmp1 |= cci<<16;
1235 1.14 tacha BA1WRITE4(sc, CS4280_CCI, tmp1);
1236 1.14 tacha #else
1237 1.14 tacha BA1WRITE4(sc, CS4280_CCI, cci);
1238 1.14 tacha #endif
1239 1.14 tacha
1240 1.14 tacha tmp1 = BA1READ4(sc, CS4280_CD) & ~CD_MASK;
1241 1.14 tacha tmp1 |= cdlay <<18;
1242 1.14 tacha BA1WRITE4(sc, CS4280_CD, tmp1);
1243 1.34 kent
1244 1.14 tacha BA1WRITE4(sc, CS4280_CPI, cpi);
1245 1.34 kent
1246 1.14 tacha tmp1 = BA1READ4(sc, CS4280_CGL) & ~CGL_MASK;
1247 1.14 tacha tmp1 |= cgl;
1248 1.14 tacha BA1WRITE4(sc, CS4280_CGL, tmp1);
1249 1.14 tacha
1250 1.14 tacha BA1WRITE4(sc, CS4280_CNT, cnt);
1251 1.34 kent
1252 1.14 tacha tmp1 = BA1READ4(sc, CS4280_CGC) & ~CGC_MASK;
1253 1.14 tacha tmp1 |= cgl;
1254 1.14 tacha BA1WRITE4(sc, CS4280_CGC, tmp1);
1255 1.14 tacha }
1256 1.14 tacha
1257 1.35 thorpej static void
1258 1.34 kent cs4280_set_dac_rate(struct cs428x_softc *sc, int rate)
1259 1.14 tacha {
1260 1.14 tacha /*
1261 1.14 tacha * playback rate may range from 8000Hz to 48000Hz
1262 1.14 tacha *
1263 1.14 tacha * play_phase_increment = floor(rate*65536*1024/48000)
1264 1.14 tacha * px = round(rate*65536*1024 - play_phase_incremnt*48000)
1265 1.14 tacha * py=floor(px/200)
1266 1.14 tacha * play_sample_rate_correction = px - 200*py
1267 1.14 tacha *
1268 1.14 tacha * play_phase_increment is a 32bit signed quantity.
1269 1.14 tacha * play_sample_rate_correction is a 16bit signed quantity.
1270 1.1 augustss */
1271 1.14 tacha int32_t ppi;
1272 1.14 tacha int16_t psrc;
1273 1.34 kent uint32_t px, py;
1274 1.34 kent
1275 1.14 tacha if (rate < 8000)
1276 1.14 tacha rate = 8000;
1277 1.14 tacha if (rate > 48000)
1278 1.14 tacha rate = 48000;
1279 1.14 tacha px = rate << 16;
1280 1.14 tacha ppi = px/48000;
1281 1.14 tacha px -= ppi*48000;
1282 1.14 tacha ppi <<= 10;
1283 1.14 tacha px <<= 10;
1284 1.14 tacha py = px / 48000;
1285 1.14 tacha ppi += py;
1286 1.14 tacha px -= py*48000;
1287 1.14 tacha py = px/200;
1288 1.14 tacha px -= py*200;
1289 1.14 tacha psrc = px;
1290 1.14 tacha #if 0
1291 1.14 tacha /* what manual says */
1292 1.14 tacha px = BA1READ4(sc, CS4280_PSRC) & ~PSRC_MASK;
1293 1.14 tacha BA1WRITE4(sc, CS4280_PSRC,
1294 1.14 tacha ( ((psrc<<16) & PSRC_MASK) | px ));
1295 1.34 kent #else
1296 1.14 tacha /* suggested by cs461x.c (ALSA driver) */
1297 1.14 tacha BA1WRITE4(sc, CS4280_PSRC, CS4280_MK_PSRC(psrc,py));
1298 1.14 tacha #endif
1299 1.14 tacha BA1WRITE4(sc, CS4280_PPI, ppi);
1300 1.14 tacha }
1301 1.14 tacha
1302 1.38 jmcneill /* Download Processor Code and Data image */
1303 1.35 thorpej static int
1304 1.34 kent cs4280_download(struct cs428x_softc *sc, const uint32_t *src,
1305 1.34 kent uint32_t offset, uint32_t len)
1306 1.14 tacha {
1307 1.34 kent uint32_t ctr;
1308 1.14 tacha #if CS4280_DEBUG > 10
1309 1.34 kent uint32_t con, data;
1310 1.34 kent uint8_t c0, c1, c2, c3;
1311 1.14 tacha #endif
1312 1.34 kent if ((offset & 3) || (len & 3))
1313 1.14 tacha return -1;
1314 1.1 augustss
1315 1.34 kent len /= sizeof(uint32_t);
1316 1.14 tacha for (ctr = 0; ctr < len; ctr++) {
1317 1.14 tacha /* XXX:
1318 1.14 tacha * I cannot confirm this is the right thing or not
1319 1.14 tacha * on BIG-ENDIAN machines.
1320 1.14 tacha */
1321 1.14 tacha BA1WRITE4(sc, offset+ctr*4, htole32(*(src+ctr)));
1322 1.14 tacha #if CS4280_DEBUG > 10
1323 1.14 tacha data = htole32(*(src+ctr));
1324 1.14 tacha c0 = bus_space_read_1(sc->ba1t, sc->ba1h, offset+ctr*4+0);
1325 1.14 tacha c1 = bus_space_read_1(sc->ba1t, sc->ba1h, offset+ctr*4+1);
1326 1.14 tacha c2 = bus_space_read_1(sc->ba1t, sc->ba1h, offset+ctr*4+2);
1327 1.14 tacha c3 = bus_space_read_1(sc->ba1t, sc->ba1h, offset+ctr*4+3);
1328 1.34 kent con = (c3 << 24) | (c2 << 16) | (c1 << 8) | c0;
1329 1.14 tacha if (data != con ) {
1330 1.14 tacha printf("0x%06x: write=0x%08x read=0x%08x\n",
1331 1.14 tacha offset+ctr*4, data, con);
1332 1.14 tacha return -1;
1333 1.14 tacha }
1334 1.14 tacha #endif
1335 1.1 augustss }
1336 1.14 tacha return 0;
1337 1.1 augustss }
1338 1.1 augustss
1339 1.35 thorpej static int
1340 1.34 kent cs4280_download_image(struct cs428x_softc *sc)
1341 1.1 augustss {
1342 1.14 tacha int idx, err;
1343 1.34 kent uint32_t offset = 0;
1344 1.14 tacha
1345 1.14 tacha err = 0;
1346 1.14 tacha for (idx = 0; idx < BA1_MEMORY_COUNT; ++idx) {
1347 1.14 tacha err = cs4280_download(sc, &BA1Struct.map[offset],
1348 1.14 tacha BA1Struct.memory[idx].offset,
1349 1.14 tacha BA1Struct.memory[idx].size);
1350 1.14 tacha if (err != 0) {
1351 1.51 dyoung aprint_error_dev(&sc->sc_dev,
1352 1.51 dyoung "load_image failed at %d\n", idx);
1353 1.14 tacha return -1;
1354 1.1 augustss }
1355 1.34 kent offset += BA1Struct.memory[idx].size / sizeof(uint32_t);
1356 1.1 augustss }
1357 1.14 tacha return err;
1358 1.1 augustss }
1359 1.1 augustss
1360 1.14 tacha /* Processor Soft Reset */
1361 1.35 thorpej static void
1362 1.34 kent cs4280_reset(void *sc_)
1363 1.1 augustss {
1364 1.34 kent struct cs428x_softc *sc;
1365 1.1 augustss
1366 1.34 kent sc = sc_;
1367 1.14 tacha /* Set RSTSP bit in SPCR (also clear RUN, RUNFR, and DRQEN) */
1368 1.14 tacha BA1WRITE4(sc, CS4280_SPCR, SPCR_RSTSP);
1369 1.14 tacha delay(100);
1370 1.14 tacha /* Clear RSTSP bit in SPCR */
1371 1.14 tacha BA1WRITE4(sc, CS4280_SPCR, 0);
1372 1.14 tacha /* enable DMA reqest */
1373 1.14 tacha BA1WRITE4(sc, CS4280_SPCR, SPCR_DRQEN);
1374 1.1 augustss }
1375 1.1 augustss
1376 1.35 thorpej static int
1377 1.34 kent cs4280_init(struct cs428x_softc *sc, int init)
1378 1.1 augustss {
1379 1.1 augustss int n;
1380 1.34 kent uint32_t mem;
1381 1.40 jmcneill int rv;
1382 1.40 jmcneill
1383 1.40 jmcneill rv = 1;
1384 1.40 jmcneill cs4280_clkrun_hack(sc, 1);
1385 1.1 augustss
1386 1.1 augustss /* Start PLL out in known state */
1387 1.1 augustss BA0WRITE4(sc, CS4280_CLKCR1, 0);
1388 1.1 augustss /* Start serial ports out in known state */
1389 1.1 augustss BA0WRITE4(sc, CS4280_SERMC1, 0);
1390 1.1 augustss
1391 1.1 augustss /* Specify type of CODEC */
1392 1.6 augustss /* XXX should not be here */
1393 1.1 augustss #define SERACC_CODEC_TYPE_1_03
1394 1.1 augustss #ifdef SERACC_CODEC_TYPE_1_03
1395 1.1 augustss BA0WRITE4(sc, CS4280_SERACC, SERACC_HSP | SERACC_CTYPE_1_03); /* AC 97 1.03 */
1396 1.1 augustss #else
1397 1.1 augustss BA0WRITE4(sc, CS4280_SERACC, SERACC_HSP | SERACC_CTYPE_2_0); /* AC 97 2.0 */
1398 1.1 augustss #endif
1399 1.1 augustss
1400 1.1 augustss /* Reset codec */
1401 1.14 tacha BA0WRITE4(sc, CS428X_ACCTL, 0);
1402 1.1 augustss delay(100); /* delay 100us */
1403 1.14 tacha BA0WRITE4(sc, CS428X_ACCTL, ACCTL_RSTN);
1404 1.34 kent
1405 1.1 augustss /* Enable AC-link sync generation */
1406 1.14 tacha BA0WRITE4(sc, CS428X_ACCTL, ACCTL_ESYN | ACCTL_RSTN);
1407 1.1 augustss delay(50*1000); /* delay 50ms */
1408 1.1 augustss
1409 1.1 augustss /* Set the serial port timing configuration */
1410 1.1 augustss BA0WRITE4(sc, CS4280_SERMC1, SERMC1_PTC_AC97);
1411 1.34 kent
1412 1.1 augustss /* Setup clock control */
1413 1.1 augustss BA0WRITE4(sc, CS4280_PLLCC, PLLCC_CDR_STATE|PLLCC_LPF_STATE);
1414 1.1 augustss BA0WRITE4(sc, CS4280_PLLM, PLLM_STATE);
1415 1.1 augustss BA0WRITE4(sc, CS4280_CLKCR2, CLKCR2_PDIVS_8);
1416 1.34 kent
1417 1.1 augustss /* Power up the PLL */
1418 1.1 augustss BA0WRITE4(sc, CS4280_CLKCR1, CLKCR1_PLLP);
1419 1.1 augustss delay(50*1000); /* delay 50ms */
1420 1.34 kent
1421 1.1 augustss /* Turn on clock */
1422 1.7 augustss mem = BA0READ4(sc, CS4280_CLKCR1) | CLKCR1_SWCE;
1423 1.7 augustss BA0WRITE4(sc, CS4280_CLKCR1, mem);
1424 1.34 kent
1425 1.2 augustss /* Set the serial port FIFO pointer to the
1426 1.2 augustss * first sample in FIFO. (not documented) */
1427 1.1 augustss cs4280_clear_fifos(sc);
1428 1.2 augustss
1429 1.2 augustss #if 0
1430 1.2 augustss /* Set the serial port FIFO pointer to the first sample in the FIFO */
1431 1.2 augustss BA0WRITE4(sc, CS4280_SERBSP, 0);
1432 1.1 augustss #endif
1433 1.34 kent
1434 1.1 augustss /* Configure the serial port */
1435 1.1 augustss BA0WRITE4(sc, CS4280_SERC1, SERC1_SO1EN | SERC1_SO1F_AC97);
1436 1.1 augustss BA0WRITE4(sc, CS4280_SERC2, SERC2_SI1EN | SERC2_SI1F_AC97);
1437 1.1 augustss BA0WRITE4(sc, CS4280_SERMC1, SERMC1_MSPE | SERMC1_PTC_AC97);
1438 1.34 kent
1439 1.1 augustss /* Wait for CODEC ready */
1440 1.1 augustss n = 0;
1441 1.14 tacha while ((BA0READ4(sc, CS428X_ACSTS) & ACSTS_CRDY) == 0) {
1442 1.2 augustss delay(125);
1443 1.2 augustss if (++n > 1000) {
1444 1.51 dyoung aprint_error_dev(&sc->sc_dev, "codec ready timeout\n");
1445 1.40 jmcneill goto exit;
1446 1.1 augustss }
1447 1.1 augustss }
1448 1.1 augustss
1449 1.1 augustss /* Assert valid frame signal */
1450 1.14 tacha BA0WRITE4(sc, CS428X_ACCTL, ACCTL_VFRM | ACCTL_ESYN | ACCTL_RSTN);
1451 1.1 augustss
1452 1.1 augustss /* Wait for valid AC97 input slot */
1453 1.1 augustss n = 0;
1454 1.14 tacha while ((BA0READ4(sc, CS428X_ACISV) & (ACISV_ISV3 | ACISV_ISV4)) !=
1455 1.7 augustss (ACISV_ISV3 | ACISV_ISV4)) {
1456 1.1 augustss delay(1000);
1457 1.1 augustss if (++n > 1000) {
1458 1.1 augustss printf("AC97 inputs slot ready timeout\n");
1459 1.40 jmcneill goto exit;
1460 1.1 augustss }
1461 1.1 augustss }
1462 1.34 kent
1463 1.1 augustss /* Set AC97 output slot valid signals */
1464 1.14 tacha BA0WRITE4(sc, CS428X_ACOSV, ACOSV_SLV3 | ACOSV_SLV4);
1465 1.1 augustss
1466 1.1 augustss /* reset the processor */
1467 1.1 augustss cs4280_reset(sc);
1468 1.1 augustss
1469 1.1 augustss /* Download the image to the processor */
1470 1.1 augustss if (cs4280_download_image(sc) != 0) {
1471 1.51 dyoung aprint_error_dev(&sc->sc_dev, "image download error\n");
1472 1.40 jmcneill goto exit;
1473 1.1 augustss }
1474 1.1 augustss
1475 1.1 augustss /* Save playback parameter and then write zero.
1476 1.1 augustss * this ensures that DMA doesn't immediately occur upon
1477 1.34 kent * starting the processor core
1478 1.1 augustss */
1479 1.1 augustss mem = BA1READ4(sc, CS4280_PCTL);
1480 1.1 augustss sc->pctl = mem & PCTL_MASK; /* save startup value */
1481 1.16 tacha BA1WRITE4(sc, CS4280_PCTL, mem & ~PCTL_MASK);
1482 1.16 tacha if (init != 0)
1483 1.16 tacha sc->sc_prun = 0;
1484 1.34 kent
1485 1.1 augustss /* Save capture parameter and then write zero.
1486 1.1 augustss * this ensures that DMA doesn't immediately occur upon
1487 1.34 kent * starting the processor core
1488 1.1 augustss */
1489 1.1 augustss mem = BA1READ4(sc, CS4280_CCTL);
1490 1.1 augustss sc->cctl = mem & CCTL_MASK; /* save startup value */
1491 1.16 tacha BA1WRITE4(sc, CS4280_CCTL, mem & ~CCTL_MASK);
1492 1.16 tacha if (init != 0)
1493 1.16 tacha sc->sc_rrun = 0;
1494 1.1 augustss
1495 1.1 augustss /* Processor Startup Procedure */
1496 1.1 augustss BA1WRITE4(sc, CS4280_FRMT, FRMT_FTV);
1497 1.1 augustss BA1WRITE4(sc, CS4280_SPCR, SPCR_RUN | SPCR_RUNFR | SPCR_DRQEN);
1498 1.1 augustss
1499 1.1 augustss /* Monitor RUNFR bit in SPCR for 1 to 0 transition */
1500 1.1 augustss n = 0;
1501 1.1 augustss while (BA1READ4(sc, CS4280_SPCR) & SPCR_RUNFR) {
1502 1.1 augustss delay(10);
1503 1.1 augustss if (++n > 1000) {
1504 1.1 augustss printf("SPCR 1->0 transition timeout\n");
1505 1.40 jmcneill goto exit;
1506 1.1 augustss }
1507 1.1 augustss }
1508 1.34 kent
1509 1.1 augustss n = 0;
1510 1.1 augustss while (!(BA1READ4(sc, CS4280_SPCS) & SPCS_SPRUN)) {
1511 1.1 augustss delay(10);
1512 1.1 augustss if (++n > 1000) {
1513 1.1 augustss printf("SPCS 0->1 transition timeout\n");
1514 1.40 jmcneill goto exit;
1515 1.1 augustss }
1516 1.1 augustss }
1517 1.1 augustss /* Processor is now running !!! */
1518 1.1 augustss
1519 1.1 augustss /* Setup volume */
1520 1.1 augustss BA1WRITE4(sc, CS4280_PVOL, 0x80008000);
1521 1.1 augustss BA1WRITE4(sc, CS4280_CVOL, 0x80008000);
1522 1.1 augustss
1523 1.1 augustss /* Interrupt enable */
1524 1.1 augustss BA0WRITE4(sc, CS4280_HICR, HICR_IEV|HICR_CHGM);
1525 1.1 augustss
1526 1.1 augustss /* playback interrupt enable */
1527 1.1 augustss mem = BA1READ4(sc, CS4280_PFIE) & ~PFIE_PI_MASK;
1528 1.1 augustss mem |= PFIE_PI_ENABLE;
1529 1.1 augustss BA1WRITE4(sc, CS4280_PFIE, mem);
1530 1.1 augustss /* capture interrupt enable */
1531 1.1 augustss mem = BA1READ4(sc, CS4280_CIE) & ~CIE_CI_MASK;
1532 1.1 augustss mem |= CIE_CI_ENABLE;
1533 1.1 augustss BA1WRITE4(sc, CS4280_CIE, mem);
1534 1.2 augustss
1535 1.2 augustss #if NMIDI > 0
1536 1.2 augustss /* Reset midi port */
1537 1.2 augustss mem = BA0READ4(sc, CS4280_MIDCR) & ~MIDCR_MASK;
1538 1.2 augustss BA0WRITE4(sc, CS4280_MIDCR, mem | MIDCR_MRST);
1539 1.2 augustss DPRINTF(("midi reset: 0x%x\n", BA0READ4(sc, CS4280_MIDCR)));
1540 1.2 augustss /* midi interrupt enable */
1541 1.2 augustss mem |= MIDCR_TXE | MIDCR_RXE | MIDCR_RIE | MIDCR_TIE;
1542 1.2 augustss BA0WRITE4(sc, CS4280_MIDCR, mem);
1543 1.2 augustss #endif
1544 1.40 jmcneill
1545 1.40 jmcneill rv = 0;
1546 1.40 jmcneill
1547 1.40 jmcneill exit:
1548 1.40 jmcneill cs4280_clkrun_hack(sc, -1);
1549 1.40 jmcneill return rv;
1550 1.1 augustss }
1551 1.1 augustss
1552 1.35 thorpej static void
1553 1.34 kent cs4280_clear_fifos(struct cs428x_softc *sc)
1554 1.1 augustss {
1555 1.34 kent int pd, cnt, n;
1556 1.34 kent uint32_t mem;
1557 1.34 kent
1558 1.34 kent pd = 0;
1559 1.34 kent /*
1560 1.1 augustss * If device power down, power up the device and keep power down
1561 1.1 augustss * state.
1562 1.1 augustss */
1563 1.1 augustss mem = BA0READ4(sc, CS4280_CLKCR1);
1564 1.1 augustss if (!(mem & CLKCR1_SWCE)) {
1565 1.1 augustss printf("cs4280_clear_fifo: power down found.\n");
1566 1.1 augustss BA0WRITE4(sc, CS4280_CLKCR1, mem | CLKCR1_SWCE);
1567 1.1 augustss pd = 1;
1568 1.1 augustss }
1569 1.1 augustss BA0WRITE4(sc, CS4280_SERBWP, 0);
1570 1.1 augustss for (cnt = 0; cnt < 256; cnt++) {
1571 1.1 augustss n = 0;
1572 1.1 augustss while (BA0READ4(sc, CS4280_SERBST) & SERBST_WBSY) {
1573 1.1 augustss delay(1000);
1574 1.1 augustss if (++n > 1000) {
1575 1.1 augustss printf("clear_fifo: fist timeout cnt=%d\n", cnt);
1576 1.1 augustss break;
1577 1.1 augustss }
1578 1.1 augustss }
1579 1.1 augustss BA0WRITE4(sc, CS4280_SERBAD, cnt);
1580 1.1 augustss BA0WRITE4(sc, CS4280_SERBCM, SERBCM_WRC);
1581 1.1 augustss }
1582 1.1 augustss if (pd)
1583 1.1 augustss BA0WRITE4(sc, CS4280_CLKCR1, mem);
1584 1.1 augustss }
1585 1.1 augustss
1586 1.1 augustss #if NMIDI > 0
1587 1.35 thorpej static int
1588 1.45 christos cs4280_midi_open(void *addr, int flags, void (*iintr)(void *, int),
1589 1.34 kent void (*ointr)(void *), void *arg)
1590 1.1 augustss {
1591 1.34 kent struct cs428x_softc *sc;
1592 1.34 kent uint32_t mem;
1593 1.1 augustss
1594 1.1 augustss DPRINTF(("midi_open\n"));
1595 1.34 kent sc = addr;
1596 1.1 augustss sc->sc_iintr = iintr;
1597 1.1 augustss sc->sc_ointr = ointr;
1598 1.1 augustss sc->sc_arg = arg;
1599 1.1 augustss
1600 1.2 augustss /* midi interrupt enable */
1601 1.2 augustss mem = BA0READ4(sc, CS4280_MIDCR) & ~MIDCR_MASK;
1602 1.1 augustss mem |= MIDCR_TXE | MIDCR_RXE | MIDCR_RIE | MIDCR_TIE | MIDCR_MLB;
1603 1.1 augustss BA0WRITE4(sc, CS4280_MIDCR, mem);
1604 1.2 augustss #ifdef CS4280_DEBUG
1605 1.2 augustss if (mem != BA0READ4(sc, CS4280_MIDCR)) {
1606 1.2 augustss DPRINTF(("midi_open: MIDCR=%d\n", BA0READ4(sc, CS4280_MIDCR)));
1607 1.2 augustss return(EINVAL);
1608 1.2 augustss }
1609 1.2 augustss DPRINTF(("MIDCR=0x%x\n", BA0READ4(sc, CS4280_MIDCR)));
1610 1.2 augustss #endif
1611 1.14 tacha return 0;
1612 1.1 augustss }
1613 1.1 augustss
1614 1.35 thorpej static void
1615 1.34 kent cs4280_midi_close(void *addr)
1616 1.1 augustss {
1617 1.34 kent struct cs428x_softc *sc;
1618 1.34 kent uint32_t mem;
1619 1.34 kent
1620 1.1 augustss DPRINTF(("midi_close\n"));
1621 1.34 kent sc = addr;
1622 1.13 augustss tsleep(sc, PWAIT, "cs0clm", hz/10); /* give uart a chance to drain */
1623 1.1 augustss mem = BA0READ4(sc, CS4280_MIDCR);
1624 1.2 augustss mem &= ~MIDCR_MASK;
1625 1.1 augustss BA0WRITE4(sc, CS4280_MIDCR, mem);
1626 1.1 augustss
1627 1.1 augustss sc->sc_iintr = 0;
1628 1.1 augustss sc->sc_ointr = 0;
1629 1.1 augustss }
1630 1.1 augustss
1631 1.35 thorpej static int
1632 1.34 kent cs4280_midi_output(void *addr, int d)
1633 1.1 augustss {
1634 1.34 kent struct cs428x_softc *sc;
1635 1.34 kent uint32_t mem;
1636 1.1 augustss int x;
1637 1.1 augustss
1638 1.34 kent sc = addr;
1639 1.1 augustss for (x = 0; x != MIDI_BUSY_WAIT; x++) {
1640 1.2 augustss if ((BA0READ4(sc, CS4280_MIDSR) & MIDSR_TBF) == 0) {
1641 1.2 augustss mem = BA0READ4(sc, CS4280_MIDWP) & ~MIDWP_MASK;
1642 1.2 augustss mem |= d & MIDWP_MASK;
1643 1.2 augustss DPRINTFN(5,("midi_output d=0x%08x",d));
1644 1.1 augustss BA0WRITE4(sc, CS4280_MIDWP, mem);
1645 1.34 kent #ifdef DIAGNOSTIC
1646 1.2 augustss if (mem != BA0READ4(sc, CS4280_MIDWP)) {
1647 1.2 augustss DPRINTF(("Bad write data: %d %d",
1648 1.2 augustss mem, BA0READ4(sc, CS4280_MIDWP)));
1649 1.34 kent return EIO;
1650 1.2 augustss }
1651 1.6 augustss #endif
1652 1.14 tacha return 0;
1653 1.1 augustss }
1654 1.1 augustss delay(MIDI_BUSY_DELAY);
1655 1.1 augustss }
1656 1.34 kent return EIO;
1657 1.1 augustss }
1658 1.1 augustss
1659 1.35 thorpej static void
1660 1.45 christos cs4280_midi_getinfo(void *addr, struct midi_info *mi)
1661 1.1 augustss {
1662 1.34 kent
1663 1.1 augustss mi->name = "CS4280 MIDI UART";
1664 1.1 augustss mi->props = MIDI_PROP_CAN_INPUT | MIDI_PROP_OUT_INTR;
1665 1.14 tacha }
1666 1.14 tacha
1667 1.34 kent #endif /* NMIDI */
1668 1.14 tacha
1669 1.14 tacha /* DEBUG functions */
1670 1.14 tacha #if CS4280_DEBUG > 10
1671 1.35 thorpej static int
1672 1.34 kent cs4280_checkimage(struct cs428x_softc *sc, uint32_t *src,
1673 1.34 kent uint32_t offset, uint32_t len)
1674 1.14 tacha {
1675 1.34 kent uint32_t ctr, data;
1676 1.34 kent int err;
1677 1.14 tacha
1678 1.34 kent if ((offset & 3) || (len & 3))
1679 1.14 tacha return -1;
1680 1.14 tacha
1681 1.34 kent err = 0;
1682 1.34 kent len /= sizeof(uint32_t);
1683 1.14 tacha for (ctr = 0; ctr < len; ctr++) {
1684 1.14 tacha /* I cannot confirm this is the right thing
1685 1.14 tacha * on BIG-ENDIAN machines
1686 1.14 tacha */
1687 1.14 tacha data = BA1READ4(sc, offset+ctr*4);
1688 1.14 tacha if (data != htole32(*(src+ctr))) {
1689 1.14 tacha printf("0x%06x: 0x%08x(0x%08x)\n",
1690 1.14 tacha offset+ctr*4, data, *(src+ctr));
1691 1.14 tacha *(src+ctr) = data;
1692 1.14 tacha ++err;
1693 1.14 tacha }
1694 1.14 tacha }
1695 1.14 tacha return err;
1696 1.14 tacha }
1697 1.14 tacha
1698 1.35 thorpej static int
1699 1.34 kent cs4280_check_images(struct cs428x_softc *sc)
1700 1.14 tacha {
1701 1.14 tacha int idx, err;
1702 1.34 kent uint32_t offset;
1703 1.14 tacha
1704 1.34 kent offset = 0;
1705 1.14 tacha err = 0;
1706 1.35 thorpej /*for (idx=0; idx < BA1_MEMORY_COUNT; ++idx)*/
1707 1.14 tacha for (idx = 0; idx < 1; ++idx) {
1708 1.14 tacha err = cs4280_checkimage(sc, &BA1Struct.map[offset],
1709 1.14 tacha BA1Struct.memory[idx].offset,
1710 1.14 tacha BA1Struct.memory[idx].size);
1711 1.14 tacha if (err != 0) {
1712 1.51 dyoung aprint_error_dev(&sc->sc_dev,
1713 1.51 dyoung "check_image failed at %d\n", idx);
1714 1.14 tacha }
1715 1.34 kent offset += BA1Struct.memory[idx].size / sizeof(uint32_t);
1716 1.14 tacha }
1717 1.14 tacha return err;
1718 1.1 augustss }
1719 1.1 augustss
1720 1.34 kent #endif /* CS4280_DEBUG */
1721