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