?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Rename sprintf -> ksprintf
[dfdiff.git] / sys / dev / sound / pci / es137x.c
blobe48b986a405966e2ce227caad5cd2cd002da7a73
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 <gandalf@vilnya.demon.co.uk>
7 * Copyright (c) 1998 by Joachim Kuebart. All rights reserved.
8 *
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
11 * are met:
12 *
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 *
16 * 2. Redistributions in binary form must reproduce the above copyright
17 * notice, this list of conditions and the following disclaimer in
18 * the documentation and/or other materials provided with the
19 * distribution.
20 *
21 * 3. All advertising materials mentioning features or use of this
22 * software must display the following acknowledgement:
23 * This product includes software developed by Joachim Kuebart.
24 *
25 * 4. The name of the author may not be used to endorse or promote
26 * products derived from this software without specific prior
27 * written permission.
28 *
29 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
30 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
31 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
32 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
33 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
34 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
35 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
36 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
37 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
38 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
39 * OF THE POSSIBILITY OF SUCH DAMAGE.
40 *
41 * $FreeBSD: src/sys/dev/sound/pci/es137x.c,v 1.13.2.10 2002/05/07 17:02:25 greid Exp $
42 * $DragonFly: src/sys/dev/sound/pci/es137x.c,v 1.7 2006/12/20 18:14:40 dillon Exp $
43 */
44
45 /*
46 * Part of this code was heavily inspired by the linux driver from
47 * Thomas Sailer (sailer@ife.ee.ethz.ch)
48 * Just about everything has been touched and reworked in some way but
49 * the all the underlying sequences/timing/register values are from
50 * Thomas' code.
51 *
52 */
53
54 #include <dev/sound/pcm/sound.h>
55 #include <dev/sound/pcm/ac97.h>
56 #include <dev/sound/pci/es137x.h>
57
58 #include <bus/pci/pcireg.h>
59 #include <bus/pci/pcivar.h>
60
61 #include <sys/sysctl.h>
62
63 #include "mixer_if.h"
64
65 SND_DECLARE_FILE("$DragonFly: src/sys/dev/sound/pci/es137x.c,v 1.7 2006/12/20 18:14:40 dillon Exp $");
66
67 static int debug = 0;
68 SYSCTL_INT(_debug, OID_AUTO, es_debug, CTLFLAG_RW, &debug, 0, "");
69
70 #define MEM_MAP_REG 0x14
71
72 /* PCI IDs of supported chips */
73 #define ES1370_PCI_ID 0x50001274
74 #define ES1371_PCI_ID 0x13711274
75 #define ES1371_PCI_ID2 0x13713274
76 #define CT5880_PCI_ID 0x58801274
77
78 #define ES1371REV_ES1371_A 0x02
79 #define ES1371REV_ES1371_B 0x09
80
81 #define ES1371REV_ES1373_8 0x08
82 #define ES1371REV_ES1373_A 0x04
83 #define ES1371REV_ES1373_B 0x06
84
85 #define ES1371REV_CT5880_A 0x07
86
87 #define CT5880REV_CT5880_C 0x02
88 #define CT5880REV_CT5880_D 0x03
89 #define CT5880REV_CT5880_E 0x04
90
91 #define ES_DEFAULT_BUFSZ 4096
92
93 /* device private data */
94 struct es_info;
95
96 struct es_chinfo {
97 struct es_info *parent;
98 struct pcm_channel *channel;
99 struct snd_dbuf *buffer;
100 int dir, num;
101 u_int32_t fmt, blksz, bufsz;
102 };
103
104 struct es_info {
105 bus_space_tag_t st;
106 bus_space_handle_t sh;
107 bus_dma_tag_t parent_dmat;
108
109 struct resource *reg, *irq;
110 int regtype, regid, irqid;
111 void *ih;
112
113 device_t dev;
114 int num;
115 unsigned int bufsz;
116
117 /* Contents of board's registers */
118 u_long ctrl;
119 u_long sctrl;
120 struct es_chinfo pch, rch;
121 };
122
123 /* -------------------------------------------------------------------- */
124
125 /* prototypes */
126 static void es_intr(void *);
127
128 static u_int es1371_wait_src_ready(struct es_info *);
129 static void es1371_src_write(struct es_info *, u_short, unsigned short);
130 static u_int es1371_adc_rate(struct es_info *, u_int, int);
131 static u_int es1371_dac_rate(struct es_info *, u_int, int);
132 static int es1371_init(struct es_info *, device_t);
133 static int es1370_init(struct es_info *);
134 static int es1370_wrcodec(struct es_info *, u_char, u_char);
135
136 static u_int32_t es_playfmt[] = {
137 AFMT_U8,
138 AFMT_STEREO | AFMT_U8,
139 AFMT_S16_LE,
140 AFMT_STEREO | AFMT_S16_LE,
141 0
142 };
143 static struct pcmchan_caps es_playcaps = {4000, 48000, es_playfmt, 0};
144
145 static u_int32_t es_recfmt[] = {
146 AFMT_U8,
147 AFMT_STEREO | AFMT_U8,
148 AFMT_S16_LE,
149 AFMT_STEREO | AFMT_S16_LE,
150 0
151 };
152 static struct pcmchan_caps es_reccaps = {4000, 48000, es_recfmt, 0};
153
154 static const struct {
155 unsigned volidx:4;
156 unsigned left:4;
157 unsigned right:4;
158 unsigned stereo:1;
159 unsigned recmask:13;
160 unsigned avail:1;
161 } mixtable[SOUND_MIXER_NRDEVICES] = {
162 [SOUND_MIXER_VOLUME] = { 0, 0x0, 0x1, 1, 0x0000, 1 },
163 [SOUND_MIXER_PCM] = { 1, 0x2, 0x3, 1, 0x0400, 1 },
164 [SOUND_MIXER_SYNTH] = { 2, 0x4, 0x5, 1, 0x0060, 1 },
165 [SOUND_MIXER_CD] = { 3, 0x6, 0x7, 1, 0x0006, 1 },
166 [SOUND_MIXER_LINE] = { 4, 0x8, 0x9, 1, 0x0018, 1 },
167 [SOUND_MIXER_LINE1] = { 5, 0xa, 0xb, 1, 0x1800, 1 },
168 [SOUND_MIXER_LINE2] = { 6, 0xc, 0x0, 0, 0x0100, 1 },
169 [SOUND_MIXER_LINE3] = { 7, 0xd, 0x0, 0, 0x0200, 1 },
170 [SOUND_MIXER_MIC] = { 8, 0xe, 0x0, 0, 0x0001, 1 },
171 [SOUND_MIXER_OGAIN] = { 9, 0xf, 0x0, 0, 0x0000, 1 }
172 };
173
174 /* -------------------------------------------------------------------- */
175 /* The es1370 mixer interface */
176
177 static int
178 es1370_mixinit(struct snd_mixer *m)
179 {
180 int i;
181 u_int32_t v;
182
183 v = 0;
184 for (i = 0; i < SOUND_MIXER_NRDEVICES; i++)
185 if (mixtable[i].avail) v |= (1 << i);
186 mix_setdevs(m, v);
187 v = 0;
188 for (i = 0; i < SOUND_MIXER_NRDEVICES; i++)
189 if (mixtable[i].recmask) v |= (1 << i);
190 mix_setrecdevs(m, v);
191 return 0;
192 }
193
194 static int
195 es1370_mixset(struct snd_mixer *m, unsigned dev, unsigned left, unsigned right)
196 {
197 int l, r, rl, rr;
198
199 if (!mixtable[dev].avail) return -1;
200 l = left;
201 r = mixtable[dev].stereo? right : l;
202 if (mixtable[dev].left == 0xf) {
203 rl = (l < 2)? 0x80 : 7 - (l - 2) / 14;
204 } else {
205 rl = (l < 10)? 0x80 : 15 - (l - 10) / 6;
206 }
207 if (mixtable[dev].stereo) {
208 rr = (r < 10)? 0x80 : 15 - (r - 10) / 6;
209 es1370_wrcodec(mix_getdevinfo(m), mixtable[dev].right, rr);
210 }
211 es1370_wrcodec(mix_getdevinfo(m), mixtable[dev].left, rl);
212 return l | (r << 8);
213 }
214
215 static int
216 es1370_mixsetrecsrc(struct snd_mixer *m, u_int32_t src)
217 {
218 int i, j = 0;
219
220 if (src == 0) src = 1 << SOUND_MIXER_MIC;
221 src &= mix_getrecdevs(m);
222 for (i = 0; i < SOUND_MIXER_NRDEVICES; i++)
223 if ((src & (1 << i)) != 0) j |= mixtable[i].recmask;
224
225 es1370_wrcodec(mix_getdevinfo(m), CODEC_LIMIX1, j & 0x55);
226 es1370_wrcodec(mix_getdevinfo(m), CODEC_RIMIX1, j & 0xaa);
227 es1370_wrcodec(mix_getdevinfo(m), CODEC_LIMIX2, (j >> 8) & 0x17);
228 es1370_wrcodec(mix_getdevinfo(m), CODEC_RIMIX2, (j >> 8) & 0x0f);
229 es1370_wrcodec(mix_getdevinfo(m), CODEC_OMIX1, 0x7f);
230 es1370_wrcodec(mix_getdevinfo(m), CODEC_OMIX2, 0x3f);
231 return src;
232 }
233
234 static kobj_method_t es1370_mixer_methods[] = {
235 KOBJMETHOD(mixer_init, es1370_mixinit),
236 KOBJMETHOD(mixer_set, es1370_mixset),
237 KOBJMETHOD(mixer_setrecsrc, es1370_mixsetrecsrc),
238 { 0, 0 }
239 };
240 MIXER_DECLARE(es1370_mixer);
241
242 /* -------------------------------------------------------------------- */
243
244 static int
245 es1370_wrcodec(struct es_info *es, u_char i, u_char data)
246 {
247 int wait = 100; /* 100 msec timeout */
248
249 do {
250 if ((bus_space_read_4(es->st, es->sh, ES1370_REG_STATUS) &
251 STAT_CSTAT) == 0) {
252 bus_space_write_2(es->st, es->sh, ES1370_REG_CODEC,
253 ((u_short)i << CODEC_INDEX_SHIFT) | data);
254 return 0;
255 }
256 DELAY(1000);
257 } while (--wait);
258 printf("pcm: es1370_wrcodec timed out\n");
259 return -1;
260 }
261
262 /* -------------------------------------------------------------------- */
263
264 /* channel interface */
265 static void *
266 eschan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
267 {
268 struct es_info *es = devinfo;
269 struct es_chinfo *ch = (dir == PCMDIR_PLAY)? &es->pch : &es->rch;
270
271 ch->parent = es;
272 ch->channel = c;
273 ch->buffer = b;
274 ch->bufsz = es->bufsz;
275 ch->blksz = ch->bufsz / 2;
276 ch->num = ch->parent->num++;
277 if (sndbuf_alloc(ch->buffer, es->parent_dmat, ch->bufsz) == -1) return NULL;
278 return ch;
279 }
280
281 static int
282 eschan_setdir(kobj_t obj, void *data, int dir)
283 {
284 struct es_chinfo *ch = data;
285 struct es_info *es = ch->parent;
286
287 if (dir == PCMDIR_PLAY) {
288 bus_space_write_1(es->st, es->sh, ES1370_REG_MEMPAGE, ES1370_REG_DAC2_FRAMEADR >> 8);
289 bus_space_write_4(es->st, es->sh, ES1370_REG_DAC2_FRAMEADR & 0xff, vtophys(sndbuf_getbuf(ch->buffer)));
290 bus_space_write_4(es->st, es->sh, ES1370_REG_DAC2_FRAMECNT & 0xff, (ch->bufsz >> 2) - 1);
291 } else {
292 bus_space_write_1(es->st, es->sh, ES1370_REG_MEMPAGE, ES1370_REG_ADC_FRAMEADR >> 8);
293 bus_space_write_4(es->st, es->sh, ES1370_REG_ADC_FRAMEADR & 0xff, vtophys(sndbuf_getbuf(ch->buffer)));
294 bus_space_write_4(es->st, es->sh, ES1370_REG_ADC_FRAMECNT & 0xff, (ch->bufsz >> 2) - 1);
295 }
296 ch->dir = dir;
297 return 0;
298 }
299
300 static int
301 eschan_setformat(kobj_t obj, void *data, u_int32_t format)
302 {
303 struct es_chinfo *ch = data;
304 struct es_info *es = ch->parent;
305
306 if (ch->dir == PCMDIR_PLAY) {
307 es->sctrl &= ~SCTRL_P2FMT;
308 if (format & AFMT_S16_LE) es->sctrl |= SCTRL_P2SEB;
309 if (format & AFMT_STEREO) es->sctrl |= SCTRL_P2SMB;
310 } else {
311 es->sctrl &= ~SCTRL_R1FMT;
312 if (format & AFMT_S16_LE) es->sctrl |= SCTRL_R1SEB;
313 if (format & AFMT_STEREO) es->sctrl |= SCTRL_R1SMB;
314 }
315 bus_space_write_4(es->st, es->sh, ES1370_REG_SERIAL_CONTROL, es->sctrl);
316 ch->fmt = format;
317 return 0;
318 }
319
320 static int
321 eschan1370_setspeed(kobj_t obj, void *data, u_int32_t speed)
322 {
323 struct es_chinfo *ch = data;
324 struct es_info *es = ch->parent;
325
326 es->ctrl &= ~CTRL_PCLKDIV;
327 es->ctrl |= DAC2_SRTODIV(speed) << CTRL_SH_PCLKDIV;
328 bus_space_write_4(es->st, es->sh, ES1370_REG_CONTROL, es->ctrl);
329 /* rec/play speeds locked together - should indicate in flags */
330 return speed; /* XXX calc real speed */
331 }
332
333 static int
334 eschan1371_setspeed(kobj_t obj, void *data, u_int32_t speed)
335 {
336 struct es_chinfo *ch = data;
337 struct es_info *es = ch->parent;
338
339 if (ch->dir == PCMDIR_PLAY) {
340 return es1371_dac_rate(es, speed, 3 - ch->num); /* play */
341 } else {
342 return es1371_adc_rate(es, speed, 1); /* record */
343 }
344 }
345
346 static int
347 eschan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
348 {
349 struct es_chinfo *ch = data;
350
351 ch->blksz = blocksize;
352 ch->bufsz = ch->blksz * 2;
353 sndbuf_resize(ch->buffer, 2, ch->blksz);
354
355 return ch->blksz;
356 }
357
358 static int
359 eschan_trigger(kobj_t obj, void *data, int go)
360 {
361 struct es_chinfo *ch = data;
362 struct es_info *es = ch->parent;
363 unsigned cnt;
364
365 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
366 return 0;
367
368 cnt = (ch->blksz / sndbuf_getbps(ch->buffer)) - 1;
369
370 if (ch->dir == PCMDIR_PLAY) {
371 if (go == PCMTRIG_START) {
372 int b = (ch->fmt & AFMT_S16_LE)? 2 : 1;
373 es->ctrl |= CTRL_DAC2_EN;
374 es->sctrl &= ~(SCTRL_P2ENDINC | SCTRL_P2STINC | SCTRL_P2LOOPSEL | SCTRL_P2PAUSE | SCTRL_P2DACSEN);
375 es->sctrl |= SCTRL_P2INTEN | (b << SCTRL_SH_P2ENDINC);
376 bus_space_write_4(es->st, es->sh, ES1370_REG_DAC2_SCOUNT, cnt);
377 /* start at beginning of buffer */
378 bus_space_write_4(es->st, es->sh, ES1370_REG_MEMPAGE, ES1370_REG_DAC2_FRAMECNT >> 8);
379 bus_space_write_4(es->st, es->sh, ES1370_REG_DAC2_FRAMECNT & 0xff, (ch->bufsz >> 2) - 1);
380 } else es->ctrl &= ~CTRL_DAC2_EN;
381 } else {
382 if (go == PCMTRIG_START) {
383 es->ctrl |= CTRL_ADC_EN;
384 es->sctrl &= ~SCTRL_R1LOOPSEL;
385 es->sctrl |= SCTRL_R1INTEN;
386 bus_space_write_4(es->st, es->sh, ES1370_REG_ADC_SCOUNT, cnt);
387 /* start at beginning of buffer */
388 bus_space_write_4(es->st, es->sh, ES1370_REG_MEMPAGE, ES1370_REG_ADC_FRAMECNT >> 8);
389 bus_space_write_4(es->st, es->sh, ES1370_REG_ADC_FRAMECNT & 0xff, (ch->bufsz >> 2) - 1);
390 } else es->ctrl &= ~CTRL_ADC_EN;
391 }
392 bus_space_write_4(es->st, es->sh, ES1370_REG_SERIAL_CONTROL, es->sctrl);
393 bus_space_write_4(es->st, es->sh, ES1370_REG_CONTROL, es->ctrl);
394 return 0;
395 }
396
397 static int
398 eschan_getptr(kobj_t obj, void *data)
399 {
400 struct es_chinfo *ch = data;
401 struct es_info *es = ch->parent;
402 u_int32_t reg, cnt;
403
404 if (ch->dir == PCMDIR_PLAY)
405 reg = ES1370_REG_DAC2_FRAMECNT;
406 else
407 reg = ES1370_REG_ADC_FRAMECNT;
408
409 bus_space_write_4(es->st, es->sh, ES1370_REG_MEMPAGE, reg >> 8);
410 cnt = bus_space_read_4(es->st, es->sh, reg & 0x000000ff) >> 16;
411 /* cnt is longwords */
412 return cnt << 2;
413 }
414
415 static struct pcmchan_caps *
416 eschan_getcaps(kobj_t obj, void *data)
417 {
418 struct es_chinfo *ch = data;
419 return (ch->dir == PCMDIR_PLAY)? &es_playcaps : &es_reccaps;
420 }
421
422 static kobj_method_t eschan1370_methods[] = {
423 KOBJMETHOD(channel_init, eschan_init),
424 KOBJMETHOD(channel_setdir, eschan_setdir),
425 KOBJMETHOD(channel_setformat, eschan_setformat),
426 KOBJMETHOD(channel_setspeed, eschan1370_setspeed),
427 KOBJMETHOD(channel_setblocksize, eschan_setblocksize),
428 KOBJMETHOD(channel_trigger, eschan_trigger),
429 KOBJMETHOD(channel_getptr, eschan_getptr),
430 KOBJMETHOD(channel_getcaps, eschan_getcaps),
431 { 0, 0 }
432 };
433 CHANNEL_DECLARE(eschan1370);
434
435 static kobj_method_t eschan1371_methods[] = {
436 KOBJMETHOD(channel_init, eschan_init),
437 KOBJMETHOD(channel_setdir, eschan_setdir),
438 KOBJMETHOD(channel_setformat, eschan_setformat),
439 KOBJMETHOD(channel_setspeed, eschan1371_setspeed),
440 KOBJMETHOD(channel_setblocksize, eschan_setblocksize),
441 KOBJMETHOD(channel_trigger, eschan_trigger),
442 KOBJMETHOD(channel_getptr, eschan_getptr),
443 KOBJMETHOD(channel_getcaps, eschan_getcaps),
444 { 0, 0 }
445 };
446 CHANNEL_DECLARE(eschan1371);
447
448 /* -------------------------------------------------------------------- */
449 /* The interrupt handler */
450 static void
451 es_intr(void *p)
452 {
453 struct es_info *es = p;
454 unsigned intsrc, sctrl;
455
456 intsrc = bus_space_read_4(es->st, es->sh, ES1370_REG_STATUS);
457 if ((intsrc & STAT_INTR) == 0) return;
458
459 sctrl = es->sctrl;
460 if (intsrc & STAT_ADC) sctrl &= ~SCTRL_R1INTEN;
461 if (intsrc & STAT_DAC1) sctrl &= ~SCTRL_P1INTEN;
462 if (intsrc & STAT_DAC2) sctrl &= ~SCTRL_P2INTEN;
463
464 bus_space_write_4(es->st, es->sh, ES1370_REG_SERIAL_CONTROL, sctrl);
465 bus_space_write_4(es->st, es->sh, ES1370_REG_SERIAL_CONTROL, es->sctrl);
466
467 if (intsrc & STAT_ADC) chn_intr(es->rch.channel);
468 if (intsrc & STAT_DAC1);
469 if (intsrc & STAT_DAC2) chn_intr(es->pch.channel);
470 }
471
472 /* ES1370 specific */
473 static int
474 es1370_init(struct es_info *es)
475 {
476 es->ctrl = CTRL_CDC_EN | CTRL_SERR_DIS |
477 (DAC2_SRTODIV(DSP_DEFAULT_SPEED) << CTRL_SH_PCLKDIV);
478 bus_space_write_4(es->st, es->sh, ES1370_REG_CONTROL, es->ctrl);
479
480 es->sctrl = 0;
481 bus_space_write_4(es->st, es->sh, ES1370_REG_SERIAL_CONTROL, es->sctrl);
482
483 es1370_wrcodec(es, CODEC_RES_PD, 3);/* No RST, PD */
484 es1370_wrcodec(es, CODEC_CSEL, 0); /* CODEC ADC and CODEC DAC use
485 * {LR,B}CLK2 and run off the LRCLK2
486 * PLL; program DAC_SYNC=0! */
487 es1370_wrcodec(es, CODEC_ADSEL, 0);/* Recording source is mixer */
488 es1370_wrcodec(es, CODEC_MGAIN, 0);/* MIC amp is 0db */
489
490 return 0;
491 }
492
493 /* ES1371 specific */
494 int
495 es1371_init(struct es_info *es, device_t dev)
496 {
497 int idx;
498 int devid = pci_get_devid(dev);
499 int revid = pci_get_revid(dev);
500
501 if (debug > 0) printf("es_init\n");
502
503 es->num = 0;
504 es->ctrl = 0;
505 es->sctrl = 0;
506 /* initialize the chips */
507 if ((devid == ES1371_PCI_ID && revid == ES1371REV_ES1373_8) ||
508 (devid == ES1371_PCI_ID && revid == ES1371REV_CT5880_A) ||
509 (devid == CT5880_PCI_ID && revid == CT5880REV_CT5880_C) ||
510 (devid == CT5880_PCI_ID && revid == CT5880REV_CT5880_D) ||
511 (devid == CT5880_PCI_ID && revid == CT5880REV_CT5880_E)) {
512 bus_space_write_4(es->st, es->sh, ES1370_REG_STATUS, 0x20000000);
513 DELAY(20000);
514 if (debug > 0) device_printf(dev, "ac97 2.1 enabled\n");
515 } else { /* pre ac97 2.1 card */
516 bus_space_write_4(es->st, es->sh, ES1370_REG_CONTROL, es->ctrl);
517 if (debug > 0) device_printf(dev, "ac97 pre-2.1 enabled\n");
518 }
519 bus_space_write_4(es->st, es->sh, ES1370_REG_SERIAL_CONTROL, es->sctrl);
520 bus_space_write_4(es->st, es->sh, ES1371_REG_LEGACY, 0);
521 /* AC'97 warm reset to start the bitclk */
522 bus_space_write_4(es->st, es->sh, ES1371_REG_LEGACY, es->ctrl | ES1371_SYNC_RES);
523 DELAY(2000);
524 bus_space_write_4(es->st, es->sh, ES1370_REG_SERIAL_CONTROL, es->ctrl);
525 /* Init the sample rate converter */
526 bus_space_write_4(es->st, es->sh, ES1371_REG_SMPRATE, ES1371_DIS_SRC);
527 for (idx = 0; idx < 0x80; idx++)
528 es1371_src_write(es, idx, 0);
529 es1371_src_write(es, ES_SMPREG_DAC1 + ES_SMPREG_TRUNC_N, 16 << 4);
530 es1371_src_write(es, ES_SMPREG_DAC1 + ES_SMPREG_INT_REGS, 16 << 10);
531 es1371_src_write(es, ES_SMPREG_DAC2 + ES_SMPREG_TRUNC_N, 16 << 4);
532 es1371_src_write(es, ES_SMPREG_DAC2 + ES_SMPREG_INT_REGS, 16 << 10);
533 es1371_src_write(es, ES_SMPREG_VOL_ADC, 1 << 12);
534 es1371_src_write(es, ES_SMPREG_VOL_ADC + 1, 1 << 12);
535 es1371_src_write(es, ES_SMPREG_VOL_DAC1, 1 << 12);
536 es1371_src_write(es, ES_SMPREG_VOL_DAC1 + 1, 1 << 12);
537 es1371_src_write(es, ES_SMPREG_VOL_DAC2, 1 << 12);
538 es1371_src_write(es, ES_SMPREG_VOL_DAC2 + 1, 1 << 12);
539 es1371_adc_rate (es, 22050, 1);
540 es1371_dac_rate (es, 22050, 1);
541 es1371_dac_rate (es, 22050, 2);
542 /* WARNING:
543 * enabling the sample rate converter without properly programming
544 * its parameters causes the chip to lock up (the SRC busy bit will
545 * be stuck high, and I've found no way to rectify this other than
546 * power cycle)
547 */
548 bus_space_write_4(es->st, es->sh, ES1371_REG_SMPRATE, 0);
549
550 return (0);
551 }
552
553 /* -------------------------------------------------------------------- */
554
555 static int
556 es1371_wrcd(kobj_t obj, void *s, int addr, u_int32_t data)
557 {
558 unsigned t, x;
559 struct es_info *es = (struct es_info*)s;
560
561 if (debug > 0) printf("wrcodec addr 0x%x data 0x%x\n", addr, data);
562
563 for (t = 0; t < 0x1000; t++)
564 if (!(bus_space_read_4(es->st, es->sh,(ES1371_REG_CODEC & CODEC_WIP))))
565 break;
566 crit_enter();
567 /* save the current state for later */
568 x = bus_space_read_4(es->st, es->sh, ES1371_REG_SMPRATE);
569 /* enable SRC state data in SRC mux */
570 bus_space_write_4(es->st, es->sh, ES1371_REG_SMPRATE,
571 (es1371_wait_src_ready(s) &
572 (ES1371_DIS_SRC | ES1371_DIS_P1 | ES1371_DIS_P2 | ES1371_DIS_R1)));
573 /* wait for a SAFE time to write addr/data and then do it, dammit */
574 for (t = 0; t < 0x1000; t++)
575 if ((bus_space_read_4(es->st, es->sh, ES1371_REG_SMPRATE) & 0x00070000) == 0x00010000)
576 break;
577
578 if (debug > 2)
579 printf("one b_s_w: 0x%lx 0x%x 0x%x\n",
580 rman_get_start(es->reg), ES1371_REG_CODEC,
581 ((addr << CODEC_POADD_SHIFT) & CODEC_POADD_MASK) |
582 ((data << CODEC_PODAT_SHIFT) & CODEC_PODAT_MASK));
583
584 bus_space_write_4(es->st, es->sh,ES1371_REG_CODEC,
585 ((addr << CODEC_POADD_SHIFT) & CODEC_POADD_MASK) |
586 ((data << CODEC_PODAT_SHIFT) & CODEC_PODAT_MASK));
587 /* restore SRC reg */
588 es1371_wait_src_ready(s);
589 if (debug > 2)
590 printf("two b_s_w: 0x%lx 0x%x 0x%x\n",
591 rman_get_start(es->reg), ES1371_REG_SMPRATE, x);
592 bus_space_write_4(es->st, es->sh, ES1371_REG_SMPRATE, x);
593 crit_exit();
594
595 return 0;
596 }
597
598 static int
599 es1371_rdcd(kobj_t obj, void *s, int addr)
600 {
601 unsigned t, x = 0;
602 struct es_info *es = (struct es_info *)s;
603
604 if (debug > 0) printf("rdcodec addr 0x%x ... ", addr);
605
606 for (t = 0; t < 0x1000; t++)
607 if (!(x = bus_space_read_4(es->st, es->sh, ES1371_REG_CODEC) & CODEC_WIP))
608 break;
609 if (debug > 0) printf("loop 1 t 0x%x x 0x%x ", t, x);
610
611 crit_enter();
612
613 /* save the current state for later */
614 x = bus_space_read_4(es->st, es->sh, ES1371_REG_SMPRATE);
615 /* enable SRC state data in SRC mux */
616 bus_space_write_4(es->st, es->sh, ES1371_REG_SMPRATE,
617 (es1371_wait_src_ready(s) &
618 (ES1371_DIS_SRC | ES1371_DIS_P1 | ES1371_DIS_P2 | ES1371_DIS_R1)));
619 /* wait for a SAFE time to write addr/data and then do it, dammit */
620 for (t = 0; t < 0x5000; t++)
621 if ((x = bus_space_read_4(es->st, es->sh, ES1371_REG_SMPRATE) & 0x00070000) == 0x00010000)
622 break;
623 if (debug > 0) printf("loop 2 t 0x%x x 0x%x ", t, x);
624 bus_space_write_4(es->st, es->sh, ES1371_REG_CODEC,
625 ((addr << CODEC_POADD_SHIFT) & CODEC_POADD_MASK) | CODEC_PORD);
626
627 /* restore SRC reg */
628 es1371_wait_src_ready(s);
629 bus_space_write_4(es->st, es->sh, ES1371_REG_SMPRATE, x);
630
631 crit_exit();
632
633 /* now wait for the stinkin' data (RDY) */
634 for (t = 0; t < 0x1000; t++)
635 if ((x = bus_space_read_4(es->st, es->sh, ES1371_REG_CODEC)) & CODEC_RDY)
636 break;
637 if (debug > 0) printf("loop 3 t 0x%x 0x%x ret 0x%x\n", t, x, ((x & CODEC_PIDAT_MASK) >> CODEC_PIDAT_SHIFT));
638 return ((x & CODEC_PIDAT_MASK) >> CODEC_PIDAT_SHIFT);
639 }
640
641 static kobj_method_t es1371_ac97_methods[] = {
642 KOBJMETHOD(ac97_read, es1371_rdcd),
643 KOBJMETHOD(ac97_write, es1371_wrcd),
644 { 0, 0 }
645 };
646 AC97_DECLARE(es1371_ac97);
647
648 /* -------------------------------------------------------------------- */
649
650 static u_int
651 es1371_src_read(struct es_info *es, u_short reg)
652 {
653 unsigned int r;
654
655 r = es1371_wait_src_ready(es) &
656 (ES1371_DIS_SRC | ES1371_DIS_P1 | ES1371_DIS_P2 | ES1371_DIS_R1);
657 r |= ES1371_SRC_RAM_ADDRO(reg);
658 bus_space_write_4(es->st, es->sh, ES1371_REG_SMPRATE,r);
659 return ES1371_SRC_RAM_DATAI(es1371_wait_src_ready(es));
660 }
661
662 static void
663 es1371_src_write(struct es_info *es, u_short reg, u_short data){
664 u_int r;
665
666 r = es1371_wait_src_ready(es) &
667 (ES1371_DIS_SRC | ES1371_DIS_P1 | ES1371_DIS_P2 | ES1371_DIS_R1);
668 r |= ES1371_SRC_RAM_ADDRO(reg) | ES1371_SRC_RAM_DATAO(data);
669 /* printf("es1371_src_write 0x%x 0x%x\n",ES1371_REG_SMPRATE,r | ES1371_SRC_RAM_WE); */
670 bus_space_write_4(es->st, es->sh, ES1371_REG_SMPRATE, r | ES1371_SRC_RAM_WE);
671 }
672
673 static u_int
674 es1371_adc_rate(struct es_info *es, u_int rate, int set)
675 {
676 u_int n, truncm, freq, result;
677
678 if (rate > 48000) rate = 48000;
679 if (rate < 4000) rate = 4000;
680 n = rate / 3000;
681 if ((1 << n) & ((1 << 15) | (1 << 13) | (1 << 11) | (1 << 9)))
682 n--;
683 truncm = (21 * n - 1) | 1;
684 freq = ((48000UL << 15) / rate) * n;
685 result = (48000UL << 15) / (freq / n);
686 if (set) {
687 if (rate >= 24000) {
688 if (truncm > 239) truncm = 239;
689 es1371_src_write(es, ES_SMPREG_ADC + ES_SMPREG_TRUNC_N,
690 (((239 - truncm) >> 1) << 9) | (n << 4));
691 } else {
692 if (truncm > 119) truncm = 119;
693 es1371_src_write(es, ES_SMPREG_ADC + ES_SMPREG_TRUNC_N,
694 0x8000 | (((119 - truncm) >> 1) << 9) | (n << 4));
695 }
696 es1371_src_write(es, ES_SMPREG_ADC + ES_SMPREG_INT_REGS,
697 (es1371_src_read(es, ES_SMPREG_ADC + ES_SMPREG_INT_REGS) &
698 0x00ff) | ((freq >> 5) & 0xfc00));
699 es1371_src_write(es, ES_SMPREG_ADC + ES_SMPREG_VFREQ_FRAC, freq & 0x7fff);
700 es1371_src_write(es, ES_SMPREG_VOL_ADC, n << 8);
701 es1371_src_write(es, ES_SMPREG_VOL_ADC + 1, n << 8);
702 }
703 return result;
704 }
705
706 static u_int
707 es1371_dac_rate(struct es_info *es, u_int rate, int set)
708 {
709 u_int freq, r, result, dac, dis;
710
711 if (rate > 48000) rate = 48000;
712 if (rate < 4000) rate = 4000;
713 freq = (rate << 15) / 3000;
714 result = (freq * 3000) >> 15;
715 if (set) {
716 dac = (set == 1)? ES_SMPREG_DAC1 : ES_SMPREG_DAC2;
717 dis = (set == 1)? ES1371_DIS_P2 : ES1371_DIS_P1;
718
719 r = (es1371_wait_src_ready(es) & (ES1371_DIS_SRC | ES1371_DIS_P1 | ES1371_DIS_P2 | ES1371_DIS_R1));
720 bus_space_write_4(es->st, es->sh, ES1371_REG_SMPRATE, r);
721 es1371_src_write(es, dac + ES_SMPREG_INT_REGS,
722 (es1371_src_read(es, dac + ES_SMPREG_INT_REGS) & 0x00ff) | ((freq >> 5) & 0xfc00));
723 es1371_src_write(es, dac + ES_SMPREG_VFREQ_FRAC, freq & 0x7fff);
724 r = (es1371_wait_src_ready(es) & (ES1371_DIS_SRC | dis | ES1371_DIS_R1));
725 bus_space_write_4(es->st, es->sh, ES1371_REG_SMPRATE, r);
726 }
727 return result;
728 }
729
730 static u_int
731 es1371_wait_src_ready(struct es_info *es)
732 {
733 u_int t, r;
734
735 for (t = 0; t < 500; t++) {
736 if (!((r = bus_space_read_4(es->st, es->sh, ES1371_REG_SMPRATE)) & ES1371_SRC_RAM_BUSY))
737 return r;
738 DELAY(1000);
739 }
740 printf("es1371: wait src ready timeout 0x%x [0x%x]\n", ES1371_REG_SMPRATE, r);
741 return 0;
742 }
743
744 /* -------------------------------------------------------------------- */
745
746 /*
747 * Probe and attach the card
748 */
749
750 static int
751 es_pci_probe(device_t dev)
752 {
753 switch(pci_get_devid(dev)) {
754 case ES1370_PCI_ID:
755 device_set_desc(dev, "AudioPCI ES1370");
756 return 0;
757
758 case ES1371_PCI_ID:
759 switch(pci_get_revid(dev)) {
760 case ES1371REV_ES1371_A:
761 device_set_desc(dev, "AudioPCI ES1371-A");
762 return 0;
763
764 case ES1371REV_ES1371_B:
765 device_set_desc(dev, "AudioPCI ES1371-B");
766 return 0;
767
768 case ES1371REV_ES1373_A:
769 device_set_desc(dev, "AudioPCI ES1373-A");
770 return 0;
771
772 case ES1371REV_ES1373_B:
773 device_set_desc(dev, "AudioPCI ES1373-B");
774 return 0;
775
776 case ES1371REV_ES1373_8:
777 device_set_desc(dev, "AudioPCI ES1373-8");
778 return 0;
779
780 case ES1371REV_CT5880_A:
781 device_set_desc(dev, "Creative CT5880-A");
782 return 0;
783
784 default:
785 device_set_desc(dev, "AudioPCI ES1371-?");
786 device_printf(dev, "unknown revision %d -- please report to cg@freebsd.org\n", pci_get_revid(dev));
787 return 0;
788 }
789
790 case ES1371_PCI_ID2:
791 device_set_desc(dev, "Strange AudioPCI ES1371-? (vid=3274)");
792 device_printf(dev, "unknown revision %d -- please report to cg@freebsd.org\n", pci_get_revid(dev));
793 return 0;
794
795 case CT5880_PCI_ID:
796 switch(pci_get_revid(dev)) {
797 case CT5880REV_CT5880_C:
798 device_set_desc(dev, "Creative CT5880-C");
799 return 0;
800
801 case CT5880REV_CT5880_D:
802 device_set_desc(dev, "Creative CT5880-D");
803 return 0;
804
805 case CT5880REV_CT5880_E:
806 device_set_desc(dev, "Creative CT5880-E");
807 return 0;
808
809 default:
810 device_set_desc(dev, "Creative CT5880-?");
811 device_printf(dev, "unknown revision %d -- please report to cg@freebsd.org\n", pci_get_revid(dev));
812 return 0;
813 }
814
815 default:
816 return ENXIO;
817 }
818 }
819
820 static int
821 es_pci_attach(device_t dev)
822 {
823 u_int32_t data;
824 struct es_info *es = 0;
825 int mapped;
826 char status[SND_STATUSLEN];
827 struct ac97_info *codec = 0;
828 kobj_class_t ct = NULL;
829
830 if ((es = kmalloc(sizeof *es, M_DEVBUF, M_NOWAIT | M_ZERO)) == NULL) {
831 device_printf(dev, "cannot allocate softc\n");
832 return ENXIO;
833 }
834
835 es->dev = dev;
836 mapped = 0;
837 data = pci_read_config(dev, PCIR_COMMAND, 2);
838 data |= (PCIM_CMD_PORTEN|PCIM_CMD_MEMEN|PCIM_CMD_BUSMASTEREN);
839 pci_write_config(dev, PCIR_COMMAND, data, 2);
840 data = pci_read_config(dev, PCIR_COMMAND, 2);
841 if (mapped == 0 && (data & PCIM_CMD_MEMEN)) {
842 es->regid = MEM_MAP_REG;
843 es->regtype = SYS_RES_MEMORY;
844 es->reg = bus_alloc_resource(dev, es->regtype, &es->regid,
845 0, ~0, 1, RF_ACTIVE);
846 if (es->reg) {
847 es->st = rman_get_bustag(es->reg);
848 es->sh = rman_get_bushandle(es->reg);
849 mapped++;
850 }
851 }
852 if (mapped == 0 && (data & PCIM_CMD_PORTEN)) {
853 es->regid = PCIR_MAPS;
854 es->regtype = SYS_RES_IOPORT;
855 es->reg = bus_alloc_resource(dev, es->regtype, &es->regid,
856 0, ~0, 1, RF_ACTIVE);
857 if (es->reg) {
858 es->st = rman_get_bustag(es->reg);
859 es->sh = rman_get_bushandle(es->reg);
860 mapped++;
861 }
862 }
863 if (mapped == 0) {
864 device_printf(dev, "unable to map register space\n");
865 goto bad;
866 }
867
868 es->bufsz = pcm_getbuffersize(dev, 4096, ES_DEFAULT_BUFSZ, 65536);
869
870 if (pci_get_devid(dev) == ES1371_PCI_ID ||
871 pci_get_devid(dev) == ES1371_PCI_ID2 ||
872 pci_get_devid(dev) == CT5880_PCI_ID) {
873 if(-1 == es1371_init(es, dev)) {
874 device_printf(dev, "unable to initialize the card\n");
875 goto bad;
876 }
877 codec = AC97_CREATE(dev, es, es1371_ac97);
878 if (codec == NULL) goto bad;
879 /* our init routine does everything for us */
880 /* set to NULL; flag mixer_init not to run the ac97_init */
881 /* ac97_mixer.init = NULL; */
882 if (mixer_init(dev, ac97_getmixerclass(), codec)) goto bad;
883 ct = &eschan1371_class;
884 } else if (pci_get_devid(dev) == ES1370_PCI_ID) {
885 if (-1 == es1370_init(es)) {
886 device_printf(dev, "unable to initialize the card\n");
887 goto bad;
888 }
889 if (mixer_init(dev, &es1370_mixer_class, es)) goto bad;
890 ct = &eschan1370_class;
891 } else goto bad;
892
893 es->irqid = 0;
894 es->irq = bus_alloc_resource(dev, SYS_RES_IRQ, &es->irqid,
895 0, ~0, 1, RF_ACTIVE | RF_SHAREABLE);
896 if (!es->irq || snd_setup_intr(dev, es->irq, 0, es_intr, es, &es->ih, NULL)) {
897 device_printf(dev, "unable to map interrupt\n");
898 goto bad;
899 }
900
901 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0,
902 /*lowaddr*/BUS_SPACE_MAXADDR_32BIT,
903 /*highaddr*/BUS_SPACE_MAXADDR,
904 /*filter*/NULL, /*filterarg*/NULL,
905 /*maxsize*/es->bufsz, /*nsegments*/1, /*maxsegz*/0x3ffff,
906 /*flags*/0, &es->parent_dmat) != 0) {
907 device_printf(dev, "unable to create dma tag\n");
908 goto bad;
909 }
910
911 ksnprintf(status, SND_STATUSLEN, "at %s 0x%lx irq %ld",
912 (es->regtype == SYS_RES_IOPORT)? "io" : "memory",
913 rman_get_start(es->reg), rman_get_start(es->irq));
914
915 if (pcm_register(dev, es, 1, 1)) goto bad;
916 pcm_addchan(dev, PCMDIR_REC, ct, es);
917 pcm_addchan(dev, PCMDIR_PLAY, ct, es);
918 pcm_setstatus(dev, status);
919
920 return 0;
921
922 bad:
923 if (codec) ac97_destroy(codec);
924 if (es->reg) bus_release_resource(dev, es->regtype, es->regid, es->reg);
925 if (es->ih) bus_teardown_intr(dev, es->irq, es->ih);
926 if (es->irq) bus_release_resource(dev, SYS_RES_IRQ, es->irqid, es->irq);
927 if (es->parent_dmat) bus_dma_tag_destroy(es->parent_dmat);
928 if (es) kfree(es, M_DEVBUF);
929 return ENXIO;
930 }
931
932 static int
933 es_pci_detach(device_t dev)
934 {
935 int r;
936 struct es_info *es;
937
938 r = pcm_unregister(dev);
939 if (r)
940 return r;
941
942 es = pcm_getdevinfo(dev);
943 bus_release_resource(dev, es->regtype, es->regid, es->reg);
944 bus_teardown_intr(dev, es->irq, es->ih);
945 bus_release_resource(dev, SYS_RES_IRQ, es->irqid, es->irq);
946 bus_dma_tag_destroy(es->parent_dmat);
947 kfree(es, M_DEVBUF);
948
949 return 0;
950 }
951
952 static device_method_t es_methods[] = {
953 /* Device interface */
954 DEVMETHOD(device_probe, es_pci_probe),
955 DEVMETHOD(device_attach, es_pci_attach),
956 DEVMETHOD(device_detach, es_pci_detach),
957
958 { 0, 0 }
959 };
960
961 static driver_t es_driver = {
962 "pcm",
963 es_methods,
964 PCM_SOFTC_SIZE,
965 };
966
967 DRIVER_MODULE(snd_es137x, pci, es_driver, pcm_devclass, 0, 0);
968 MODULE_DEPEND(snd_es137x, snd_pcm, PCM_MINVER, PCM_PREFVER, PCM_MAXVER);
969 MODULE_VERSION(snd_es137x, 1);
Port diff from OpenBSD to DragonFly