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