xref: /dragonfly/sys/dev/sound/pci/solo.c (revision 030b0c8c4cf27c560ccec70410c8e21934ae677d)
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 <bus/pci/pcireg.h>
33 #include <bus/pci/pcivar.h>
34 
35 #include  <dev/sound/pci/sb.h>
36 #include  <dev/sound/chip.h>
37 
38 #include "mixer_if.h"
39 
40 SND_DECLARE_FILE("$FreeBSD: head/sys/dev/sound/pci/solo.c 254263 2013-08-12 23:30:01Z scottl $");
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 
54 static 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 };
65 static struct pcmchan_caps ess_playcaps = {6000, 48000, ess_playfmt, 0};
66 
67 /*
68  * Recording output is byte-swapped
69  */
70 static 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 };
81 static struct pcmchan_caps ess_reccaps = {6000, 48000, ess_recfmt, 0};
82 
83 struct ess_info;
84 
85 struct 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 
93 struct 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 lock *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 
119 static int ess_rd(struct ess_info *sc, int reg);
120 static void ess_wr(struct ess_info *sc, int reg, u_int8_t val);
121 static int ess_dspready(struct ess_info *sc);
122 static int ess_cmd(struct ess_info *sc, u_char val);
123 static int ess_cmd1(struct ess_info *sc, u_char cmd, int val);
124 static int ess_get_byte(struct ess_info *sc);
125 static void ess_setmixer(struct ess_info *sc, u_int port, u_int value);
126 static int ess_getmixer(struct ess_info *sc, u_int port);
127 static int ess_reset_dsp(struct ess_info *sc);
128 
129 static int ess_write(struct ess_info *sc, u_char reg, int val);
130 static int ess_read(struct ess_info *sc, u_char reg);
131 
132 static void ess_intr(void *arg);
133 static int ess_setupch(struct ess_info *sc, int ch, int dir, int spd, u_int32_t fmt, int len);
134 static int ess_start(struct ess_chinfo *ch);
135 static int ess_stop(struct ess_chinfo *ch);
136 
137 static int ess_dmasetup(struct ess_info *sc, int ch, u_int32_t base, u_int16_t cnt, int dir);
138 static int ess_dmapos(struct ess_info *sc, int ch);
139 static 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 
153 static int
port_rd(struct resource * port,int regno,int size)154 port_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 
171 static void
port_wr(struct resource * port,int regno,u_int32_t data,int size)172 port_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 
190 static int
ess_rd(struct ess_info * sc,int reg)191 ess_rd(struct ess_info *sc, int reg)
192 {
193           return port_rd(sc->sb, reg, 1);
194 }
195 
196 static void
ess_wr(struct ess_info * sc,int reg,u_int8_t val)197 ess_wr(struct ess_info *sc, int reg, u_int8_t val)
198 {
199           port_wr(sc->sb, reg, val, 1);
200 }
201 
202 static int
ess_dspready(struct ess_info * sc)203 ess_dspready(struct ess_info *sc)
204 {
205           return ((ess_rd(sc, SBDSP_STATUS) & 0x80) == 0);
206 }
207 
208 static int
ess_dspwr(struct ess_info * sc,u_char val)209 ess_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           kprintf("ess_dspwr(0x%02x) timed out.\n", val);
221           return 0;
222 }
223 
224 static int
ess_cmd(struct ess_info * sc,u_char val)225 ess_cmd(struct ess_info *sc, u_char val)
226 {
227           DEB(kprintf("ess_cmd: %x\n", val));
228           return ess_dspwr(sc, val);
229 }
230 
231 static int
ess_cmd1(struct ess_info * sc,u_char cmd,int val)232 ess_cmd1(struct ess_info *sc, u_char cmd, int val)
233 {
234           DEB(kprintf("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 
240 static void
ess_setmixer(struct ess_info * sc,u_int port,u_int value)241 ess_setmixer(struct ess_info *sc, u_int port, u_int value)
242 {
243           DEB(kprintf("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 
250 static int
ess_getmixer(struct ess_info * sc,u_int port)251 ess_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 
263 static int
ess_get_byte(struct ess_info * sc)264 ess_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 
277 static int
ess_write(struct ess_info * sc,u_char reg,int val)278 ess_write(struct ess_info *sc, u_char reg, int val)
279 {
280           return ess_cmd1(sc, reg, val);
281 }
282 
283 static int
ess_read(struct ess_info * sc,u_char reg)284 ess_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 
289 static int
ess_reset_dsp(struct ess_info * sc)290 ess_reset_dsp(struct ess_info *sc)
291 {
292           DEB(kprintf("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(kprintf("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 
307 static void
ess_intr(void * arg)308 ess_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                               kprintf("solo: IRQ neither playback nor rec!\n");
335           }
336 
337           DEB(kprintf("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 */
374 static u_int8_t
ess_calcspeed8(int * spd)375 ess_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 
393 static u_int8_t
ess_calcspeed9(int * spd)394 ess_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 
415 static u_int8_t
ess_calcfilter(int spd)416 ess_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 
426 static int
ess_setupch(struct ess_info * sc,int ch,int dir,int spd,u_int32_t fmt,int len)427 ess_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(kprintf("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 }
497 static int
ess_start(struct ess_chinfo * ch)498 ess_start(struct ess_chinfo *ch)
499 {
500           struct ess_info *sc = ch->parent;
501 
502           DEB(kprintf("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 
518 static int
ess_stop(struct ess_chinfo * ch)519 ess_stop(struct ess_chinfo *ch)
520 {
521           struct ess_info *sc = ch->parent;
522 
523           DEB(kprintf("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(kprintf("done with stop\n"));
530           return 0;
531 }
532 
533 /* -------------------------------------------------------------------- */
534 /* channel interface for ESS18xx */
535 static void *
esschan_init(kobj_t obj,void * devinfo,struct snd_dbuf * b,struct pcm_channel * c,int dir)536 esschan_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(kprintf("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 
554 static int
esschan_setformat(kobj_t obj,void * data,u_int32_t format)555 esschan_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 
563 static u_int32_t
esschan_setspeed(kobj_t obj,void * data,u_int32_t speed)564 esschan_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 
577 static u_int32_t
esschan_setblocksize(kobj_t obj,void * data,u_int32_t blocksize)578 esschan_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 
586 static int
esschan_trigger(kobj_t obj,void * data,int go)587 esschan_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(kprintf("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 
615 static u_int32_t
esschan_getptr(kobj_t obj,void * data)616 esschan_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 
628 static struct pcmchan_caps *
esschan_getcaps(kobj_t obj,void * data)629 esschan_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 
636 static 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 };
646 CHANNEL_DECLARE(esschan);
647 
648 /************************************************************/
649 
650 static int
essmix_init(struct snd_mixer * m)651 essmix_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 
667 static int
essmix_set(struct snd_mixer * m,unsigned dev,unsigned left,unsigned right)668 essmix_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 
727 static u_int32_t
essmix_setrecsrc(struct snd_mixer * m,u_int32_t src)728 essmix_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 
758 static 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 };
764 MIXER_DECLARE(solomixer);
765 
766 /************************************************************/
767 
768 static int
ess_dmasetup(struct ess_info * sc,int ch,u_int32_t base,u_int16_t cnt,int dir)769 ess_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 
789 static int
ess_dmapos(struct ess_info * sc,int ch)790 ess_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                                         kprintf("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 
821 static int
ess_dmatrigger(struct ess_info * sc,int ch,int go)822 ess_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 
832 static void
ess_release_resources(struct ess_info * sc,device_t dev)833 ess_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           kfree(sc, M_DEVBUF);
879 }
880 
881 static int
ess_alloc_resources(struct ess_info * sc,device_t dev)882 ess_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 
915 static int
ess_probe(device_t dev)916 ess_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 
942 static int
ess_suspend(device_t dev)943 ess_suspend(device_t dev)
944 {
945   return 0;
946 }
947 
948 static int
ess_resume(device_t dev)949 ess_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 
979 static int
ess_attach(device_t dev)980 ess_attach(device_t dev)
981 {
982           struct ess_info *sc;
983           char status[SND_STATUSLEN];
984           u_int16_t ddma;
985 
986           sc = kmalloc(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                               /*maxsize*/sc->bufsz, /*nsegments*/1,
1032                               /*maxsegz*/0x3ffff,
1033                               /*flags*/0,
1034                               &sc->parent_dmat) != 0) {
1035                     device_printf(dev, "unable to create dma tag\n");
1036                     goto no;
1037           }
1038 
1039           if (ess_reset_dsp(sc))
1040                     goto no;
1041 
1042           if (sc->newspeed)
1043                     ess_setmixer(sc, 0x71, 0x2a);
1044 
1045           if (mixer_init(dev, &solomixer_class, sc))
1046                     goto no;
1047 
1048           ksnprintf(status, SND_STATUSLEN, "at io 0x%lx,0x%lx,0x%lx irq %ld %s",
1049                     rman_get_start(sc->io), rman_get_start(sc->sb), rman_get_start(sc->vc),
1050                     rman_get_start(sc->irq),PCM_KLDSTRING(snd_solo));
1051 
1052           if (pcm_register(dev, sc, 1, 1))
1053                     goto no;
1054           pcm_addchan(dev, PCMDIR_REC, &esschan_class, sc);
1055           pcm_addchan(dev, PCMDIR_PLAY, &esschan_class, sc);
1056           pcm_setstatus(dev, status);
1057 
1058           return 0;
1059 
1060 no:
1061           ess_release_resources(sc, dev);
1062           return ENXIO;
1063 }
1064 
1065 static int
ess_detach(device_t dev)1066 ess_detach(device_t dev)
1067 {
1068           int r;
1069           struct ess_info *sc;
1070 
1071           r = pcm_unregister(dev);
1072           if (r)
1073                     return r;
1074 
1075           sc = pcm_getdevinfo(dev);
1076           ess_release_resources(sc, dev);
1077           return 0;
1078 }
1079 
1080 static device_method_t ess_methods[] = {
1081           /* Device interface */
1082           DEVMETHOD(device_probe,                 ess_probe),
1083           DEVMETHOD(device_attach,      ess_attach),
1084           DEVMETHOD(device_detach,      ess_detach),
1085           DEVMETHOD(device_resume,      ess_resume),
1086           DEVMETHOD(device_suspend,     ess_suspend),
1087 
1088           { 0, 0 }
1089 };
1090 
1091 static driver_t ess_driver = {
1092           "pcm",
1093           ess_methods,
1094           PCM_SOFTC_SIZE,
1095 };
1096 
1097 DRIVER_MODULE(snd_solo, pci, ess_driver, pcm_devclass, NULL, NULL);
1098 MODULE_DEPEND(snd_solo, sound, SOUND_MINVER, SOUND_PREFVER, SOUND_MAXVER);
1099 MODULE_VERSION(snd_solo, 1);
1100 
1101 
1102 
1103