1/*-
2 * Copyright (c) 1999 Cameron Grant <cg@freebsd.org>
3 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions
6 * are met:
7 * 1. Redistributions of source code must retain the above copyright
8 *    notice, this list of conditions and the following disclaimer.
9 * 2. Redistributions in binary form must reproduce the above copyright
10 *    notice, this list of conditions and the following disclaimer in the
11 *    documentation and/or other materials provided with the distribution.
12 *
13 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
14 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
15 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
16 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
17 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
18 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
19 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
20 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
21 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
22 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
23 * SUCH DAMAGE.
24 */
25
26#ifdef HAVE_KERNEL_OPTION_HEADERS
27#include "opt_snd.h"
28#endif
29
30#include <dev/sound/pcm/sound.h>
31
32#include <dev/pci/pcireg.h>
33#include <dev/pci/pcivar.h>
34
35#include  <dev/sound/isa/sb.h>
36#include  <dev/sound/chip.h>
37
38#include "mixer_if.h"
39
40SND_DECLARE_FILE("$FreeBSD$");
41
42#define SOLO_DEFAULT_BUFSZ 16384
43#define ABS(x) (((x) < 0)? -(x) : (x))
44
45/* if defined, playback always uses the 2nd channel and full duplex works */
46#define ESS18XX_DUPLEX	1
47
48/* more accurate clocks and split audio1/audio2 rates */
49#define ESS18XX_NEWSPEED
50
51/* 1 = INTR_MPSAFE, 0 = GIANT */
52#define ESS18XX_MPSAFE	1
53
54static u_int32_t ess_playfmt[] = {
55	SND_FORMAT(AFMT_U8, 1, 0),
56	SND_FORMAT(AFMT_U8, 2, 0),
57	SND_FORMAT(AFMT_S8, 1, 0),
58	SND_FORMAT(AFMT_S8, 2, 0),
59	SND_FORMAT(AFMT_S16_LE, 1, 0),
60	SND_FORMAT(AFMT_S16_LE, 2, 0),
61	SND_FORMAT(AFMT_U16_LE, 1, 0),
62	SND_FORMAT(AFMT_U16_LE, 2, 0),
63	0
64};
65static struct pcmchan_caps ess_playcaps = {6000, 48000, ess_playfmt, 0};
66
67/*
68 * Recording output is byte-swapped
69 */
70static u_int32_t ess_recfmt[] = {
71	SND_FORMAT(AFMT_U8, 1, 0),
72	SND_FORMAT(AFMT_U8, 2, 0),
73	SND_FORMAT(AFMT_S8, 1, 0),
74	SND_FORMAT(AFMT_S8, 2, 0),
75	SND_FORMAT(AFMT_S16_BE, 1, 0),
76	SND_FORMAT(AFMT_S16_BE, 2, 0),
77	SND_FORMAT(AFMT_U16_BE, 1, 0),
78	SND_FORMAT(AFMT_U16_BE, 2, 0),
79	0
80};
81static struct pcmchan_caps ess_reccaps = {6000, 48000, ess_recfmt, 0};
82
83struct ess_info;
84
85struct ess_chinfo {
86	struct ess_info *parent;
87	struct pcm_channel *channel;
88	struct snd_dbuf *buffer;
89	int dir, hwch, stopping;
90	u_int32_t fmt, spd, blksz;
91};
92
93struct ess_info {
94    	struct resource *io, *sb, *vc, *mpu, *gp;	/* I/O address for the board */
95    	struct resource *irq;
96	void		*ih;
97    	bus_dma_tag_t parent_dmat;
98
99    	int simplex_dir, type, dmasz[2];
100	unsigned int duplex:1, newspeed:1;
101	unsigned int bufsz;
102
103    	struct ess_chinfo pch, rch;
104#if ESS18XX_MPSAFE == 1
105	struct mtx *lock;
106#endif
107};
108
109#if ESS18XX_MPSAFE == 1
110#define ess_lock(_ess) snd_mtxlock((_ess)->lock)
111#define ess_unlock(_ess) snd_mtxunlock((_ess)->lock)
112#define ess_lock_assert(_ess) snd_mtxassert((_ess)->lock)
113#else
114#define ess_lock(_ess)
115#define ess_unlock(_ess)
116#define ess_lock_assert(_ess)
117#endif
118
119static int ess_rd(struct ess_info *sc, int reg);
120static void ess_wr(struct ess_info *sc, int reg, u_int8_t val);
121static int ess_dspready(struct ess_info *sc);
122static int ess_cmd(struct ess_info *sc, u_char val);
123static int ess_cmd1(struct ess_info *sc, u_char cmd, int val);
124static int ess_get_byte(struct ess_info *sc);
125static void ess_setmixer(struct ess_info *sc, u_int port, u_int value);
126static int ess_getmixer(struct ess_info *sc, u_int port);
127static int ess_reset_dsp(struct ess_info *sc);
128
129static int ess_write(struct ess_info *sc, u_char reg, int val);
130static int ess_read(struct ess_info *sc, u_char reg);
131
132static void ess_intr(void *arg);
133static int ess_setupch(struct ess_info *sc, int ch, int dir, int spd, u_int32_t fmt, int len);
134static int ess_start(struct ess_chinfo *ch);
135static int ess_stop(struct ess_chinfo *ch);
136
137static int ess_dmasetup(struct ess_info *sc, int ch, u_int32_t base, u_int16_t cnt, int dir);
138static int ess_dmapos(struct ess_info *sc, int ch);
139static int ess_dmatrigger(struct ess_info *sc, int ch, int go);
140
141/*
142 * Common code for the midi and pcm functions
143 *
144 * ess_cmd write a single byte to the CMD port.
145 * ess_cmd1 write a CMD + 1 byte arg
146 * ess_cmd2 write a CMD + 2 byte arg
147 * ess_get_byte returns a single byte from the DSP data port
148 *
149 * ess_write is actually ess_cmd1
150 * ess_read access ext. regs via ess_cmd(0xc0, reg) followed by ess_get_byte
151 */
152
153static int
154port_rd(struct resource *port, int regno, int size)
155{
156	bus_space_tag_t st = rman_get_bustag(port);
157	bus_space_handle_t sh = rman_get_bushandle(port);
158
159	switch (size) {
160	case 1:
161		return bus_space_read_1(st, sh, regno);
162	case 2:
163		return bus_space_read_2(st, sh, regno);
164	case 4:
165		return bus_space_read_4(st, sh, regno);
166	default:
167		return 0xffffffff;
168	}
169}
170
171static void
172port_wr(struct resource *port, int regno, u_int32_t data, int size)
173{
174	bus_space_tag_t st = rman_get_bustag(port);
175	bus_space_handle_t sh = rman_get_bushandle(port);
176
177	switch (size) {
178	case 1:
179		bus_space_write_1(st, sh, regno, data);
180		break;
181	case 2:
182		bus_space_write_2(st, sh, regno, data);
183		break;
184	case 4:
185		bus_space_write_4(st, sh, regno, data);
186		break;
187	}
188}
189
190static int
191ess_rd(struct ess_info *sc, int reg)
192{
193	return port_rd(sc->sb, reg, 1);
194}
195
196static void
197ess_wr(struct ess_info *sc, int reg, u_int8_t val)
198{
199	port_wr(sc->sb, reg, val, 1);
200}
201
202static int
203ess_dspready(struct ess_info *sc)
204{
205	return ((ess_rd(sc, SBDSP_STATUS) & 0x80) == 0);
206}
207
208static int
209ess_dspwr(struct ess_info *sc, u_char val)
210{
211    	int  i;
212
213    	for (i = 0; i < 1000; i++) {
214		if (ess_dspready(sc)) {
215	    		ess_wr(sc, SBDSP_CMD, val);
216	    		return 1;
217		}
218		if (i > 10) DELAY((i > 100)? 1000 : 10);
219    	}
220    	printf("ess_dspwr(0x%02x) timed out.\n", val);
221    	return 0;
222}
223
224static int
225ess_cmd(struct ess_info *sc, u_char val)
226{
227	DEB(printf("ess_cmd: %x\n", val));
228    	return ess_dspwr(sc, val);
229}
230
231static int
232ess_cmd1(struct ess_info *sc, u_char cmd, int val)
233{
234    	DEB(printf("ess_cmd1: %x, %x\n", cmd, val));
235    	if (ess_dspwr(sc, cmd)) {
236		return ess_dspwr(sc, val & 0xff);
237    	} else return 0;
238}
239
240static void
241ess_setmixer(struct ess_info *sc, u_int port, u_int value)
242{
243	DEB(printf("ess_setmixer: reg=%x, val=%x\n", port, value);)
244    	ess_wr(sc, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */
245    	DELAY(10);
246    	ess_wr(sc, SB_MIX_DATA, (u_char) (value & 0xff));
247    	DELAY(10);
248}
249
250static int
251ess_getmixer(struct ess_info *sc, u_int port)
252{
253    	int val;
254
255    	ess_wr(sc, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */
256    	DELAY(10);
257    	val = ess_rd(sc, SB_MIX_DATA);
258    	DELAY(10);
259
260    	return val;
261}
262
263static int
264ess_get_byte(struct ess_info *sc)
265{
266    	int i;
267
268    	for (i = 1000; i > 0; i--) {
269		if (ess_rd(sc, 0xc) & 0x40)
270			return ess_rd(sc, DSP_READ);
271		else
272			DELAY(20);
273    	}
274    	return -1;
275}
276
277static int
278ess_write(struct ess_info *sc, u_char reg, int val)
279{
280    	return ess_cmd1(sc, reg, val);
281}
282
283static int
284ess_read(struct ess_info *sc, u_char reg)
285{
286    	return (ess_cmd(sc, 0xc0) && ess_cmd(sc, reg))? ess_get_byte(sc) : -1;
287}
288
289static int
290ess_reset_dsp(struct ess_info *sc)
291{
292	DEB(printf("ess_reset_dsp\n"));
293    	ess_wr(sc, SBDSP_RST, 3);
294    	DELAY(100);
295    	ess_wr(sc, SBDSP_RST, 0);
296    	if (ess_get_byte(sc) != 0xAA) {
297        	DEB(printf("ess_reset_dsp failed\n"));
298/*
299			   rman_get_start(d->io_base)));
300*/
301		return ENXIO;	/* Sorry */
302    	}
303    	ess_cmd(sc, 0xc6);
304    	return 0;
305}
306
307static void
308ess_intr(void *arg)
309{
310    	struct ess_info *sc = (struct ess_info *)arg;
311	int src, pirq = 0, rirq = 0;
312
313	ess_lock(sc);
314	src = 0;
315	if (ess_getmixer(sc, 0x7a) & 0x80)
316		src |= 2;
317	if (ess_rd(sc, 0x0c) & 0x01)
318		src |= 1;
319
320	if (src == 0) {
321		ess_unlock(sc);
322		return;
323	}
324
325	if (sc->duplex) {
326		pirq = (src & sc->pch.hwch)? 1 : 0;
327		rirq = (src & sc->rch.hwch)? 1 : 0;
328	} else {
329		if (sc->simplex_dir == PCMDIR_PLAY)
330			pirq = 1;
331		if (sc->simplex_dir == PCMDIR_REC)
332			rirq = 1;
333		if (!pirq && !rirq)
334			printf("solo: IRQ neither playback nor rec!\n");
335	}
336
337	DEB(printf("ess_intr: pirq:%d rirq:%d\n",pirq,rirq));
338
339	if (pirq) {
340		if (sc->pch.stopping) {
341			ess_dmatrigger(sc, sc->pch.hwch, 0);
342			sc->pch.stopping = 0;
343			if (sc->pch.hwch == 1)
344				ess_write(sc, 0xb8, ess_read(sc, 0xb8) & ~0x01);
345			else
346				ess_setmixer(sc, 0x78, ess_getmixer(sc, 0x78) & ~0x03);
347		}
348		ess_unlock(sc);
349		chn_intr(sc->pch.channel);
350		ess_lock(sc);
351	}
352
353	if (rirq) {
354		if (sc->rch.stopping) {
355			ess_dmatrigger(sc, sc->rch.hwch, 0);
356			sc->rch.stopping = 0;
357			/* XXX: will this stop audio2? */
358			ess_write(sc, 0xb8, ess_read(sc, 0xb8) & ~0x01);
359		}
360		ess_unlock(sc);
361		chn_intr(sc->rch.channel);
362		ess_lock(sc);
363	}
364
365	if (src & 2)
366		ess_setmixer(sc, 0x7a, ess_getmixer(sc, 0x7a) & ~0x80);
367	if (src & 1)
368    		ess_rd(sc, DSP_DATA_AVAIL);
369
370	ess_unlock(sc);
371}
372
373/* utility functions for ESS */
374static u_int8_t
375ess_calcspeed8(int *spd)
376{
377	int speed = *spd;
378	u_int32_t t;
379
380	if (speed > 22000) {
381		t = (795500 + speed / 2) / speed;
382		speed = (795500 + t / 2) / t;
383		t = (256 - t) | 0x80;
384	} else {
385		t = (397700 + speed / 2) / speed;
386		speed = (397700 + t / 2) / t;
387		t = 128 - t;
388	}
389	*spd = speed;
390	return t & 0x000000ff;
391}
392
393static u_int8_t
394ess_calcspeed9(int *spd)
395{
396	int speed, s0, s1, use0;
397	u_int8_t t0, t1;
398
399	/* rate = source / (256 - divisor) */
400	/* divisor = 256 - (source / rate) */
401	speed = *spd;
402	t0 = 128 - (793800 / speed);
403	s0 = 793800 / (128 - t0);
404
405	t1 = 128 - (768000 / speed);
406	s1 = 768000 / (128 - t1);
407	t1 |= 0x80;
408
409	use0 = (ABS(speed - s0) < ABS(speed - s1))? 1 : 0;
410
411	*spd = use0? s0 : s1;
412	return use0? t0 : t1;
413}
414
415static u_int8_t
416ess_calcfilter(int spd)
417{
418	int cutoff;
419
420	/* cutoff = 7160000 / (256 - divisor) */
421	/* divisor = 256 - (7160000 / cutoff) */
422	cutoff = (spd * 9 * 82) / 20;
423	return (256 - (7160000 / cutoff));
424}
425
426static int
427ess_setupch(struct ess_info *sc, int ch, int dir, int spd, u_int32_t fmt, int len)
428{
429	int play = (dir == PCMDIR_PLAY)? 1 : 0;
430	int b16 = (fmt & AFMT_16BIT)? 1 : 0;
431	int stereo = (AFMT_CHANNEL(fmt) > 1)? 1 : 0;
432	int unsign = (!(fmt & AFMT_SIGNED))? 1 : 0;
433	u_int8_t spdval, fmtval;
434
435	DEB(printf("ess_setupch\n"));
436	spdval = (sc->newspeed)? ess_calcspeed9(&spd) : ess_calcspeed8(&spd);
437
438	sc->simplex_dir = play ? PCMDIR_PLAY : PCMDIR_REC ;
439
440	if (ch == 1) {
441		KASSERT((dir == PCMDIR_PLAY) || (dir == PCMDIR_REC), ("ess_setupch: dir1 bad"));
442		len = -len;
443		/* transfer length low */
444		ess_write(sc, 0xa4, len & 0x00ff);
445		/* transfer length high */
446		ess_write(sc, 0xa5, (len & 0xff00) >> 8);
447		/* autoinit, dma dir */
448		ess_write(sc, 0xb8, 0x04 | (play? 0x00 : 0x0a));
449		/* mono/stereo */
450		ess_write(sc, 0xa8, (ess_read(sc, 0xa8) & ~0x03) | (stereo? 0x01 : 0x02));
451		/* demand mode, 4 bytes/xfer */
452		ess_write(sc, 0xb9, 0x02);
453		/* sample rate */
454        	ess_write(sc, 0xa1, spdval);
455		/* filter cutoff */
456		ess_write(sc, 0xa2, ess_calcfilter(spd));
457		/* setup dac/adc */
458		/*
459		if (play)
460			ess_write(sc, 0xb6, unsign? 0x80 : 0x00);
461		*/
462		/* mono, b16: signed, load signal */
463		/*
464		ess_write(sc, 0xb7, 0x51 | (unsign? 0x00 : 0x20));
465		*/
466		/* setup fifo */
467		ess_write(sc, 0xb7, 0x91 | (unsign? 0x00 : 0x20) |
468					   (b16? 0x04 : 0x00) |
469					   (stereo? 0x08 : 0x40));
470		/* irq control */
471		ess_write(sc, 0xb1, (ess_read(sc, 0xb1) & 0x0f) | 0x50);
472		/* drq control */
473		ess_write(sc, 0xb2, (ess_read(sc, 0xb2) & 0x0f) | 0x50);
474	} else if (ch == 2) {
475		KASSERT(dir == PCMDIR_PLAY, ("ess_setupch: dir2 bad"));
476		len >>= 1;
477		len = -len;
478		/* transfer length low */
479		ess_setmixer(sc, 0x74, len & 0x00ff);
480		/* transfer length high */
481		ess_setmixer(sc, 0x76, (len & 0xff00) >> 8);
482		/* autoinit, 4 bytes/req */
483		ess_setmixer(sc, 0x78, 0x10);
484		fmtval = b16 | (stereo << 1) | ((!unsign) << 2);
485		/* enable irq, set format */
486		ess_setmixer(sc, 0x7a, 0x40 | fmtval);
487		if (sc->newspeed) {
488			/* sample rate */
489			ess_setmixer(sc, 0x70, spdval);
490			/* filter cutoff */
491			ess_setmixer(sc, 0x72, ess_calcfilter(spd));
492		}
493
494	}
495	return 0;
496}
497static int
498ess_start(struct ess_chinfo *ch)
499{
500	struct ess_info *sc = ch->parent;
501
502	DEB(printf("ess_start\n"););
503	ess_setupch(sc, ch->hwch, ch->dir, ch->spd, ch->fmt, ch->blksz);
504	ch->stopping = 0;
505	if (ch->hwch == 1) {
506		ess_write(sc, 0xb8, ess_read(sc, 0xb8) | 0x01);
507		if (ch->dir == PCMDIR_PLAY) {
508#if 0
509			DELAY(100000); /* 100 ms */
510#endif
511			ess_cmd(sc, 0xd1);
512		}
513	} else
514		ess_setmixer(sc, 0x78, ess_getmixer(sc, 0x78) | 0x03);
515	return 0;
516}
517
518static int
519ess_stop(struct ess_chinfo *ch)
520{
521	struct ess_info *sc = ch->parent;
522
523	DEB(printf("ess_stop\n"));
524	ch->stopping = 1;
525	if (ch->hwch == 1)
526		ess_write(sc, 0xb8, ess_read(sc, 0xb8) & ~0x04);
527	else
528		ess_setmixer(sc, 0x78, ess_getmixer(sc, 0x78) & ~0x10);
529	DEB(printf("done with stop\n"));
530	return 0;
531}
532
533/* -------------------------------------------------------------------- */
534/* channel interface for ESS18xx */
535static void *
536esschan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
537{
538	struct ess_info *sc = devinfo;
539	struct ess_chinfo *ch = (dir == PCMDIR_PLAY)? &sc->pch : &sc->rch;
540
541	DEB(printf("esschan_init\n"));
542	ch->parent = sc;
543	ch->channel = c;
544	ch->buffer = b;
545	ch->dir = dir;
546	if (sndbuf_alloc(ch->buffer, sc->parent_dmat, 0, sc->bufsz) != 0)
547		return NULL;
548	ch->hwch = 1;
549	if ((dir == PCMDIR_PLAY) && (sc->duplex))
550		ch->hwch = 2;
551	return ch;
552}
553
554static int
555esschan_setformat(kobj_t obj, void *data, u_int32_t format)
556{
557	struct ess_chinfo *ch = data;
558
559	ch->fmt = format;
560	return 0;
561}
562
563static u_int32_t
564esschan_setspeed(kobj_t obj, void *data, u_int32_t speed)
565{
566	struct ess_chinfo *ch = data;
567	struct ess_info *sc = ch->parent;
568
569	ch->spd = speed;
570	if (sc->newspeed)
571		ess_calcspeed9(&ch->spd);
572	else
573		ess_calcspeed8(&ch->spd);
574	return ch->spd;
575}
576
577static u_int32_t
578esschan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
579{
580	struct ess_chinfo *ch = data;
581
582	ch->blksz = blocksize;
583	return ch->blksz;
584}
585
586static int
587esschan_trigger(kobj_t obj, void *data, int go)
588{
589	struct ess_chinfo *ch = data;
590	struct ess_info *sc = ch->parent;
591
592	if (!PCMTRIG_COMMON(go))
593		return 0;
594
595	DEB(printf("esschan_trigger: %d\n",go));
596
597	ess_lock(sc);
598	switch (go) {
599	case PCMTRIG_START:
600		ess_dmasetup(sc, ch->hwch, sndbuf_getbufaddr(ch->buffer), sndbuf_getsize(ch->buffer), ch->dir);
601		ess_dmatrigger(sc, ch->hwch, 1);
602		ess_start(ch);
603		break;
604
605	case PCMTRIG_STOP:
606	case PCMTRIG_ABORT:
607	default:
608		ess_stop(ch);
609		break;
610	}
611	ess_unlock(sc);
612	return 0;
613}
614
615static u_int32_t
616esschan_getptr(kobj_t obj, void *data)
617{
618	struct ess_chinfo *ch = data;
619	struct ess_info *sc = ch->parent;
620	u_int32_t ret;
621
622	ess_lock(sc);
623	ret = ess_dmapos(sc, ch->hwch);
624	ess_unlock(sc);
625	return ret;
626}
627
628static struct pcmchan_caps *
629esschan_getcaps(kobj_t obj, void *data)
630{
631	struct ess_chinfo *ch = data;
632
633	return (ch->dir == PCMDIR_PLAY)? &ess_playcaps : &ess_reccaps;
634}
635
636static kobj_method_t esschan_methods[] = {
637    	KOBJMETHOD(channel_init,		esschan_init),
638    	KOBJMETHOD(channel_setformat,		esschan_setformat),
639    	KOBJMETHOD(channel_setspeed,		esschan_setspeed),
640    	KOBJMETHOD(channel_setblocksize,	esschan_setblocksize),
641    	KOBJMETHOD(channel_trigger,		esschan_trigger),
642    	KOBJMETHOD(channel_getptr,		esschan_getptr),
643    	KOBJMETHOD(channel_getcaps,		esschan_getcaps),
644	KOBJMETHOD_END
645};
646CHANNEL_DECLARE(esschan);
647
648/************************************************************/
649
650static int
651essmix_init(struct snd_mixer *m)
652{
653    	struct ess_info *sc = mix_getdevinfo(m);
654
655	mix_setrecdevs(m, SOUND_MASK_CD | SOUND_MASK_MIC | SOUND_MASK_LINE |
656			  SOUND_MASK_IMIX);
657
658	mix_setdevs(m, SOUND_MASK_SYNTH | SOUND_MASK_PCM | SOUND_MASK_LINE |
659		       SOUND_MASK_MIC | SOUND_MASK_CD | SOUND_MASK_VOLUME |
660		       SOUND_MASK_LINE1);
661
662	ess_setmixer(sc, 0, 0); /* reset */
663
664	return 0;
665}
666
667static int
668essmix_set(struct snd_mixer *m, unsigned dev, unsigned left, unsigned right)
669{
670    	struct ess_info *sc = mix_getdevinfo(m);
671    	int preg = 0, rreg = 0, l, r;
672
673	l = (left * 15) / 100;
674	r = (right * 15) / 100;
675	switch (dev) {
676	case SOUND_MIXER_SYNTH:
677		preg = 0x36;
678		rreg = 0x6b;
679		break;
680
681	case SOUND_MIXER_PCM:
682		preg = 0x14;
683		rreg = 0x7c;
684		break;
685
686	case SOUND_MIXER_LINE:
687		preg = 0x3e;
688		rreg = 0x6e;
689		break;
690
691	case SOUND_MIXER_MIC:
692		preg = 0x1a;
693		rreg = 0x68;
694		break;
695
696	case SOUND_MIXER_LINE1:
697		preg = 0x3a;
698		rreg = 0x6c;
699		break;
700
701	case SOUND_MIXER_CD:
702		preg = 0x38;
703		rreg = 0x6a;
704		break;
705
706	case SOUND_MIXER_VOLUME:
707		l = left? (left * 63) / 100 : 64;
708		r = right? (right * 63) / 100 : 64;
709		ess_setmixer(sc, 0x60, l);
710		ess_setmixer(sc, 0x62, r);
711		left = (l == 64)? 0 : (l * 100) / 63;
712		right = (r == 64)? 0 : (r * 100) / 63;
713    		return left | (right << 8);
714	}
715
716	if (preg)
717		ess_setmixer(sc, preg, (l << 4) | r);
718	if (rreg)
719		ess_setmixer(sc, rreg, (l << 4) | r);
720
721	left = (l * 100) / 15;
722	right = (r * 100) / 15;
723
724    	return left | (right << 8);
725}
726
727static u_int32_t
728essmix_setrecsrc(struct snd_mixer *m, u_int32_t src)
729{
730    	struct ess_info *sc = mix_getdevinfo(m);
731    	u_char recdev;
732
733    	switch (src) {
734	case SOUND_MASK_CD:
735		recdev = 0x02;
736		break;
737
738	case SOUND_MASK_LINE:
739		recdev = 0x06;
740		break;
741
742	case SOUND_MASK_IMIX:
743		recdev = 0x05;
744		break;
745
746	case SOUND_MASK_MIC:
747	default:
748		recdev = 0x00;
749		src = SOUND_MASK_MIC;
750		break;
751	}
752
753	ess_setmixer(sc, 0x1c, recdev);
754
755	return src;
756}
757
758static kobj_method_t solomixer_methods[] = {
759    	KOBJMETHOD(mixer_init,		essmix_init),
760    	KOBJMETHOD(mixer_set,		essmix_set),
761    	KOBJMETHOD(mixer_setrecsrc,	essmix_setrecsrc),
762	KOBJMETHOD_END
763};
764MIXER_DECLARE(solomixer);
765
766/************************************************************/
767
768static int
769ess_dmasetup(struct ess_info *sc, int ch, u_int32_t base, u_int16_t cnt, int dir)
770{
771	KASSERT(ch == 1 || ch == 2, ("bad ch"));
772	sc->dmasz[ch - 1] = cnt;
773	if (ch == 1) {
774		port_wr(sc->vc, 0x8, 0xc4, 1); /* command */
775		port_wr(sc->vc, 0xd, 0xff, 1); /* reset */
776		port_wr(sc->vc, 0xf, 0x01, 1); /* mask */
777		port_wr(sc->vc, 0xb, dir == PCMDIR_PLAY? 0x58 : 0x54, 1); /* mode */
778		port_wr(sc->vc, 0x0, base, 4);
779		port_wr(sc->vc, 0x4, cnt - 1, 2);
780
781	} else if (ch == 2) {
782		port_wr(sc->io, 0x6, 0x08, 1); /* autoinit */
783		port_wr(sc->io, 0x0, base, 4);
784		port_wr(sc->io, 0x4, cnt, 2);
785	}
786	return 0;
787}
788
789static int
790ess_dmapos(struct ess_info *sc, int ch)
791{
792	int p = 0, i = 0, j = 0;
793
794	KASSERT(ch == 1 || ch == 2, ("bad ch"));
795	if (ch == 1) {
796
797/*
798 * During recording, this register is known to give back
799 * garbage if it's not quiescent while being read. That's
800 * why we spl, stop the DMA, and try over and over until
801 * adjacent reads are "close", in the right order and not
802 * bigger than is otherwise possible.
803 */
804		ess_dmatrigger(sc, ch, 0);
805		DELAY(20);
806		do {
807			DELAY(10);
808			if (j > 1)
809				printf("DMA count reg bogus: %04x & %04x\n",
810					i, p);
811			i = port_rd(sc->vc, 0x4, 2) + 1;
812			p = port_rd(sc->vc, 0x4, 2) + 1;
813		} while ((p > sc->dmasz[ch - 1] || i < p || (p - i) > 0x8) && j++ < 1000);
814		ess_dmatrigger(sc, ch, 1);
815	}
816	else if (ch == 2)
817		p = port_rd(sc->io, 0x4, 2);
818	return sc->dmasz[ch - 1] - p;
819}
820
821static int
822ess_dmatrigger(struct ess_info *sc, int ch, int go)
823{
824	KASSERT(ch == 1 || ch == 2, ("bad ch"));
825	if (ch == 1)
826		port_wr(sc->vc, 0xf, go? 0x00 : 0x01, 1); /* mask */
827	else if (ch == 2)
828		port_wr(sc->io, 0x6, 0x08 | (go? 0x02 : 0x00), 1); /* autoinit */
829	return 0;
830}
831
832static void
833ess_release_resources(struct ess_info *sc, device_t dev)
834{
835    	if (sc->irq) {
836		if (sc->ih)
837			bus_teardown_intr(dev, sc->irq, sc->ih);
838		bus_release_resource(dev, SYS_RES_IRQ, 0, sc->irq);
839		sc->irq = 0;
840    	}
841    	if (sc->io) {
842		bus_release_resource(dev, SYS_RES_IOPORT, PCIR_BAR(0), sc->io);
843		sc->io = 0;
844    	}
845
846    	if (sc->sb) {
847		bus_release_resource(dev, SYS_RES_IOPORT, PCIR_BAR(1), sc->sb);
848		sc->sb = 0;
849    	}
850
851    	if (sc->vc) {
852		bus_release_resource(dev, SYS_RES_IOPORT, PCIR_BAR(2), sc->vc);
853		sc->vc = 0;
854    	}
855
856    	if (sc->mpu) {
857		bus_release_resource(dev, SYS_RES_IOPORT, PCIR_BAR(3), sc->mpu);
858		sc->mpu = 0;
859    	}
860
861    	if (sc->gp) {
862		bus_release_resource(dev, SYS_RES_IOPORT, PCIR_BAR(4), sc->gp);
863		sc->gp = 0;
864    	}
865
866	if (sc->parent_dmat) {
867		bus_dma_tag_destroy(sc->parent_dmat);
868		sc->parent_dmat = 0;
869    	}
870
871#if ESS18XX_MPSAFE == 1
872	if (sc->lock) {
873		snd_mtxfree(sc->lock);
874		sc->lock = NULL;
875	}
876#endif
877
878    	free(sc, M_DEVBUF);
879}
880
881static int
882ess_alloc_resources(struct ess_info *sc, device_t dev)
883{
884	int rid;
885
886	rid = PCIR_BAR(0);
887    	sc->io = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE);
888
889	rid = PCIR_BAR(1);
890    	sc->sb = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE);
891
892	rid = PCIR_BAR(2);
893    	sc->vc = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE);
894
895	rid = PCIR_BAR(3);
896    	sc->mpu = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE);
897
898	rid = PCIR_BAR(4);
899    	sc->gp = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE);
900
901	rid = 0;
902	sc->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
903		RF_ACTIVE | RF_SHAREABLE);
904
905#if ESS18XX_MPSAFE == 1
906	sc->lock = snd_mtxcreate(device_get_nameunit(dev), "snd_solo softc");
907
908	return (sc->irq && sc->io && sc->sb && sc->vc &&
909				sc->mpu && sc->gp && sc->lock)? 0 : ENXIO;
910#else
911	return (sc->irq && sc->io && sc->sb && sc->vc && sc->mpu && sc->gp)? 0 : ENXIO;
912#endif
913}
914
915static int
916ess_probe(device_t dev)
917{
918	char *s = NULL;
919	u_int32_t subdev;
920
921	subdev = (pci_get_subdevice(dev) << 16) | pci_get_subvendor(dev);
922	switch (pci_get_devid(dev)) {
923	case 0x1969125d:
924		if (subdev == 0x8888125d)
925			s = "ESS Solo-1E";
926		else if (subdev == 0x1818125d)
927			s = "ESS Solo-1";
928		else
929			s = "ESS Solo-1 (unknown vendor)";
930		break;
931	}
932
933	if (s)
934		device_set_desc(dev, s);
935	return s ? BUS_PROBE_DEFAULT : ENXIO;
936}
937
938#define ESS_PCI_LEGACYCONTROL       0x40
939#define ESS_PCI_CONFIG              0x50
940#define ESS_PCI_DDMACONTROL      	0x60
941
942static int
943ess_suspend(device_t dev)
944{
945  return 0;
946}
947
948static int
949ess_resume(device_t dev)
950{
951	uint16_t ddma;
952	struct ess_info *sc = pcm_getdevinfo(dev);
953
954	ess_lock(sc);
955	ddma = rman_get_start(sc->vc) | 1;
956	pci_write_config(dev, ESS_PCI_LEGACYCONTROL, 0x805f, 2);
957	pci_write_config(dev, ESS_PCI_DDMACONTROL, ddma, 2);
958	pci_write_config(dev, ESS_PCI_CONFIG, 0, 2);
959
960    	if (ess_reset_dsp(sc)) {
961		ess_unlock(sc);
962		goto no;
963	}
964	ess_unlock(sc);
965    	if (mixer_reinit(dev))
966		goto no;
967	ess_lock(sc);
968	if (sc->newspeed)
969		ess_setmixer(sc, 0x71, 0x2a);
970
971	port_wr(sc->io, 0x7, 0xb0, 1); /* enable irqs */
972	ess_unlock(sc);
973
974	return 0;
975 no:
976	return EIO;
977}
978
979static int
980ess_attach(device_t dev)
981{
982    	struct ess_info *sc;
983    	char status[SND_STATUSLEN];
984	u_int16_t ddma;
985
986	sc = malloc(sizeof(*sc), M_DEVBUF, M_WAITOK | M_ZERO);
987	pci_enable_busmaster(dev);
988
989    	if (ess_alloc_resources(sc, dev))
990		goto no;
991
992	sc->bufsz = pcm_getbuffersize(dev, 4096, SOLO_DEFAULT_BUFSZ, 65536);
993
994	ddma = rman_get_start(sc->vc) | 1;
995	pci_write_config(dev, ESS_PCI_LEGACYCONTROL, 0x805f, 2);
996	pci_write_config(dev, ESS_PCI_DDMACONTROL, ddma, 2);
997	pci_write_config(dev, ESS_PCI_CONFIG, 0, 2);
998
999	port_wr(sc->io, 0x7, 0xb0, 1); /* enable irqs */
1000#ifdef ESS18XX_DUPLEX
1001	sc->duplex = 1;
1002#else
1003	sc->duplex = 0;
1004#endif
1005
1006#ifdef ESS18XX_NEWSPEED
1007	sc->newspeed = 1;
1008#else
1009	sc->newspeed = 0;
1010#endif
1011	if (snd_setup_intr(dev, sc->irq,
1012#if ESS18XX_MPSAFE == 1
1013			INTR_MPSAFE
1014#else
1015			0
1016#endif
1017			, ess_intr, sc, &sc->ih)) {
1018		device_printf(dev, "unable to map interrupt\n");
1019		goto no;
1020	}
1021
1022    	if (!sc->duplex)
1023		pcm_setflags(dev, pcm_getflags(dev) | SD_F_SIMPLEX);
1024
1025#if 0
1026    	if (bus_dma_tag_create(/*parent*/bus_get_dma_tag(dev), /*alignment*/65536, /*boundary*/0,
1027#endif
1028    	if (bus_dma_tag_create(/*parent*/bus_get_dma_tag(dev), /*alignment*/2, /*boundary*/0,
1029			/*lowaddr*/BUS_SPACE_MAXADDR_24BIT,
1030			/*highaddr*/BUS_SPACE_MAXADDR,
1031			/*filter*/NULL, /*filterarg*/NULL,
1032			/*maxsize*/sc->bufsz, /*nsegments*/1,
1033			/*maxsegz*/0x3ffff,
1034			/*flags*/0,
1035#if ESS18XX_MPSAFE == 1
1036			/*lockfunc*/NULL, /*lockarg*/NULL,
1037#else
1038			/*lockfunc*/busdma_lock_mutex, /*lockarg*/&Giant,
1039#endif
1040			&sc->parent_dmat) != 0) {
1041		device_printf(dev, "unable to create dma tag\n");
1042		goto no;
1043    	}
1044
1045    	if (ess_reset_dsp(sc))
1046		goto no;
1047
1048	if (sc->newspeed)
1049		ess_setmixer(sc, 0x71, 0x2a);
1050
1051    	if (mixer_init(dev, &solomixer_class, sc))
1052		goto no;
1053
1054    	snprintf(status, SND_STATUSLEN, "at io 0x%lx,0x%lx,0x%lx irq %ld %s",
1055    	     	rman_get_start(sc->io), rman_get_start(sc->sb), rman_get_start(sc->vc),
1056		rman_get_start(sc->irq),PCM_KLDSTRING(snd_solo));
1057
1058    	if (pcm_register(dev, sc, 1, 1))
1059		goto no;
1060      	pcm_addchan(dev, PCMDIR_REC, &esschan_class, sc);
1061	pcm_addchan(dev, PCMDIR_PLAY, &esschan_class, sc);
1062	pcm_setstatus(dev, status);
1063
1064    	return 0;
1065
1066no:
1067    	ess_release_resources(sc, dev);
1068    	return ENXIO;
1069}
1070
1071static int
1072ess_detach(device_t dev)
1073{
1074	int r;
1075	struct ess_info *sc;
1076
1077	r = pcm_unregister(dev);
1078	if (r)
1079		return r;
1080
1081	sc = pcm_getdevinfo(dev);
1082    	ess_release_resources(sc, dev);
1083	return 0;
1084}
1085
1086static device_method_t ess_methods[] = {
1087	/* Device interface */
1088	DEVMETHOD(device_probe,		ess_probe),
1089	DEVMETHOD(device_attach,	ess_attach),
1090	DEVMETHOD(device_detach,	ess_detach),
1091	DEVMETHOD(device_resume,	ess_resume),
1092	DEVMETHOD(device_suspend,	ess_suspend),
1093
1094	{ 0, 0 }
1095};
1096
1097static driver_t ess_driver = {
1098	"pcm",
1099	ess_methods,
1100	PCM_SOFTC_SIZE,
1101};
1102
1103DRIVER_MODULE(snd_solo, pci, ess_driver, pcm_devclass, 0, 0);
1104MODULE_DEPEND(snd_solo, sound, SOUND_MINVER, SOUND_PREFVER, SOUND_MAXVER);
1105MODULE_VERSION(snd_solo, 1);
1106
1107
1108
1109