1/*-
2 * Support the ENSONIQ AudioPCI board and Creative Labs SoundBlaster PCI
3 * boards based on the ES1370, ES1371 and ES1373 chips.
4 *
5 * Copyright (c) 1999 Russell Cattelan <cattelan@thebarn.com>
6 * Copyright (c) 1999 Cameron Grant <cg@freebsd.org>
7 * Copyright (c) 1998 by Joachim Kuebart. All rights reserved.
8 *
--- 45 unchanged lines hidden (view full) ---
54
55#include <dev/pci/pcireg.h>
56#include <dev/pci/pcivar.h>
57
58#include <sys/sysctl.h>
59
60#include "mixer_if.h"
61
62SND_DECLARE_FILE("$FreeBSD: head/sys/dev/sound/pci/es137x.c 148591 2005-07-31 13:19:38Z netchild $");
63
64#define MEM_MAP_REG 0x14
65
66/* PCI IDs of supported chips */
67#define ES1370_PCI_ID 0x50001274
68#define ES1371_PCI_ID 0x13711274
69#define ES1371_PCI_ID2 0x13713274
70#define CT5880_PCI_ID 0x58801274
--- 33 unchanged lines hidden (view full) ---
104 bus_dma_tag_t parent_dmat;
105
106 struct resource *reg, *irq;
107 int regtype, regid, irqid;
108 void *ih;
109
110 device_t dev;
111 int num;
112 int spdif_en;
113 unsigned int bufsz;
114
115 /* Contents of board's registers */
116 u_long ctrl;
117 u_long sctrl;
118 struct es_chinfo pch, rch;
119 struct mtx *lock;
120};
121
122/* -------------------------------------------------------------------- */
123
124/* prototypes */
125static void es_intr(void *);
126
127static u_int es1371_wait_src_ready(struct es_info *);
128static void es1371_src_write(struct es_info *, u_short, unsigned short);
129static u_int es1371_adc_rate(struct es_info *, u_int, int);
130static u_int es1371_dac_rate(struct es_info *, u_int, int);
131static int es1371_init(struct es_info *, device_t);
132static int es1370_init(struct es_info *);
133static int es1370_wrcodec(struct es_info *, u_char, u_char);
134
135static u_int32_t es_playfmt[] = {
136 AFMT_U8,
137 AFMT_STEREO | AFMT_U8,
138 AFMT_S16_LE,
139 AFMT_STEREO | AFMT_S16_LE,
140 0
141};
142static struct pcmchan_caps es_playcaps = {4000, 48000, es_playfmt, 0};
143
144static u_int32_t es_recfmt[] = {
145 AFMT_U8,
146 AFMT_STEREO | AFMT_U8,
147 AFMT_S16_LE,
148 AFMT_STEREO | AFMT_S16_LE,
149 0
150};
151static struct pcmchan_caps es_reccaps = {4000, 48000, es_recfmt, 0};
152
153static const struct {
154 unsigned volidx:4;
155 unsigned left:4;
156 unsigned right:4;
157 unsigned stereo:1;
158 unsigned recmask:13;
159 unsigned avail:1;
160} mixtable[SOUND_MIXER_NRDEVICES] = {
--- 4 unchanged lines hidden (view full) ---
165 [SOUND_MIXER_LINE] = { 4, 0x8, 0x9, 1, 0x0018, 1 },
166 [SOUND_MIXER_LINE1] = { 5, 0xa, 0xb, 1, 0x1800, 1 },
167 [SOUND_MIXER_LINE2] = { 6, 0xc, 0x0, 0, 0x0100, 1 },
168 [SOUND_MIXER_LINE3] = { 7, 0xd, 0x0, 0, 0x0200, 1 },
169 [SOUND_MIXER_MIC] = { 8, 0xe, 0x0, 0, 0x0001, 1 },
170 [SOUND_MIXER_OGAIN] = { 9, 0xf, 0x0, 0, 0x0000, 1 }
171};
172
173static u_int32_t
174es_rd(struct es_info *es, int regno, int size)
175{
176 switch (size) {
177 case 1:
178 return bus_space_read_1(es->st, es->sh, regno);
179 case 2:
180 return bus_space_read_2(es->st, es->sh, regno);
181 case 4:
182 return bus_space_read_4(es->st, es->sh, regno);
183 default:
184 return 0xFFFFFFFF;
185 }
186}
187
188static void
189es_wr(struct es_info *es, int regno, u_int32_t data, int size)
190{
191
192 switch (size) {
193 case 1:
194 bus_space_write_1(es->st, es->sh, regno, data);
195 break;
196 case 2:
--- 23 unchanged lines hidden (view full) ---
220 if (mixtable[i].recmask) v |= (1 << i);
221 mix_setrecdevs(m, v);
222 return 0;
223}
224
225static int
226es1370_mixset(struct snd_mixer *m, unsigned dev, unsigned left, unsigned right)
227{
228 int l, r, rl, rr;
229
230 if (!mixtable[dev].avail) return -1;
231 l = left;
232 r = mixtable[dev].stereo? right : l;
233 if (mixtable[dev].left == 0xf) {
234 rl = (l < 2)? 0x80 : 7 - (l - 2) / 14;
235 } else {
236 rl = (l < 10)? 0x80 : 15 - (l - 10) / 6;
237 }
238 if (mixtable[dev].stereo) {
239 rr = (r < 10)? 0x80 : 15 - (r - 10) / 6;
240 es1370_wrcodec(mix_getdevinfo(m), mixtable[dev].right, rr);
241 }
242 es1370_wrcodec(mix_getdevinfo(m), mixtable[dev].left, rl);
243 return l | (r << 8);
244}
245
246static int
247es1370_mixsetrecsrc(struct snd_mixer *m, u_int32_t src)
248{
249 int i, j = 0;
250
251 if (src == 0) src = 1 << SOUND_MIXER_MIC;
252 src &= mix_getrecdevs(m);
253 for (i = 0; i < SOUND_MIXER_NRDEVICES; i++)
254 if ((src & (1 << i)) != 0) j |= mixtable[i].recmask;
255
256 es1370_wrcodec(mix_getdevinfo(m), CODEC_LIMIX1, j & 0x55);
257 es1370_wrcodec(mix_getdevinfo(m), CODEC_RIMIX1, j & 0xaa);
258 es1370_wrcodec(mix_getdevinfo(m), CODEC_LIMIX2, (j >> 8) & 0x17);
259 es1370_wrcodec(mix_getdevinfo(m), CODEC_RIMIX2, (j >> 8) & 0x0f);
260 es1370_wrcodec(mix_getdevinfo(m), CODEC_OMIX1, 0x7f);
261 es1370_wrcodec(mix_getdevinfo(m), CODEC_OMIX2, 0x3f);
262 return src;
263}
264
265static kobj_method_t es1370_mixer_methods[] = {
266 KOBJMETHOD(mixer_init, es1370_mixinit),
267 KOBJMETHOD(mixer_set, es1370_mixset),
268 KOBJMETHOD(mixer_setrecsrc, es1370_mixsetrecsrc),
269 { 0, 0 }
270};
271MIXER_DECLARE(es1370_mixer);
272
273/* -------------------------------------------------------------------- */
274
275static int
276es1370_wrcodec(struct es_info *es, u_char i, u_char data)
277{
278 u_int t;
279
280 for (t = 0; t < 0x1000; t++) {
281 if ((es_rd(es, ES1370_REG_STATUS, 4) &
282 STAT_CSTAT) == 0) {
283 es_wr(es, ES1370_REG_CODEC,
284 ((u_short)i << CODEC_INDEX_SHIFT) | data, 2);
285 return 0;
286 }
287 DELAY(1);
288 }
289 printf("pcm: es1370_wrcodec timed out\n");
290 return -1;
291}
292
293/* -------------------------------------------------------------------- */
294
295/* channel interface */
296static void *
297eschan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
298{
299 struct es_info *es = devinfo;
300 struct es_chinfo *ch = (dir == PCMDIR_PLAY)? &es->pch : &es->rch;
301
302 snd_mtxlock(es->lock);
303 ch->parent = es;
304 ch->channel = c;
305 ch->buffer = b;
306 ch->bufsz = es->bufsz;
307 ch->blksz = ch->bufsz / 2;
308 ch->num = ch->parent->num++;
309 snd_mtxunlock(es->lock);
310 if (sndbuf_alloc(ch->buffer, es->parent_dmat, ch->bufsz) != 0)
311 return NULL;
312 return ch;
313}
314
315static int
316eschan_setdir(kobj_t obj, void *data, int dir)
317{
318 struct es_chinfo *ch = data;
319 struct es_info *es = ch->parent;
320
321 if (dir == PCMDIR_PLAY) {
322 es_wr(es, ES1370_REG_MEMPAGE, ES1370_REG_DAC2_FRAMEADR >> 8, 1);
323 es_wr(es, ES1370_REG_DAC2_FRAMEADR & 0xff, sndbuf_getbufaddr(ch->buffer), 4);
324 es_wr(es, ES1370_REG_DAC2_FRAMECNT & 0xff, (ch->bufsz >> 2) - 1, 4);
325 } else {
326 es_wr(es, ES1370_REG_MEMPAGE, ES1370_REG_ADC_FRAMEADR >> 8, 1);
327 es_wr(es, ES1370_REG_ADC_FRAMEADR & 0xff, sndbuf_getbufaddr(ch->buffer), 4);
328 es_wr(es, ES1370_REG_ADC_FRAMECNT & 0xff, (ch->bufsz >> 2) - 1, 4);
329 }
330 ch->dir = dir;
331 return 0;
332}
333
334static int
335eschan_setformat(kobj_t obj, void *data, u_int32_t format)
336{
337 struct es_chinfo *ch = data;
338 struct es_info *es = ch->parent;
339
340 if (ch->dir == PCMDIR_PLAY) {
341 es->sctrl &= ~SCTRL_P2FMT;
342 if (format & AFMT_S16_LE) es->sctrl |= SCTRL_P2SEB;
343 if (format & AFMT_STEREO) es->sctrl |= SCTRL_P2SMB;
344 } else {
345 es->sctrl &= ~SCTRL_R1FMT;
346 if (format & AFMT_S16_LE) es->sctrl |= SCTRL_R1SEB;
347 if (format & AFMT_STEREO) es->sctrl |= SCTRL_R1SMB;
348 }
349 es_wr(es, ES1370_REG_SERIAL_CONTROL, es->sctrl, 4);
350 ch->fmt = format;
351 return 0;
352}
353
354static int
355eschan1370_setspeed(kobj_t obj, void *data, u_int32_t speed)
356{
357 struct es_chinfo *ch = data;
358 struct es_info *es = ch->parent;
359
360 es->ctrl &= ~CTRL_PCLKDIV;
361 es->ctrl |= DAC2_SRTODIV(speed) << CTRL_SH_PCLKDIV;
362 es_wr(es, ES1370_REG_CONTROL, es->ctrl, 4);
363 /* rec/play speeds locked together - should indicate in flags */
364 return speed; /* XXX calc real speed */
365}
366
367static int
368eschan1371_setspeed(kobj_t obj, void *data, u_int32_t speed)
369{
370 struct es_chinfo *ch = data;
371 struct es_info *es = ch->parent;
372 int i, delta;
373
374 if (ch->dir == PCMDIR_PLAY)
375 i = es1371_dac_rate(es, speed, 3 - ch->num); /* play */
376 else
377 i = es1371_adc_rate(es, speed, 1); /* record */
378 delta = (speed > i) ? speed - i : i - speed;
379 if (delta < 2)
380 return speed;
381 return i;
382}
383
384static int
385eschan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
386{
387 struct es_chinfo *ch = data;
388
389 ch->blksz = blocksize;
390 ch->bufsz = ch->blksz * 2;
391 sndbuf_resize(ch->buffer, 2, ch->blksz);
392 return ch->blksz;
393}
394
395static int
396eschan_trigger(kobj_t obj, void *data, int go)
397{
398 struct es_chinfo *ch = data;
399 struct es_info *es = ch->parent;
400 unsigned cnt;
401
402 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
403 return 0;
404
405 cnt = (ch->blksz / sndbuf_getbps(ch->buffer)) - 1;
406
407 if (ch->dir == PCMDIR_PLAY) {
408 if (go == PCMTRIG_START) {
409 int b = (ch->fmt & AFMT_S16_LE)? 2 : 1;
410 es->ctrl |= CTRL_DAC2_EN;
411 es->sctrl &= ~(SCTRL_P2ENDINC | SCTRL_P2STINC | SCTRL_P2LOOPSEL | SCTRL_P2PAUSE | SCTRL_P2DACSEN);
412 es->sctrl |= SCTRL_P2INTEN | (b << SCTRL_SH_P2ENDINC);
413 es_wr(es, ES1370_REG_DAC2_SCOUNT, cnt, 4);
414 /* start at beginning of buffer */
--- 8 unchanged lines hidden (view full) ---
423 es_wr(es, ES1370_REG_ADC_SCOUNT, cnt, 4);
424 /* start at beginning of buffer */
425 es_wr(es, ES1370_REG_MEMPAGE, ES1370_REG_ADC_FRAMECNT >> 8, 4);
426 es_wr(es, ES1370_REG_ADC_FRAMECNT & 0xff, (ch->bufsz >> 2) - 1, 4);
427 } else es->ctrl &= ~CTRL_ADC_EN;
428 }
429 es_wr(es, ES1370_REG_SERIAL_CONTROL, es->sctrl, 4);
430 es_wr(es, ES1370_REG_CONTROL, es->ctrl, 4);
431 return 0;
432}
433
434static int
435eschan_getptr(kobj_t obj, void *data)
436{
437 struct es_chinfo *ch = data;
438 struct es_info *es = ch->parent;
439 u_int32_t reg, cnt;
440
441 if (ch->dir == PCMDIR_PLAY)
442 reg = ES1370_REG_DAC2_FRAMECNT;
443 else
444 reg = ES1370_REG_ADC_FRAMECNT;
445 es_wr(es, ES1370_REG_MEMPAGE, reg >> 8, 4);
446 cnt = es_rd(es, reg & 0x000000ff, 4) >> 16;
447 /* cnt is longwords */
448 return cnt << 2;
449}
450
451static struct pcmchan_caps *
452eschan_getcaps(kobj_t obj, void *data)
453{
454 struct es_chinfo *ch = data;
455 return (ch->dir == PCMDIR_PLAY)? &es_playcaps : &es_reccaps;
456}
457
458static kobj_method_t eschan1370_methods[] = {
459 KOBJMETHOD(channel_init, eschan_init),
460 KOBJMETHOD(channel_setdir, eschan_setdir),
461 KOBJMETHOD(channel_setformat, eschan_setformat),
462 KOBJMETHOD(channel_setspeed, eschan1370_setspeed),
463 KOBJMETHOD(channel_setblocksize, eschan_setblocksize),
464 KOBJMETHOD(channel_trigger, eschan_trigger),
465 KOBJMETHOD(channel_getptr, eschan_getptr),
466 KOBJMETHOD(channel_getcaps, eschan_getcaps),
467 { 0, 0 }
468};
469CHANNEL_DECLARE(eschan1370);
470
471static kobj_method_t eschan1371_methods[] = {
472 KOBJMETHOD(channel_init, eschan_init),
473 KOBJMETHOD(channel_setdir, eschan_setdir),
474 KOBJMETHOD(channel_setformat, eschan_setformat),
475 KOBJMETHOD(channel_setspeed, eschan1371_setspeed),
476 KOBJMETHOD(channel_setblocksize, eschan_setblocksize),
477 KOBJMETHOD(channel_trigger, eschan_trigger),
478 KOBJMETHOD(channel_getptr, eschan_getptr),
479 KOBJMETHOD(channel_getcaps, eschan_getcaps),
480 { 0, 0 }
481};
482CHANNEL_DECLARE(eschan1371);
483
484/* -------------------------------------------------------------------- */
485/* The interrupt handler */
486static void
487es_intr(void *p)
488{
489 struct es_info *es = p;
490 unsigned intsrc, sctrl;
491
492 snd_mtxlock(es->lock);
493 intsrc = es_rd(es, ES1370_REG_STATUS, 4);
494 if ((intsrc & STAT_INTR) == 0) {
495 snd_mtxunlock(es->lock);
496 return;
497 }
498
499 sctrl = es->sctrl;
500 if (intsrc & STAT_ADC) sctrl &= ~SCTRL_R1INTEN;
501 if (intsrc & STAT_DAC1) sctrl &= ~SCTRL_P1INTEN;
502 if (intsrc & STAT_DAC2) sctrl &= ~SCTRL_P2INTEN;
503
504 es_wr(es, ES1370_REG_SERIAL_CONTROL, sctrl, 4);
505 es_wr(es, ES1370_REG_SERIAL_CONTROL, es->sctrl, 4);
506 snd_mtxunlock(es->lock);
507
508 if (intsrc & STAT_ADC) chn_intr(es->rch.channel);
509 if (intsrc & STAT_DAC1)
510 ; /* nothing */
511 if (intsrc & STAT_DAC2) chn_intr(es->pch.channel);
512}
513
514/* ES1370 specific */
515static int
516es1370_init(struct es_info *es)
517{
518 es->ctrl = CTRL_CDC_EN | CTRL_SERR_DIS |
519 (DAC2_SRTODIV(DSP_DEFAULT_SPEED) << CTRL_SH_PCLKDIV);
520 es_wr(es, ES1370_REG_CONTROL, es->ctrl, 4);
521
522 es->sctrl = 0;
523 es_wr(es, ES1370_REG_SERIAL_CONTROL, es->sctrl, 4);
524
525 es1370_wrcodec(es, CODEC_RES_PD, 3);/* No RST, PD */
526 es1370_wrcodec(es, CODEC_CSEL, 0); /* CODEC ADC and CODEC DAC use
527 * {LR,B}CLK2 and run off the LRCLK2
528 * PLL; program DAC_SYNC=0! */
529 es1370_wrcodec(es, CODEC_ADSEL, 0);/* Recording source is mixer */
530 es1370_wrcodec(es, CODEC_MGAIN, 0);/* MIC amp is 0db */
531
532 return 0;
533}
534
535/* ES1371 specific */
536int
537es1371_init(struct es_info *es, device_t dev)
538{
539 u_long cssr;
540 int idx;
541 int devid = pci_get_devid(dev);
542 int revid = pci_get_revid(dev);
543
544 es->num = 0;
545 es->ctrl = 0;
546 es->sctrl = 0;
547 cssr = 0;
548 if (devid == CT4730_PCI_ID) {
549 /* XXX amplifier hack? */
550 es->ctrl |= (1 << 16);
551 }
552 /* initialize the chips */
553 es_wr(es, ES1370_REG_CONTROL, es->ctrl, 4);
554 es_wr(es, ES1370_REG_SERIAL_CONTROL, es->sctrl, 4);
555 es_wr(es, ES1371_REG_LEGACY, 0, 4);
--- 34 unchanged lines hidden (view full) ---
590 * be stuck high, and I've found no way to rectify this other than
591 * power cycle)
592 */
593 es1371_wait_src_ready(es);
594 es_wr(es, ES1371_REG_SMPRATE, 0, 4);
595 /* try to reset codec directly */
596 es_wr(es, ES1371_REG_CODEC, 0, 4);
597 es_wr(es, ES1370_REG_STATUS, cssr, 4);
598
599 return (0);
600}
601
602/* -------------------------------------------------------------------- */
603
604static int
605es1371_wrcd(kobj_t obj, void *s, int addr, u_int32_t data)
606{
607 unsigned t, x, orig;
608 struct es_info *es = (struct es_info*)s;
609
610 for (t = 0; t < 0x1000; t++)
611 if (!es_rd(es, ES1371_REG_CODEC & CODEC_WIP, 4))
612 break;
613 /* save the current state for later */
614 x = orig = es_rd(es, ES1371_REG_SMPRATE, 4);
615 /* enable SRC state data in SRC mux */
--- 18 unchanged lines hidden (view full) ---
634 es_wr(es, ES1371_REG_SMPRATE, orig, 4);
635
636 return 0;
637}
638
639static int
640es1371_rdcd(kobj_t obj, void *s, int addr)
641{
642 unsigned t, x = 0, orig;
643 struct es_info *es = (struct es_info *)s;
644
645 for (t = 0; t < 0x1000; t++)
646 if (!(x = es_rd(es, ES1371_REG_CODEC, 4) & CODEC_WIP))
647 break;
648
649 /* save the current state for later */
650 x = orig = es_rd(es, ES1371_REG_SMPRATE, 4);
--- 34 unchanged lines hidden (view full) ---
685};
686AC97_DECLARE(es1371_ac97);
687
688/* -------------------------------------------------------------------- */
689
690static u_int
691es1371_src_read(struct es_info *es, u_short reg)
692{
693 unsigned int r;
694
695 r = es1371_wait_src_ready(es) &
696 (ES1371_DIS_SRC | ES1371_DIS_P1 | ES1371_DIS_P2 | ES1371_DIS_R1);
697 r |= ES1371_SRC_RAM_ADDRO(reg);
698 es_wr(es, ES1371_REG_SMPRATE, r, 4);
699 return ES1371_SRC_RAM_DATAI(es1371_wait_src_ready(es));
700}
701
702static void
703es1371_src_write(struct es_info *es, u_short reg, u_short data)
704{
705 u_int r;
706
707 r = es1371_wait_src_ready(es) &
708 (ES1371_DIS_SRC | ES1371_DIS_P1 | ES1371_DIS_P2 | ES1371_DIS_R1);
709 r |= ES1371_SRC_RAM_ADDRO(reg) | ES1371_SRC_RAM_DATAO(data);
710 es_wr(es, ES1371_REG_SMPRATE, r | ES1371_SRC_RAM_WE, 4);
711}
712
713static u_int
714es1371_adc_rate(struct es_info *es, u_int rate, int set)
715{
716 u_int n, truncm, freq, result;
717
718 if (rate > 48000) rate = 48000;
719 if (rate < 4000) rate = 4000;
720 n = rate / 3000;
721 if ((1 << n) & ((1 << 15) | (1 << 13) | (1 << 11) | (1 << 9)))
722 n--;
723 truncm = (21 * n - 1) | 1;
724 freq = ((48000UL << 15) / rate) * n;
725 result = (48000UL << 15) / (freq / n);
--- 17 unchanged lines hidden (view full) ---
743 return result;
744}
745
746static u_int
747es1371_dac_rate(struct es_info *es, u_int rate, int set)
748{
749 u_int freq, r, result, dac, dis;
750
751 if (rate > 48000) rate = 48000;
752 if (rate < 4000) rate = 4000;
753 freq = (rate << 15) / 3000;
754 result = (freq * 3000) >> 15;
755 if (set) {
756 dac = (set == 1)? ES_SMPREG_DAC1 : ES_SMPREG_DAC2;
757 dis = (set == 1)? ES1371_DIS_P2 : ES1371_DIS_P1;
758
759 r = (es1371_wait_src_ready(es) & (ES1371_DIS_SRC | ES1371_DIS_P1 | ES1371_DIS_P2 | ES1371_DIS_R1));
760 es_wr(es, ES1371_REG_SMPRATE, r, 4);
761 es1371_src_write(es, dac + ES_SMPREG_INT_REGS,
762 (es1371_src_read(es, dac + ES_SMPREG_INT_REGS) & 0x00ff) | ((freq >> 5) & 0xfc00));
763 es1371_src_write(es, dac + ES_SMPREG_VFREQ_FRAC, freq & 0x7fff);
764 r = (es1371_wait_src_ready(es) & (ES1371_DIS_SRC | dis | ES1371_DIS_R1));
765 es_wr(es, ES1371_REG_SMPRATE, r, 4);
766 }
767 return result;
768}
769
770static u_int
771es1371_wait_src_ready(struct es_info *es)
772{
773 u_int t, r;
774
775 for (t = 0; t < 0x1000; t++) {
776 if (!((r = es_rd(es, ES1371_REG_SMPRATE, 4)) & ES1371_SRC_RAM_BUSY))
777 return r;
778 DELAY(1);
779 }
780 printf("es1371: wait src ready timeout 0x%x [0x%x]\n", ES1371_REG_SMPRATE, r);
781 return 0;
782}
783
784/* -------------------------------------------------------------------- */
785
786/*
787 * Probe and attach the card
788 */
--- 76 unchanged lines hidden (view full) ---
865
866 default:
867 return ENXIO;
868 }
869}
870
871#ifdef SND_DYNSYSCTL
872static int
873sysctl_es1371x_spdif_enable(SYSCTL_HANDLER_ARGS)
874{
875 struct es_info *es;
876 device_t dev;
877 int err, new_en, r;
878
879 dev = oidp->oid_arg1;
880 es = pcm_getdevinfo(dev);
881 snd_mtxlock(es->lock);
882 new_en = es->spdif_en;
883 snd_mtxunlock(es->lock);
884 err = sysctl_handle_int(oidp, &new_en, sizeof(new_en), req);
885
886 if (err || req->newptr == NULL)
887 return err;
888 if (new_en < 0 || new_en > 1)
889 return EINVAL;
890
891 snd_mtxlock(es->lock);
892 es->spdif_en = new_en;
893 r = es_rd(es, ES1370_REG_STATUS, 4);
894 if (new_en) {
895 r |= ENABLE_SPDIF;
896 es->ctrl |= SPDIFEN_B;
897 es->ctrl |= RECEN_B;
898 } else {
899 r &= ~ENABLE_SPDIF;
900 es->ctrl &= ~SPDIFEN_B;
901 es->ctrl &= ~RECEN_B;
902 }
903 es_wr(es, ES1370_REG_CONTROL, es->ctrl, 4);
904 es_wr(es, ES1370_REG_STATUS, r, 4);
905 snd_mtxunlock(es->lock);
906 return 0;
907}
908
909static int
910sysctl_es1371x_latency_timer(SYSCTL_HANDLER_ARGS)
911{
912 struct es_info *es;
913 device_t dev;
914 int err, val;
915
916 dev = oidp->oid_arg1;
917 es = pcm_getdevinfo(dev);
918 snd_mtxlock(es->lock);
919 val = pci_read_config(dev, PCIR_LATTIMER, 1);
920 snd_mtxunlock(es->lock);
921 err = sysctl_handle_int(oidp, &val, sizeof(val), req);
922
923 if (err || req->newptr == NULL)
924 return err;
925 if (val < 0 || val > 255)
926 return EINVAL;
927
928 snd_mtxlock(es->lock);
929 pci_write_config(dev, PCIR_LATTIMER, val, 1);
930 snd_mtxunlock(es->lock);
931 return 0;
932}
933#endif /* SND_DYNSYSCTL */
934
935static void
936es_init_sysctls(device_t dev)
937{
938#ifdef SND_DYNSYSCTL
939 struct es_info *es;
940 int r, devid, revid;
941
942 devid = pci_get_devid(dev);
943 revid = pci_get_revid(dev);
944 es = pcm_getdevinfo(dev);
945 if ((devid == ES1371_PCI_ID && revid == ES1371REV_ES1373_8) ||
946 (devid == ES1371_PCI_ID && revid == ES1371REV_CT5880_A) ||
947 (devid == CT5880_PCI_ID && revid == CT5880REV_CT5880_C) ||
948 (devid == CT5880_PCI_ID && revid == CT5880REV_CT5880_D) ||
949 (devid == CT5880_PCI_ID && revid == CT5880REV_CT5880_E)) {
950 r = es_rd(es, ES1370_REG_STATUS, 4);
951 es->spdif_en = (r & ENABLE_SPDIF) ? 1 : 0;
952 SYSCTL_ADD_PROC(snd_sysctl_tree(dev),
953 SYSCTL_CHILDREN(snd_sysctl_tree_top(dev)),
954 OID_AUTO, "spdif_enabled",
955 CTLTYPE_INT | CTLFLAG_RW, dev, sizeof(dev),
956 sysctl_es1371x_spdif_enable, "I",
957 "Enable S/PDIF output on primary playback channel");
958 }
959 if (resource_int_value(device_get_name(dev),
960 device_get_unit(dev), "latency_timer", &r) == 0 &&
961 !(r < 0 || r > 255))
962 pci_write_config(dev, PCIR_LATTIMER, r, 1);
963 SYSCTL_ADD_PROC(snd_sysctl_tree(dev),
964 SYSCTL_CHILDREN(snd_sysctl_tree_top(dev)),
965 OID_AUTO, "latency_timer",
966 CTLTYPE_INT | CTLFLAG_RW, dev, sizeof(dev),
967 sysctl_es1371x_latency_timer, "I",
968 "PCI Latency Timer configuration");
969#endif /* SND_DYNSYSCTL */
970}
971
972static int
973es_pci_attach(device_t dev)
974{
975 u_int32_t data;
976 struct es_info *es = 0;
977 int mapped;
978 char status[SND_STATUSLEN];
979 struct ac97_info *codec = 0;
980 kobj_class_t ct = NULL;
981 int devid, revid;
982
983 if ((es = malloc(sizeof *es, M_DEVBUF, M_NOWAIT | M_ZERO)) == NULL) {
984 device_printf(dev, "cannot allocate softc\n");
985 return ENXIO;
986 }
987 es->lock = snd_mtxcreate(device_get_nameunit(dev), "sound softc");
988 es->dev = dev;
989 mapped = 0;
990 data = pci_read_config(dev, PCIR_COMMAND, 2);
991 data |= (PCIM_CMD_PORTEN|PCIM_CMD_MEMEN|PCIM_CMD_BUSMASTEREN);
992 pci_write_config(dev, PCIR_COMMAND, data, 2);
993 data = pci_read_config(dev, PCIR_COMMAND, 2);
994 if (mapped == 0 && (data & PCIM_CMD_MEMEN)) {
995 es->regid = MEM_MAP_REG;
996 es->regtype = SYS_RES_MEMORY;
997 es->reg = bus_alloc_resource_any(dev, es->regtype, &es->regid,
998 RF_ACTIVE);
999 if (es->reg) {
1000 es->st = rman_get_bustag(es->reg);
1001 es->sh = rman_get_bushandle(es->reg);
1002 mapped++;
1003 }
1004 }
1005 if (mapped == 0 && (data & PCIM_CMD_PORTEN)) {
1006 es->regid = PCIR_BAR(0);
1007 es->regtype = SYS_RES_IOPORT;
1008 es->reg = bus_alloc_resource_any(dev, es->regtype, &es->regid,
1009 RF_ACTIVE);
1010 if (es->reg) {
1011 es->st = rman_get_bustag(es->reg);
1012 es->sh = rman_get_bushandle(es->reg);
1013 mapped++;
1014 }
1015 }
1016 if (mapped == 0) {
1017 device_printf(dev, "unable to map register space\n");
1018 goto bad;
1019 }
1020
1021 es->bufsz = pcm_getbuffersize(dev, 4096, ES_DEFAULT_BUFSZ, 65536);
1022
1023 devid = pci_get_devid(dev);
1024 revid = pci_get_revid(dev);
1025
1026 if (devid == ES1371_PCI_ID || devid == ES1371_PCI_ID2 ||
1027 devid == CT5880_PCI_ID || devid == CT4730_PCI_ID) {
1028 if(-1 == es1371_init(es, dev)) {
1029 device_printf(dev, "unable to initialize the card\n");
1030 goto bad;
1031 }
1032 codec = AC97_CREATE(dev, es, es1371_ac97);
1033 if (codec == NULL) goto bad;
1034 /* our init routine does everything for us */
1035 /* set to NULL; flag mixer_init not to run the ac97_init */
1036 /* ac97_mixer.init = NULL; */
1037 if (mixer_init(dev, ac97_getmixerclass(), codec)) goto bad;
1038 ct = &eschan1371_class;
1039 } else if (devid == ES1370_PCI_ID) {
1040 if (-1 == es1370_init(es)) {
1041 device_printf(dev, "unable to initialize the card\n");
1042 goto bad;
1043 }
1044 if (mixer_init(dev, &es1370_mixer_class, es)) goto bad;
1045 ct = &eschan1370_class;
1046 } else goto bad;
1047
1048 es->irqid = 0;
1049 es->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &es->irqid,
1050 RF_ACTIVE | RF_SHAREABLE);
1051 if (!es->irq || snd_setup_intr(dev, es->irq, INTR_MPSAFE, es_intr, es, &es->ih)) {
1052 device_printf(dev, "unable to map interrupt\n");
1053 goto bad;
1054 }
--- 8 unchanged lines hidden (view full) ---
1063 device_printf(dev, "unable to create dma tag\n");
1064 goto bad;
1065 }
1066
1067 snprintf(status, SND_STATUSLEN, "at %s 0x%lx irq %ld %s",
1068 (es->regtype == SYS_RES_IOPORT)? "io" : "memory",
1069 rman_get_start(es->reg), rman_get_start(es->irq),PCM_KLDSTRING(snd_es137x));
1070
1071 if (pcm_register(dev, es, 1, 1)) goto bad;
1072 pcm_addchan(dev, PCMDIR_REC, ct, es);
1073 pcm_addchan(dev, PCMDIR_PLAY, ct, es);
1074 es_init_sysctls(dev);
1075 pcm_setstatus(dev, status);
1076
1077 return 0;
1078
1079 bad:
--- 12 unchanged lines hidden (view full) ---
1092{
1093 int r;
1094 struct es_info *es;
1095
1096 r = pcm_unregister(dev);
1097 if (r) return r;
1098
1099 es = pcm_getdevinfo(dev);
1100 bus_dma_tag_destroy(es->parent_dmat);
1101 bus_teardown_intr(dev, es->irq, es->ih);
1102 bus_release_resource(dev, SYS_RES_IRQ, es->irqid, es->irq);
1103 bus_release_resource(dev, es->regtype, es->regid, es->reg);
1104 snd_mtxfree(es->lock);
1105 free(es, M_DEVBUF);
1106
1107 return 0;
1108}
1109
1110static device_method_t es_methods[] = {
1111 /* Device interface */
--- 16 unchanged lines hidden ---
2 * Support the ENSONIQ AudioPCI board and Creative Labs SoundBlaster PCI
3 * boards based on the ES1370, ES1371 and ES1373 chips.
4 *
5 * Copyright (c) 1999 Russell Cattelan <cattelan@thebarn.com>
6 * Copyright (c) 1999 Cameron Grant <cg@freebsd.org>
7 * Copyright (c) 1998 by Joachim Kuebart. All rights reserved.
8 *
--- 45 unchanged lines hidden (view full) ---
54
55#include <dev/pci/pcireg.h>
56#include <dev/pci/pcivar.h>
57
58#include <sys/sysctl.h>
59
60#include "mixer_if.h"
61
62SND_DECLARE_FILE("$FreeBSD: head/sys/dev/sound/pci/es137x.c 148591 2005-07-31 13:19:38Z netchild $");
63
64#define MEM_MAP_REG 0x14
65
66/* PCI IDs of supported chips */
67#define ES1370_PCI_ID 0x50001274
68#define ES1371_PCI_ID 0x13711274
69#define ES1371_PCI_ID2 0x13713274
70#define CT5880_PCI_ID 0x58801274
--- 33 unchanged lines hidden (view full) ---
104 bus_dma_tag_t parent_dmat;
105
106 struct resource *reg, *irq;
107 int regtype, regid, irqid;
108 void *ih;
109
110 device_t dev;
111 int num;
112 int spdif_en;
113 unsigned int bufsz;
114
115 /* Contents of board's registers */
116 u_long ctrl;
117 u_long sctrl;
118 struct es_chinfo pch, rch;
119 struct mtx *lock;
120};
121
122/* -------------------------------------------------------------------- */
123
124/* prototypes */
125static void es_intr(void *);
126
127static u_int es1371_wait_src_ready(struct es_info *);
128static void es1371_src_write(struct es_info *, u_short, unsigned short);
129static u_int es1371_adc_rate(struct es_info *, u_int, int);
130static u_int es1371_dac_rate(struct es_info *, u_int, int);
131static int es1371_init(struct es_info *, device_t);
132static int es1370_init(struct es_info *);
133static int es1370_wrcodec(struct es_info *, u_char, u_char);
134
135static u_int32_t es_playfmt[] = {
136 AFMT_U8,
137 AFMT_STEREO | AFMT_U8,
138 AFMT_S16_LE,
139 AFMT_STEREO | AFMT_S16_LE,
140 0
141};
142static struct pcmchan_caps es_playcaps = {4000, 48000, es_playfmt, 0};
143
144static u_int32_t es_recfmt[] = {
145 AFMT_U8,
146 AFMT_STEREO | AFMT_U8,
147 AFMT_S16_LE,
148 AFMT_STEREO | AFMT_S16_LE,
149 0
150};
151static struct pcmchan_caps es_reccaps = {4000, 48000, es_recfmt, 0};
152
153static const struct {
154 unsigned volidx:4;
155 unsigned left:4;
156 unsigned right:4;
157 unsigned stereo:1;
158 unsigned recmask:13;
159 unsigned avail:1;
160} mixtable[SOUND_MIXER_NRDEVICES] = {
--- 4 unchanged lines hidden (view full) ---
165 [SOUND_MIXER_LINE] = { 4, 0x8, 0x9, 1, 0x0018, 1 },
166 [SOUND_MIXER_LINE1] = { 5, 0xa, 0xb, 1, 0x1800, 1 },
167 [SOUND_MIXER_LINE2] = { 6, 0xc, 0x0, 0, 0x0100, 1 },
168 [SOUND_MIXER_LINE3] = { 7, 0xd, 0x0, 0, 0x0200, 1 },
169 [SOUND_MIXER_MIC] = { 8, 0xe, 0x0, 0, 0x0001, 1 },
170 [SOUND_MIXER_OGAIN] = { 9, 0xf, 0x0, 0, 0x0000, 1 }
171};
172
173static u_int32_t
174es_rd(struct es_info *es, int regno, int size)
175{
176 switch (size) {
177 case 1:
178 return bus_space_read_1(es->st, es->sh, regno);
179 case 2:
180 return bus_space_read_2(es->st, es->sh, regno);
181 case 4:
182 return bus_space_read_4(es->st, es->sh, regno);
183 default:
184 return 0xFFFFFFFF;
185 }
186}
187
188static void
189es_wr(struct es_info *es, int regno, u_int32_t data, int size)
190{
191
192 switch (size) {
193 case 1:
194 bus_space_write_1(es->st, es->sh, regno, data);
195 break;
196 case 2:
--- 23 unchanged lines hidden (view full) ---
220 if (mixtable[i].recmask) v |= (1 << i);
221 mix_setrecdevs(m, v);
222 return 0;
223}
224
225static int
226es1370_mixset(struct snd_mixer *m, unsigned dev, unsigned left, unsigned right)
227{
228 int l, r, rl, rr;
229
230 if (!mixtable[dev].avail) return -1;
231 l = left;
232 r = mixtable[dev].stereo? right : l;
233 if (mixtable[dev].left == 0xf) {
234 rl = (l < 2)? 0x80 : 7 - (l - 2) / 14;
235 } else {
236 rl = (l < 10)? 0x80 : 15 - (l - 10) / 6;
237 }
238 if (mixtable[dev].stereo) {
239 rr = (r < 10)? 0x80 : 15 - (r - 10) / 6;
240 es1370_wrcodec(mix_getdevinfo(m), mixtable[dev].right, rr);
241 }
242 es1370_wrcodec(mix_getdevinfo(m), mixtable[dev].left, rl);
243 return l | (r << 8);
244}
245
246static int
247es1370_mixsetrecsrc(struct snd_mixer *m, u_int32_t src)
248{
249 int i, j = 0;
250
251 if (src == 0) src = 1 << SOUND_MIXER_MIC;
252 src &= mix_getrecdevs(m);
253 for (i = 0; i < SOUND_MIXER_NRDEVICES; i++)
254 if ((src & (1 << i)) != 0) j |= mixtable[i].recmask;
255
256 es1370_wrcodec(mix_getdevinfo(m), CODEC_LIMIX1, j & 0x55);
257 es1370_wrcodec(mix_getdevinfo(m), CODEC_RIMIX1, j & 0xaa);
258 es1370_wrcodec(mix_getdevinfo(m), CODEC_LIMIX2, (j >> 8) & 0x17);
259 es1370_wrcodec(mix_getdevinfo(m), CODEC_RIMIX2, (j >> 8) & 0x0f);
260 es1370_wrcodec(mix_getdevinfo(m), CODEC_OMIX1, 0x7f);
261 es1370_wrcodec(mix_getdevinfo(m), CODEC_OMIX2, 0x3f);
262 return src;
263}
264
265static kobj_method_t es1370_mixer_methods[] = {
266 KOBJMETHOD(mixer_init, es1370_mixinit),
267 KOBJMETHOD(mixer_set, es1370_mixset),
268 KOBJMETHOD(mixer_setrecsrc, es1370_mixsetrecsrc),
269 { 0, 0 }
270};
271MIXER_DECLARE(es1370_mixer);
272
273/* -------------------------------------------------------------------- */
274
275static int
276es1370_wrcodec(struct es_info *es, u_char i, u_char data)
277{
278 u_int t;
279
280 for (t = 0; t < 0x1000; t++) {
281 if ((es_rd(es, ES1370_REG_STATUS, 4) &
282 STAT_CSTAT) == 0) {
283 es_wr(es, ES1370_REG_CODEC,
284 ((u_short)i << CODEC_INDEX_SHIFT) | data, 2);
285 return 0;
286 }
287 DELAY(1);
288 }
289 printf("pcm: es1370_wrcodec timed out\n");
290 return -1;
291}
292
293/* -------------------------------------------------------------------- */
294
295/* channel interface */
296static void *
297eschan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
298{
299 struct es_info *es = devinfo;
300 struct es_chinfo *ch = (dir == PCMDIR_PLAY)? &es->pch : &es->rch;
301
302 snd_mtxlock(es->lock);
303 ch->parent = es;
304 ch->channel = c;
305 ch->buffer = b;
306 ch->bufsz = es->bufsz;
307 ch->blksz = ch->bufsz / 2;
308 ch->num = ch->parent->num++;
309 snd_mtxunlock(es->lock);
310 if (sndbuf_alloc(ch->buffer, es->parent_dmat, ch->bufsz) != 0)
311 return NULL;
312 return ch;
313}
314
315static int
316eschan_setdir(kobj_t obj, void *data, int dir)
317{
318 struct es_chinfo *ch = data;
319 struct es_info *es = ch->parent;
320
321 if (dir == PCMDIR_PLAY) {
322 es_wr(es, ES1370_REG_MEMPAGE, ES1370_REG_DAC2_FRAMEADR >> 8, 1);
323 es_wr(es, ES1370_REG_DAC2_FRAMEADR & 0xff, sndbuf_getbufaddr(ch->buffer), 4);
324 es_wr(es, ES1370_REG_DAC2_FRAMECNT & 0xff, (ch->bufsz >> 2) - 1, 4);
325 } else {
326 es_wr(es, ES1370_REG_MEMPAGE, ES1370_REG_ADC_FRAMEADR >> 8, 1);
327 es_wr(es, ES1370_REG_ADC_FRAMEADR & 0xff, sndbuf_getbufaddr(ch->buffer), 4);
328 es_wr(es, ES1370_REG_ADC_FRAMECNT & 0xff, (ch->bufsz >> 2) - 1, 4);
329 }
330 ch->dir = dir;
331 return 0;
332}
333
334static int
335eschan_setformat(kobj_t obj, void *data, u_int32_t format)
336{
337 struct es_chinfo *ch = data;
338 struct es_info *es = ch->parent;
339
340 if (ch->dir == PCMDIR_PLAY) {
341 es->sctrl &= ~SCTRL_P2FMT;
342 if (format & AFMT_S16_LE) es->sctrl |= SCTRL_P2SEB;
343 if (format & AFMT_STEREO) es->sctrl |= SCTRL_P2SMB;
344 } else {
345 es->sctrl &= ~SCTRL_R1FMT;
346 if (format & AFMT_S16_LE) es->sctrl |= SCTRL_R1SEB;
347 if (format & AFMT_STEREO) es->sctrl |= SCTRL_R1SMB;
348 }
349 es_wr(es, ES1370_REG_SERIAL_CONTROL, es->sctrl, 4);
350 ch->fmt = format;
351 return 0;
352}
353
354static int
355eschan1370_setspeed(kobj_t obj, void *data, u_int32_t speed)
356{
357 struct es_chinfo *ch = data;
358 struct es_info *es = ch->parent;
359
360 es->ctrl &= ~CTRL_PCLKDIV;
361 es->ctrl |= DAC2_SRTODIV(speed) << CTRL_SH_PCLKDIV;
362 es_wr(es, ES1370_REG_CONTROL, es->ctrl, 4);
363 /* rec/play speeds locked together - should indicate in flags */
364 return speed; /* XXX calc real speed */
365}
366
367static int
368eschan1371_setspeed(kobj_t obj, void *data, u_int32_t speed)
369{
370 struct es_chinfo *ch = data;
371 struct es_info *es = ch->parent;
372 int i, delta;
373
374 if (ch->dir == PCMDIR_PLAY)
375 i = es1371_dac_rate(es, speed, 3 - ch->num); /* play */
376 else
377 i = es1371_adc_rate(es, speed, 1); /* record */
378 delta = (speed > i) ? speed - i : i - speed;
379 if (delta < 2)
380 return speed;
381 return i;
382}
383
384static int
385eschan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
386{
387 struct es_chinfo *ch = data;
388
389 ch->blksz = blocksize;
390 ch->bufsz = ch->blksz * 2;
391 sndbuf_resize(ch->buffer, 2, ch->blksz);
392 return ch->blksz;
393}
394
395static int
396eschan_trigger(kobj_t obj, void *data, int go)
397{
398 struct es_chinfo *ch = data;
399 struct es_info *es = ch->parent;
400 unsigned cnt;
401
402 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
403 return 0;
404
405 cnt = (ch->blksz / sndbuf_getbps(ch->buffer)) - 1;
406
407 if (ch->dir == PCMDIR_PLAY) {
408 if (go == PCMTRIG_START) {
409 int b = (ch->fmt & AFMT_S16_LE)? 2 : 1;
410 es->ctrl |= CTRL_DAC2_EN;
411 es->sctrl &= ~(SCTRL_P2ENDINC | SCTRL_P2STINC | SCTRL_P2LOOPSEL | SCTRL_P2PAUSE | SCTRL_P2DACSEN);
412 es->sctrl |= SCTRL_P2INTEN | (b << SCTRL_SH_P2ENDINC);
413 es_wr(es, ES1370_REG_DAC2_SCOUNT, cnt, 4);
414 /* start at beginning of buffer */
--- 8 unchanged lines hidden (view full) ---
423 es_wr(es, ES1370_REG_ADC_SCOUNT, cnt, 4);
424 /* start at beginning of buffer */
425 es_wr(es, ES1370_REG_MEMPAGE, ES1370_REG_ADC_FRAMECNT >> 8, 4);
426 es_wr(es, ES1370_REG_ADC_FRAMECNT & 0xff, (ch->bufsz >> 2) - 1, 4);
427 } else es->ctrl &= ~CTRL_ADC_EN;
428 }
429 es_wr(es, ES1370_REG_SERIAL_CONTROL, es->sctrl, 4);
430 es_wr(es, ES1370_REG_CONTROL, es->ctrl, 4);
431 return 0;
432}
433
434static int
435eschan_getptr(kobj_t obj, void *data)
436{
437 struct es_chinfo *ch = data;
438 struct es_info *es = ch->parent;
439 u_int32_t reg, cnt;
440
441 if (ch->dir == PCMDIR_PLAY)
442 reg = ES1370_REG_DAC2_FRAMECNT;
443 else
444 reg = ES1370_REG_ADC_FRAMECNT;
445 es_wr(es, ES1370_REG_MEMPAGE, reg >> 8, 4);
446 cnt = es_rd(es, reg & 0x000000ff, 4) >> 16;
447 /* cnt is longwords */
448 return cnt << 2;
449}
450
451static struct pcmchan_caps *
452eschan_getcaps(kobj_t obj, void *data)
453{
454 struct es_chinfo *ch = data;
455 return (ch->dir == PCMDIR_PLAY)? &es_playcaps : &es_reccaps;
456}
457
458static kobj_method_t eschan1370_methods[] = {
459 KOBJMETHOD(channel_init, eschan_init),
460 KOBJMETHOD(channel_setdir, eschan_setdir),
461 KOBJMETHOD(channel_setformat, eschan_setformat),
462 KOBJMETHOD(channel_setspeed, eschan1370_setspeed),
463 KOBJMETHOD(channel_setblocksize, eschan_setblocksize),
464 KOBJMETHOD(channel_trigger, eschan_trigger),
465 KOBJMETHOD(channel_getptr, eschan_getptr),
466 KOBJMETHOD(channel_getcaps, eschan_getcaps),
467 { 0, 0 }
468};
469CHANNEL_DECLARE(eschan1370);
470
471static kobj_method_t eschan1371_methods[] = {
472 KOBJMETHOD(channel_init, eschan_init),
473 KOBJMETHOD(channel_setdir, eschan_setdir),
474 KOBJMETHOD(channel_setformat, eschan_setformat),
475 KOBJMETHOD(channel_setspeed, eschan1371_setspeed),
476 KOBJMETHOD(channel_setblocksize, eschan_setblocksize),
477 KOBJMETHOD(channel_trigger, eschan_trigger),
478 KOBJMETHOD(channel_getptr, eschan_getptr),
479 KOBJMETHOD(channel_getcaps, eschan_getcaps),
480 { 0, 0 }
481};
482CHANNEL_DECLARE(eschan1371);
483
484/* -------------------------------------------------------------------- */
485/* The interrupt handler */
486static void
487es_intr(void *p)
488{
489 struct es_info *es = p;
490 unsigned intsrc, sctrl;
491
492 snd_mtxlock(es->lock);
493 intsrc = es_rd(es, ES1370_REG_STATUS, 4);
494 if ((intsrc & STAT_INTR) == 0) {
495 snd_mtxunlock(es->lock);
496 return;
497 }
498
499 sctrl = es->sctrl;
500 if (intsrc & STAT_ADC) sctrl &= ~SCTRL_R1INTEN;
501 if (intsrc & STAT_DAC1) sctrl &= ~SCTRL_P1INTEN;
502 if (intsrc & STAT_DAC2) sctrl &= ~SCTRL_P2INTEN;
503
504 es_wr(es, ES1370_REG_SERIAL_CONTROL, sctrl, 4);
505 es_wr(es, ES1370_REG_SERIAL_CONTROL, es->sctrl, 4);
506 snd_mtxunlock(es->lock);
507
508 if (intsrc & STAT_ADC) chn_intr(es->rch.channel);
509 if (intsrc & STAT_DAC1)
510 ; /* nothing */
511 if (intsrc & STAT_DAC2) chn_intr(es->pch.channel);
512}
513
514/* ES1370 specific */
515static int
516es1370_init(struct es_info *es)
517{
518 es->ctrl = CTRL_CDC_EN | CTRL_SERR_DIS |
519 (DAC2_SRTODIV(DSP_DEFAULT_SPEED) << CTRL_SH_PCLKDIV);
520 es_wr(es, ES1370_REG_CONTROL, es->ctrl, 4);
521
522 es->sctrl = 0;
523 es_wr(es, ES1370_REG_SERIAL_CONTROL, es->sctrl, 4);
524
525 es1370_wrcodec(es, CODEC_RES_PD, 3);/* No RST, PD */
526 es1370_wrcodec(es, CODEC_CSEL, 0); /* CODEC ADC and CODEC DAC use
527 * {LR,B}CLK2 and run off the LRCLK2
528 * PLL; program DAC_SYNC=0! */
529 es1370_wrcodec(es, CODEC_ADSEL, 0);/* Recording source is mixer */
530 es1370_wrcodec(es, CODEC_MGAIN, 0);/* MIC amp is 0db */
531
532 return 0;
533}
534
535/* ES1371 specific */
536int
537es1371_init(struct es_info *es, device_t dev)
538{
539 u_long cssr;
540 int idx;
541 int devid = pci_get_devid(dev);
542 int revid = pci_get_revid(dev);
543
544 es->num = 0;
545 es->ctrl = 0;
546 es->sctrl = 0;
547 cssr = 0;
548 if (devid == CT4730_PCI_ID) {
549 /* XXX amplifier hack? */
550 es->ctrl |= (1 << 16);
551 }
552 /* initialize the chips */
553 es_wr(es, ES1370_REG_CONTROL, es->ctrl, 4);
554 es_wr(es, ES1370_REG_SERIAL_CONTROL, es->sctrl, 4);
555 es_wr(es, ES1371_REG_LEGACY, 0, 4);
--- 34 unchanged lines hidden (view full) ---
590 * be stuck high, and I've found no way to rectify this other than
591 * power cycle)
592 */
593 es1371_wait_src_ready(es);
594 es_wr(es, ES1371_REG_SMPRATE, 0, 4);
595 /* try to reset codec directly */
596 es_wr(es, ES1371_REG_CODEC, 0, 4);
597 es_wr(es, ES1370_REG_STATUS, cssr, 4);
598
599 return (0);
600}
601
602/* -------------------------------------------------------------------- */
603
604static int
605es1371_wrcd(kobj_t obj, void *s, int addr, u_int32_t data)
606{
607 unsigned t, x, orig;
608 struct es_info *es = (struct es_info*)s;
609
610 for (t = 0; t < 0x1000; t++)
611 if (!es_rd(es, ES1371_REG_CODEC & CODEC_WIP, 4))
612 break;
613 /* save the current state for later */
614 x = orig = es_rd(es, ES1371_REG_SMPRATE, 4);
615 /* enable SRC state data in SRC mux */
--- 18 unchanged lines hidden (view full) ---
634 es_wr(es, ES1371_REG_SMPRATE, orig, 4);
635
636 return 0;
637}
638
639static int
640es1371_rdcd(kobj_t obj, void *s, int addr)
641{
642 unsigned t, x = 0, orig;
643 struct es_info *es = (struct es_info *)s;
644
645 for (t = 0; t < 0x1000; t++)
646 if (!(x = es_rd(es, ES1371_REG_CODEC, 4) & CODEC_WIP))
647 break;
648
649 /* save the current state for later */
650 x = orig = es_rd(es, ES1371_REG_SMPRATE, 4);
--- 34 unchanged lines hidden (view full) ---
685};
686AC97_DECLARE(es1371_ac97);
687
688/* -------------------------------------------------------------------- */
689
690static u_int
691es1371_src_read(struct es_info *es, u_short reg)
692{
693 unsigned int r;
694
695 r = es1371_wait_src_ready(es) &
696 (ES1371_DIS_SRC | ES1371_DIS_P1 | ES1371_DIS_P2 | ES1371_DIS_R1);
697 r |= ES1371_SRC_RAM_ADDRO(reg);
698 es_wr(es, ES1371_REG_SMPRATE, r, 4);
699 return ES1371_SRC_RAM_DATAI(es1371_wait_src_ready(es));
700}
701
702static void
703es1371_src_write(struct es_info *es, u_short reg, u_short data)
704{
705 u_int r;
706
707 r = es1371_wait_src_ready(es) &
708 (ES1371_DIS_SRC | ES1371_DIS_P1 | ES1371_DIS_P2 | ES1371_DIS_R1);
709 r |= ES1371_SRC_RAM_ADDRO(reg) | ES1371_SRC_RAM_DATAO(data);
710 es_wr(es, ES1371_REG_SMPRATE, r | ES1371_SRC_RAM_WE, 4);
711}
712
713static u_int
714es1371_adc_rate(struct es_info *es, u_int rate, int set)
715{
716 u_int n, truncm, freq, result;
717
718 if (rate > 48000) rate = 48000;
719 if (rate < 4000) rate = 4000;
720 n = rate / 3000;
721 if ((1 << n) & ((1 << 15) | (1 << 13) | (1 << 11) | (1 << 9)))
722 n--;
723 truncm = (21 * n - 1) | 1;
724 freq = ((48000UL << 15) / rate) * n;
725 result = (48000UL << 15) / (freq / n);
--- 17 unchanged lines hidden (view full) ---
743 return result;
744}
745
746static u_int
747es1371_dac_rate(struct es_info *es, u_int rate, int set)
748{
749 u_int freq, r, result, dac, dis;
750
751 if (rate > 48000) rate = 48000;
752 if (rate < 4000) rate = 4000;
753 freq = (rate << 15) / 3000;
754 result = (freq * 3000) >> 15;
755 if (set) {
756 dac = (set == 1)? ES_SMPREG_DAC1 : ES_SMPREG_DAC2;
757 dis = (set == 1)? ES1371_DIS_P2 : ES1371_DIS_P1;
758
759 r = (es1371_wait_src_ready(es) & (ES1371_DIS_SRC | ES1371_DIS_P1 | ES1371_DIS_P2 | ES1371_DIS_R1));
760 es_wr(es, ES1371_REG_SMPRATE, r, 4);
761 es1371_src_write(es, dac + ES_SMPREG_INT_REGS,
762 (es1371_src_read(es, dac + ES_SMPREG_INT_REGS) & 0x00ff) | ((freq >> 5) & 0xfc00));
763 es1371_src_write(es, dac + ES_SMPREG_VFREQ_FRAC, freq & 0x7fff);
764 r = (es1371_wait_src_ready(es) & (ES1371_DIS_SRC | dis | ES1371_DIS_R1));
765 es_wr(es, ES1371_REG_SMPRATE, r, 4);
766 }
767 return result;
768}
769
770static u_int
771es1371_wait_src_ready(struct es_info *es)
772{
773 u_int t, r;
774
775 for (t = 0; t < 0x1000; t++) {
776 if (!((r = es_rd(es, ES1371_REG_SMPRATE, 4)) & ES1371_SRC_RAM_BUSY))
777 return r;
778 DELAY(1);
779 }
780 printf("es1371: wait src ready timeout 0x%x [0x%x]\n", ES1371_REG_SMPRATE, r);
781 return 0;
782}
783
784/* -------------------------------------------------------------------- */
785
786/*
787 * Probe and attach the card
788 */
--- 76 unchanged lines hidden (view full) ---
865
866 default:
867 return ENXIO;
868 }
869}
870
871#ifdef SND_DYNSYSCTL
872static int
873sysctl_es1371x_spdif_enable(SYSCTL_HANDLER_ARGS)
874{
875 struct es_info *es;
876 device_t dev;
877 int err, new_en, r;
878
879 dev = oidp->oid_arg1;
880 es = pcm_getdevinfo(dev);
881 snd_mtxlock(es->lock);
882 new_en = es->spdif_en;
883 snd_mtxunlock(es->lock);
884 err = sysctl_handle_int(oidp, &new_en, sizeof(new_en), req);
885
886 if (err || req->newptr == NULL)
887 return err;
888 if (new_en < 0 || new_en > 1)
889 return EINVAL;
890
891 snd_mtxlock(es->lock);
892 es->spdif_en = new_en;
893 r = es_rd(es, ES1370_REG_STATUS, 4);
894 if (new_en) {
895 r |= ENABLE_SPDIF;
896 es->ctrl |= SPDIFEN_B;
897 es->ctrl |= RECEN_B;
898 } else {
899 r &= ~ENABLE_SPDIF;
900 es->ctrl &= ~SPDIFEN_B;
901 es->ctrl &= ~RECEN_B;
902 }
903 es_wr(es, ES1370_REG_CONTROL, es->ctrl, 4);
904 es_wr(es, ES1370_REG_STATUS, r, 4);
905 snd_mtxunlock(es->lock);
906 return 0;
907}
908
909static int
910sysctl_es1371x_latency_timer(SYSCTL_HANDLER_ARGS)
911{
912 struct es_info *es;
913 device_t dev;
914 int err, val;
915
916 dev = oidp->oid_arg1;
917 es = pcm_getdevinfo(dev);
918 snd_mtxlock(es->lock);
919 val = pci_read_config(dev, PCIR_LATTIMER, 1);
920 snd_mtxunlock(es->lock);
921 err = sysctl_handle_int(oidp, &val, sizeof(val), req);
922
923 if (err || req->newptr == NULL)
924 return err;
925 if (val < 0 || val > 255)
926 return EINVAL;
927
928 snd_mtxlock(es->lock);
929 pci_write_config(dev, PCIR_LATTIMER, val, 1);
930 snd_mtxunlock(es->lock);
931 return 0;
932}
933#endif /* SND_DYNSYSCTL */
934
935static void
936es_init_sysctls(device_t dev)
937{
938#ifdef SND_DYNSYSCTL
939 struct es_info *es;
940 int r, devid, revid;
941
942 devid = pci_get_devid(dev);
943 revid = pci_get_revid(dev);
944 es = pcm_getdevinfo(dev);
945 if ((devid == ES1371_PCI_ID && revid == ES1371REV_ES1373_8) ||
946 (devid == ES1371_PCI_ID && revid == ES1371REV_CT5880_A) ||
947 (devid == CT5880_PCI_ID && revid == CT5880REV_CT5880_C) ||
948 (devid == CT5880_PCI_ID && revid == CT5880REV_CT5880_D) ||
949 (devid == CT5880_PCI_ID && revid == CT5880REV_CT5880_E)) {
950 r = es_rd(es, ES1370_REG_STATUS, 4);
951 es->spdif_en = (r & ENABLE_SPDIF) ? 1 : 0;
952 SYSCTL_ADD_PROC(snd_sysctl_tree(dev),
953 SYSCTL_CHILDREN(snd_sysctl_tree_top(dev)),
954 OID_AUTO, "spdif_enabled",
955 CTLTYPE_INT | CTLFLAG_RW, dev, sizeof(dev),
956 sysctl_es1371x_spdif_enable, "I",
957 "Enable S/PDIF output on primary playback channel");
958 }
959 if (resource_int_value(device_get_name(dev),
960 device_get_unit(dev), "latency_timer", &r) == 0 &&
961 !(r < 0 || r > 255))
962 pci_write_config(dev, PCIR_LATTIMER, r, 1);
963 SYSCTL_ADD_PROC(snd_sysctl_tree(dev),
964 SYSCTL_CHILDREN(snd_sysctl_tree_top(dev)),
965 OID_AUTO, "latency_timer",
966 CTLTYPE_INT | CTLFLAG_RW, dev, sizeof(dev),
967 sysctl_es1371x_latency_timer, "I",
968 "PCI Latency Timer configuration");
969#endif /* SND_DYNSYSCTL */
970}
971
972static int
973es_pci_attach(device_t dev)
974{
975 u_int32_t data;
976 struct es_info *es = 0;
977 int mapped;
978 char status[SND_STATUSLEN];
979 struct ac97_info *codec = 0;
980 kobj_class_t ct = NULL;
981 int devid, revid;
982
983 if ((es = malloc(sizeof *es, M_DEVBUF, M_NOWAIT | M_ZERO)) == NULL) {
984 device_printf(dev, "cannot allocate softc\n");
985 return ENXIO;
986 }
987 es->lock = snd_mtxcreate(device_get_nameunit(dev), "sound softc");
988 es->dev = dev;
989 mapped = 0;
990 data = pci_read_config(dev, PCIR_COMMAND, 2);
991 data |= (PCIM_CMD_PORTEN|PCIM_CMD_MEMEN|PCIM_CMD_BUSMASTEREN);
992 pci_write_config(dev, PCIR_COMMAND, data, 2);
993 data = pci_read_config(dev, PCIR_COMMAND, 2);
994 if (mapped == 0 && (data & PCIM_CMD_MEMEN)) {
995 es->regid = MEM_MAP_REG;
996 es->regtype = SYS_RES_MEMORY;
997 es->reg = bus_alloc_resource_any(dev, es->regtype, &es->regid,
998 RF_ACTIVE);
999 if (es->reg) {
1000 es->st = rman_get_bustag(es->reg);
1001 es->sh = rman_get_bushandle(es->reg);
1002 mapped++;
1003 }
1004 }
1005 if (mapped == 0 && (data & PCIM_CMD_PORTEN)) {
1006 es->regid = PCIR_BAR(0);
1007 es->regtype = SYS_RES_IOPORT;
1008 es->reg = bus_alloc_resource_any(dev, es->regtype, &es->regid,
1009 RF_ACTIVE);
1010 if (es->reg) {
1011 es->st = rman_get_bustag(es->reg);
1012 es->sh = rman_get_bushandle(es->reg);
1013 mapped++;
1014 }
1015 }
1016 if (mapped == 0) {
1017 device_printf(dev, "unable to map register space\n");
1018 goto bad;
1019 }
1020
1021 es->bufsz = pcm_getbuffersize(dev, 4096, ES_DEFAULT_BUFSZ, 65536);
1022
1023 devid = pci_get_devid(dev);
1024 revid = pci_get_revid(dev);
1025
1026 if (devid == ES1371_PCI_ID || devid == ES1371_PCI_ID2 ||
1027 devid == CT5880_PCI_ID || devid == CT4730_PCI_ID) {
1028 if(-1 == es1371_init(es, dev)) {
1029 device_printf(dev, "unable to initialize the card\n");
1030 goto bad;
1031 }
1032 codec = AC97_CREATE(dev, es, es1371_ac97);
1033 if (codec == NULL) goto bad;
1034 /* our init routine does everything for us */
1035 /* set to NULL; flag mixer_init not to run the ac97_init */
1036 /* ac97_mixer.init = NULL; */
1037 if (mixer_init(dev, ac97_getmixerclass(), codec)) goto bad;
1038 ct = &eschan1371_class;
1039 } else if (devid == ES1370_PCI_ID) {
1040 if (-1 == es1370_init(es)) {
1041 device_printf(dev, "unable to initialize the card\n");
1042 goto bad;
1043 }
1044 if (mixer_init(dev, &es1370_mixer_class, es)) goto bad;
1045 ct = &eschan1370_class;
1046 } else goto bad;
1047
1048 es->irqid = 0;
1049 es->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &es->irqid,
1050 RF_ACTIVE | RF_SHAREABLE);
1051 if (!es->irq || snd_setup_intr(dev, es->irq, INTR_MPSAFE, es_intr, es, &es->ih)) {
1052 device_printf(dev, "unable to map interrupt\n");
1053 goto bad;
1054 }
--- 8 unchanged lines hidden (view full) ---
1063 device_printf(dev, "unable to create dma tag\n");
1064 goto bad;
1065 }
1066
1067 snprintf(status, SND_STATUSLEN, "at %s 0x%lx irq %ld %s",
1068 (es->regtype == SYS_RES_IOPORT)? "io" : "memory",
1069 rman_get_start(es->reg), rman_get_start(es->irq),PCM_KLDSTRING(snd_es137x));
1070
1071 if (pcm_register(dev, es, 1, 1)) goto bad;
1072 pcm_addchan(dev, PCMDIR_REC, ct, es);
1073 pcm_addchan(dev, PCMDIR_PLAY, ct, es);
1074 es_init_sysctls(dev);
1075 pcm_setstatus(dev, status);
1076
1077 return 0;
1078
1079 bad:
--- 12 unchanged lines hidden (view full) ---
1092{
1093 int r;
1094 struct es_info *es;
1095
1096 r = pcm_unregister(dev);
1097 if (r) return r;
1098
1099 es = pcm_getdevinfo(dev);
1100 bus_dma_tag_destroy(es->parent_dmat);
1101 bus_teardown_intr(dev, es->irq, es->ih);
1102 bus_release_resource(dev, SYS_RES_IRQ, es->irqid, es->irq);
1103 bus_release_resource(dev, es->regtype, es->regid, es->reg);
1104 snd_mtxfree(es->lock);
1105 free(es, M_DEVBUF);
1106
1107 return 0;
1108}
1109
1110static device_method_t es_methods[] = {
1111 /* Device interface */
--- 16 unchanged lines hidden ---