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