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