FreeBSD/Linux Kernel Cross Reference
sys/dev/sound/isa/sb16.c
1 /*
2 * Copyright (c) 1999 Cameron Grant <cg@freebsd.org>
3 * Copyright 1997,1998 Luigi Rizzo.
4 *
5 * Derived from files in the Voxware 3.5 distribution,
6 * Copyright by Hannu Savolainen 1994, under the same copyright
7 * conditions.
8 * All rights reserved.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
23 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 * SUCH DAMAGE.
30 */
31
32 #include <dev/sound/pcm/sound.h>
33
34 #include <dev/sound/isa/sb.h>
35 #include <dev/sound/chip.h>
36
37 #include <isa/isavar.h>
38
39 #include "mixer_if.h"
40
41 SND_DECLARE_FILE("$FreeBSD: releng/5.2/sys/dev/sound/isa/sb16.c 119853 2003-09-07 16:28:03Z cg $");
42
43 #define SB16_BUFFSIZE 4096
44 #define PLAIN_SB16(x) ((((x)->bd_flags) & (BD_F_SB16|BD_F_SB16X)) == BD_F_SB16)
45
46 static u_int32_t sb16_fmt8[] = {
47 AFMT_U8,
48 AFMT_STEREO | AFMT_U8,
49 0
50 };
51 static struct pcmchan_caps sb16_caps8 = {5000, 45000, sb16_fmt8, 0};
52
53 static u_int32_t sb16_fmt16[] = {
54 AFMT_S16_LE,
55 AFMT_STEREO | AFMT_S16_LE,
56 0
57 };
58 static struct pcmchan_caps sb16_caps16 = {5000, 45000, sb16_fmt16, 0};
59
60 static u_int32_t sb16x_fmt[] = {
61 AFMT_U8,
62 AFMT_STEREO | AFMT_U8,
63 AFMT_S16_LE,
64 AFMT_STEREO | AFMT_S16_LE,
65 0
66 };
67 static struct pcmchan_caps sb16x_caps = {5000, 49000, sb16x_fmt, 0};
68
69 struct sb_info;
70
71 struct sb_chinfo {
72 struct sb_info *parent;
73 struct pcm_channel *channel;
74 struct snd_dbuf *buffer;
75 int dir, run, dch;
76 u_int32_t fmt, spd, blksz;
77 };
78
79 struct sb_info {
80 struct resource *io_base; /* I/O address for the board */
81 struct resource *irq;
82 struct resource *drq1;
83 struct resource *drq2;
84 void *ih;
85 bus_dma_tag_t parent_dmat;
86
87 unsigned int bufsize;
88 int bd_id;
89 u_long bd_flags; /* board-specific flags */
90 int prio, prio16;
91 struct sb_chinfo pch, rch;
92 device_t parent_dev;
93 };
94
95 #if 0
96 static void sb_lock(struct sb_info *sb);
97 static void sb_unlock(struct sb_info *sb);
98 static int sb_rd(struct sb_info *sb, int reg);
99 static void sb_wr(struct sb_info *sb, int reg, u_int8_t val);
100 static int sb_cmd(struct sb_info *sb, u_char val);
101 /* static int sb_cmd1(struct sb_info *sb, u_char cmd, int val); */
102 static int sb_cmd2(struct sb_info *sb, u_char cmd, int val);
103 static u_int sb_get_byte(struct sb_info *sb);
104 static void sb_setmixer(struct sb_info *sb, u_int port, u_int value);
105 static int sb_getmixer(struct sb_info *sb, u_int port);
106 static int sb_reset_dsp(struct sb_info *sb);
107
108 static void sb_intr(void *arg);
109 #endif
110
111 /*
112 * Common code for the midi and pcm functions
113 *
114 * sb_cmd write a single byte to the CMD port.
115 * sb_cmd1 write a CMD + 1 byte arg
116 * sb_cmd2 write a CMD + 2 byte arg
117 * sb_get_byte returns a single byte from the DSP data port
118 */
119
120 static void
121 sb_lock(struct sb_info *sb) {
122
123 sbc_lock(device_get_softc(sb->parent_dev));
124 }
125
126 static void
127 sb_unlock(struct sb_info *sb) {
128
129 sbc_unlock(device_get_softc(sb->parent_dev));
130 }
131
132 static int
133 port_rd(struct resource *port, int off)
134 {
135 return bus_space_read_1(rman_get_bustag(port), rman_get_bushandle(port), off);
136 }
137
138 static void
139 port_wr(struct resource *port, int off, u_int8_t data)
140 {
141 bus_space_write_1(rman_get_bustag(port), rman_get_bushandle(port), off, data);
142 }
143
144 static int
145 sb_rd(struct sb_info *sb, int reg)
146 {
147 return port_rd(sb->io_base, reg);
148 }
149
150 static void
151 sb_wr(struct sb_info *sb, int reg, u_int8_t val)
152 {
153 port_wr(sb->io_base, reg, val);
154 }
155
156 static int
157 sb_dspwr(struct sb_info *sb, u_char val)
158 {
159 int i;
160
161 for (i = 0; i < 1000; i++) {
162 if ((sb_rd(sb, SBDSP_STATUS) & 0x80))
163 DELAY((i > 100)? 1000 : 10);
164 else {
165 sb_wr(sb, SBDSP_CMD, val);
166 return 1;
167 }
168 }
169 #if __FreeBSD_version > 500000
170 if (curthread->td_intr_nesting_level == 0)
171 printf("sb_dspwr(0x%02x) timed out.\n", val);
172 #endif
173 return 0;
174 }
175
176 static int
177 sb_cmd(struct sb_info *sb, u_char val)
178 {
179 #if 0
180 printf("sb_cmd: %x\n", val);
181 #endif
182 return sb_dspwr(sb, val);
183 }
184
185 /*
186 static int
187 sb_cmd1(struct sb_info *sb, u_char cmd, int val)
188 {
189 #if 0
190 printf("sb_cmd1: %x, %x\n", cmd, val);
191 #endif
192 if (sb_dspwr(sb, cmd)) {
193 return sb_dspwr(sb, val & 0xff);
194 } else return 0;
195 }
196 */
197
198 static int
199 sb_cmd2(struct sb_info *sb, u_char cmd, int val)
200 {
201 int r;
202
203 #if 0
204 printf("sb_cmd2: %x, %x\n", cmd, val);
205 #endif
206 sb_lock(sb);
207 r = 0;
208 if (sb_dspwr(sb, cmd)) {
209 if (sb_dspwr(sb, val & 0xff)) {
210 if (sb_dspwr(sb, (val >> 8) & 0xff)) {
211 r = 1;
212 }
213 }
214 }
215 sb_unlock(sb);
216
217 return r;
218 }
219
220 /*
221 * in the SB, there is a set of indirect "mixer" registers with
222 * address at offset 4, data at offset 5
223 */
224 static void
225 sb_setmixer(struct sb_info *sb, u_int port, u_int value)
226 {
227 sb_lock(sb);
228 sb_wr(sb, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */
229 DELAY(10);
230 sb_wr(sb, SB_MIX_DATA, (u_char) (value & 0xff));
231 DELAY(10);
232 sb_unlock(sb);
233 }
234
235 static int
236 sb_getmixer(struct sb_info *sb, u_int port)
237 {
238 int val;
239
240 sb_lock(sb);
241 sb_wr(sb, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */
242 DELAY(10);
243 val = sb_rd(sb, SB_MIX_DATA);
244 DELAY(10);
245 sb_unlock(sb);
246
247 return val;
248 }
249
250 static u_int
251 sb_get_byte(struct sb_info *sb)
252 {
253 int i;
254
255 for (i = 1000; i > 0; i--) {
256 if (sb_rd(sb, DSP_DATA_AVAIL) & 0x80)
257 return sb_rd(sb, DSP_READ);
258 else
259 DELAY(20);
260 }
261 return 0xffff;
262 }
263
264 static int
265 sb_reset_dsp(struct sb_info *sb)
266 {
267 u_char b;
268
269 sb_lock(sb);
270 sb_wr(sb, SBDSP_RST, 3);
271 DELAY(100);
272 sb_wr(sb, SBDSP_RST, 0);
273 b = sb_get_byte(sb);
274 sb_unlock(sb);
275 if (b != 0xAA) {
276 DEB(printf("sb_reset_dsp 0x%lx failed\n",
277 rman_get_start(sb->io_base)));
278 return ENXIO; /* Sorry */
279 }
280 return 0;
281 }
282
283 /************************************************************/
284
285 struct sb16_mixent {
286 int reg;
287 int bits;
288 int ofs;
289 int stereo;
290 };
291
292 static const struct sb16_mixent sb16_mixtab[32] = {
293 [SOUND_MIXER_VOLUME] = { 0x30, 5, 3, 1 },
294 [SOUND_MIXER_PCM] = { 0x32, 5, 3, 1 },
295 [SOUND_MIXER_SYNTH] = { 0x34, 5, 3, 1 },
296 [SOUND_MIXER_CD] = { 0x36, 5, 3, 1 },
297 [SOUND_MIXER_LINE] = { 0x38, 5, 3, 1 },
298 [SOUND_MIXER_MIC] = { 0x3a, 5, 3, 0 },
299 [SOUND_MIXER_SPEAKER] = { 0x3b, 5, 3, 0 },
300 [SOUND_MIXER_IGAIN] = { 0x3f, 2, 6, 1 },
301 [SOUND_MIXER_OGAIN] = { 0x41, 2, 6, 1 },
302 [SOUND_MIXER_TREBLE] = { 0x44, 4, 4, 1 },
303 [SOUND_MIXER_BASS] = { 0x46, 4, 4, 1 },
304 [SOUND_MIXER_LINE1] = { 0x52, 5, 3, 1 }
305 };
306
307 static int
308 sb16mix_init(struct snd_mixer *m)
309 {
310 struct sb_info *sb = mix_getdevinfo(m);
311
312 mix_setdevs(m, SOUND_MASK_SYNTH | SOUND_MASK_PCM | SOUND_MASK_SPEAKER |
313 SOUND_MASK_LINE | SOUND_MASK_MIC | SOUND_MASK_CD |
314 SOUND_MASK_IGAIN | SOUND_MASK_OGAIN | SOUND_MASK_LINE1 |
315 SOUND_MASK_VOLUME | SOUND_MASK_BASS | SOUND_MASK_TREBLE);
316
317 mix_setrecdevs(m, SOUND_MASK_SYNTH | SOUND_MASK_LINE |
318 SOUND_MASK_LINE1 | SOUND_MASK_MIC | SOUND_MASK_CD);
319
320 sb_setmixer(sb, 0x3c, 0x1f); /* make all output active */
321
322 sb_setmixer(sb, 0x3d, 0); /* make all inputs-l off */
323 sb_setmixer(sb, 0x3e, 0); /* make all inputs-r off */
324
325 return 0;
326 }
327
328 static int
329 sb16mix_set(struct snd_mixer *m, unsigned dev, unsigned left, unsigned right)
330 {
331 struct sb_info *sb = mix_getdevinfo(m);
332 const struct sb16_mixent *e;
333 int max;
334
335 e = &sb16_mixtab[dev];
336 max = (1 << e->bits) - 1;
337
338 left = (left * max) / 100;
339 right = (right * max) / 100;
340
341 sb_setmixer(sb, e->reg, left << e->ofs);
342 if (e->stereo)
343 sb_setmixer(sb, e->reg + 1, right << e->ofs);
344 else
345 right = left;
346
347 left = (left * 100) / max;
348 right = (right * 100) / max;
349
350 return left | (right << 8);
351 }
352
353 static int
354 sb16mix_setrecsrc(struct snd_mixer *m, u_int32_t src)
355 {
356 struct sb_info *sb = mix_getdevinfo(m);
357 u_char recdev;
358
359 recdev = 0;
360 if (src & SOUND_MASK_MIC)
361 recdev |= 0x01; /* mono mic */
362
363 if (src & SOUND_MASK_CD)
364 recdev |= 0x06; /* l+r cd */
365
366 if (src & SOUND_MASK_LINE)
367 recdev |= 0x18; /* l+r line */
368
369 if (src & SOUND_MASK_SYNTH)
370 recdev |= 0x60; /* l+r midi */
371
372 sb_setmixer(sb, SB16_IMASK_L, recdev);
373 sb_setmixer(sb, SB16_IMASK_R, recdev);
374
375 /* Switch on/off FM tuner source */
376 if (src & SOUND_MASK_LINE1)
377 sb_setmixer(sb, 0x4a, 0x0c);
378 else
379 sb_setmixer(sb, 0x4a, 0x00);
380
381 /*
382 * since the same volume controls apply to the input and
383 * output sections, the best approach to have a consistent
384 * behaviour among cards would be to disable the output path
385 * on devices which are used to record.
386 * However, since users like to have feedback, we only disable
387 * the mic -- permanently.
388 */
389 sb_setmixer(sb, SB16_OMASK, 0x1f & ~1);
390
391 return src;
392 }
393
394 static kobj_method_t sb16mix_mixer_methods[] = {
395 KOBJMETHOD(mixer_init, sb16mix_init),
396 KOBJMETHOD(mixer_set, sb16mix_set),
397 KOBJMETHOD(mixer_setrecsrc, sb16mix_setrecsrc),
398 { 0, 0 }
399 };
400 MIXER_DECLARE(sb16mix_mixer);
401
402 /************************************************************/
403
404 static void
405 sb16_release_resources(struct sb_info *sb, device_t dev)
406 {
407 if (sb->irq) {
408 if (sb->ih)
409 bus_teardown_intr(dev, sb->irq, sb->ih);
410 bus_release_resource(dev, SYS_RES_IRQ, 0, sb->irq);
411 sb->irq = 0;
412 }
413 if (sb->drq2) {
414 if (sb->drq2 != sb->drq1) {
415 isa_dma_release(rman_get_start(sb->drq2));
416 bus_release_resource(dev, SYS_RES_DRQ, 1, sb->drq2);
417 }
418 sb->drq2 = 0;
419 }
420 if (sb->drq1) {
421 isa_dma_release(rman_get_start(sb->drq1));
422 bus_release_resource(dev, SYS_RES_DRQ, 0, sb->drq1);
423 sb->drq1 = 0;
424 }
425 if (sb->io_base) {
426 bus_release_resource(dev, SYS_RES_IOPORT, 0, sb->io_base);
427 sb->io_base = 0;
428 }
429 if (sb->parent_dmat) {
430 bus_dma_tag_destroy(sb->parent_dmat);
431 sb->parent_dmat = 0;
432 }
433 free(sb, M_DEVBUF);
434 }
435
436 static int
437 sb16_alloc_resources(struct sb_info *sb, device_t dev)
438 {
439 int rid;
440
441 rid = 0;
442 if (!sb->io_base)
443 sb->io_base = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1, RF_ACTIVE);
444
445 rid = 0;
446 if (!sb->irq)
447 sb->irq = bus_alloc_resource(dev, SYS_RES_IRQ, &rid, 0, ~0, 1, RF_ACTIVE);
448
449 rid = 0;
450 if (!sb->drq1)
451 sb->drq1 = bus_alloc_resource(dev, SYS_RES_DRQ, &rid, 0, ~0, 1, RF_ACTIVE);
452
453 rid = 1;
454 if (!sb->drq2)
455 sb->drq2 = bus_alloc_resource(dev, SYS_RES_DRQ, &rid, 0, ~0, 1, RF_ACTIVE);
456
457 if (sb->io_base && sb->drq1 && sb->irq) {
458 isa_dma_acquire(rman_get_start(sb->drq1));
459 isa_dmainit(rman_get_start(sb->drq1), sb->bufsize);
460
461 if (sb->drq2) {
462 isa_dma_acquire(rman_get_start(sb->drq2));
463 isa_dmainit(rman_get_start(sb->drq2), sb->bufsize);
464 } else {
465 sb->drq2 = sb->drq1;
466 pcm_setflags(dev, pcm_getflags(dev) | SD_F_SIMPLEX);
467 }
468 return 0;
469 } else return ENXIO;
470 }
471
472 /* sbc does locking for us */
473 static void
474 sb_intr(void *arg)
475 {
476 struct sb_info *sb = (struct sb_info *)arg;
477 int reason = 3, c;
478
479 /*
480 * The Vibra16X has separate flags for 8 and 16 bit transfers, but
481 * I have no idea how to tell capture from playback interrupts...
482 */
483
484 reason = 0;
485 sb_lock(sb);
486 c = sb_getmixer(sb, IRQ_STAT);
487 if (c & 1)
488 sb_rd(sb, DSP_DATA_AVAIL); /* 8-bit int ack */
489
490 if (c & 2)
491 sb_rd(sb, DSP_DATA_AVL16); /* 16-bit int ack */
492 sb_unlock(sb);
493
494 /*
495 * this tells us if the source is 8-bit or 16-bit dma. We
496 * have to check the io channel to map it to read or write...
497 */
498
499 if (sb->bd_flags & BD_F_SB16X) {
500 if (c & 1) { /* 8-bit format */
501 if (sb->pch.fmt & AFMT_8BIT)
502 reason |= 1;
503 if (sb->rch.fmt & AFMT_8BIT)
504 reason |= 2;
505 }
506 if (c & 2) { /* 16-bit format */
507 if (sb->pch.fmt & AFMT_16BIT)
508 reason |= 1;
509 if (sb->rch.fmt & AFMT_16BIT)
510 reason |= 2;
511 }
512 } else {
513 if (c & 1) { /* 8-bit dma */
514 if (sb->pch.dch == 1)
515 reason |= 1;
516 if (sb->rch.dch == 1)
517 reason |= 2;
518 }
519 if (c & 2) { /* 16-bit dma */
520 if (sb->pch.dch == 2)
521 reason |= 1;
522 if (sb->rch.dch == 2)
523 reason |= 2;
524 }
525 }
526 #if 0
527 printf("sb_intr: reason=%d c=0x%x\n", reason, c);
528 #endif
529 if ((reason & 1) && (sb->pch.run))
530 chn_intr(sb->pch.channel);
531
532 if ((reason & 2) && (sb->rch.run))
533 chn_intr(sb->rch.channel);
534 }
535
536 static int
537 sb_setup(struct sb_info *sb)
538 {
539 struct sb_chinfo *ch;
540 u_int8_t v;
541 int l, pprio;
542
543 sb_lock(sb);
544 if (sb->bd_flags & BD_F_DMARUN)
545 sndbuf_dma(sb->pch.buffer, PCMTRIG_STOP);
546 if (sb->bd_flags & BD_F_DMARUN2)
547 sndbuf_dma(sb->rch.buffer, PCMTRIG_STOP);
548 sb->bd_flags &= ~(BD_F_DMARUN | BD_F_DMARUN2);
549
550 sb_reset_dsp(sb);
551
552 if (sb->bd_flags & BD_F_SB16X) {
553 pprio = sb->pch.run? 1 : 0;
554 sndbuf_dmasetup(sb->pch.buffer, pprio? sb->drq1 : NULL);
555 sb->pch.dch = pprio? 1 : 0;
556 sndbuf_dmasetup(sb->rch.buffer, pprio? sb->drq2 : sb->drq1);
557 sb->rch.dch = pprio? 2 : 1;
558 } else {
559 if (sb->pch.run && sb->rch.run) {
560 pprio = (sb->rch.fmt & AFMT_16BIT)? 0 : 1;
561 sndbuf_dmasetup(sb->pch.buffer, pprio? sb->drq2 : sb->drq1);
562 sb->pch.dch = pprio? 2 : 1;
563 sndbuf_dmasetup(sb->rch.buffer, pprio? sb->drq1 : sb->drq2);
564 sb->rch.dch = pprio? 1 : 2;
565 } else {
566 if (sb->pch.run) {
567 sndbuf_dmasetup(sb->pch.buffer, (sb->pch.fmt & AFMT_16BIT)? sb->drq2 : sb->drq1);
568 sb->pch.dch = (sb->pch.fmt & AFMT_16BIT)? 2 : 1;
569 sndbuf_dmasetup(sb->rch.buffer, (sb->pch.fmt & AFMT_16BIT)? sb->drq1 : sb->drq2);
570 sb->rch.dch = (sb->pch.fmt & AFMT_16BIT)? 1 : 2;
571 } else if (sb->rch.run) {
572 sndbuf_dmasetup(sb->pch.buffer, (sb->rch.fmt & AFMT_16BIT)? sb->drq1 : sb->drq2);
573 sb->pch.dch = (sb->rch.fmt & AFMT_16BIT)? 1 : 2;
574 sndbuf_dmasetup(sb->rch.buffer, (sb->rch.fmt & AFMT_16BIT)? sb->drq2 : sb->drq1);
575 sb->rch.dch = (sb->rch.fmt & AFMT_16BIT)? 2 : 1;
576 }
577 }
578 }
579
580 sndbuf_dmasetdir(sb->pch.buffer, PCMDIR_PLAY);
581 sndbuf_dmasetdir(sb->rch.buffer, PCMDIR_REC);
582
583 /*
584 printf("setup: [pch = %d, pfmt = %d, pgo = %d] [rch = %d, rfmt = %d, rgo = %d]\n",
585 sb->pch.dch, sb->pch.fmt, sb->pch.run, sb->rch.dch, sb->rch.fmt, sb->rch.run);
586 */
587
588 ch = &sb->pch;
589 if (ch->run) {
590 l = ch->blksz;
591 if (ch->fmt & AFMT_16BIT)
592 l >>= 1;
593 l--;
594
595 /* play speed */
596 RANGE(ch->spd, 5000, 45000);
597 sb_cmd(sb, DSP_CMD_OUT16);
598 sb_cmd(sb, ch->spd >> 8);
599 sb_cmd(sb, ch->spd & 0xff);
600
601 /* play format, length */
602 v = DSP_F16_AUTO | DSP_F16_FIFO_ON | DSP_F16_DAC;
603 v |= (ch->fmt & AFMT_16BIT)? DSP_DMA16 : DSP_DMA8;
604 sb_cmd(sb, v);
605
606 v = (ch->fmt & AFMT_STEREO)? DSP_F16_STEREO : 0;
607 v |= (ch->fmt & AFMT_SIGNED)? DSP_F16_SIGNED : 0;
608 sb_cmd2(sb, v, l);
609 sndbuf_dma(ch->buffer, PCMTRIG_START);
610 sb->bd_flags |= BD_F_DMARUN;
611 }
612
613 ch = &sb->rch;
614 if (ch->run) {
615 l = ch->blksz;
616 if (ch->fmt & AFMT_16BIT)
617 l >>= 1;
618 l--;
619
620 /* record speed */
621 RANGE(ch->spd, 5000, 45000);
622 sb_cmd(sb, DSP_CMD_IN16);
623 sb_cmd(sb, ch->spd >> 8);
624 sb_cmd(sb, ch->spd & 0xff);
625
626 /* record format, length */
627 v = DSP_F16_AUTO | DSP_F16_FIFO_ON | DSP_F16_ADC;
628 v |= (ch->fmt & AFMT_16BIT)? DSP_DMA16 : DSP_DMA8;
629 sb_cmd(sb, v);
630
631 v = (ch->fmt & AFMT_STEREO)? DSP_F16_STEREO : 0;
632 v |= (ch->fmt & AFMT_SIGNED)? DSP_F16_SIGNED : 0;
633 sb_cmd2(sb, v, l);
634 sndbuf_dma(ch->buffer, PCMTRIG_START);
635 sb->bd_flags |= BD_F_DMARUN2;
636 }
637 sb_unlock(sb);
638
639 return 0;
640 }
641
642 /* channel interface */
643 static void *
644 sb16chan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
645 {
646 struct sb_info *sb = devinfo;
647 struct sb_chinfo *ch = (dir == PCMDIR_PLAY)? &sb->pch : &sb->rch;
648
649 ch->parent = sb;
650 ch->channel = c;
651 ch->buffer = b;
652 ch->dir = dir;
653
654 if (sndbuf_alloc(ch->buffer, sb->parent_dmat, sb->bufsize) == -1)
655 return NULL;
656
657 return ch;
658 }
659
660 static int
661 sb16chan_setformat(kobj_t obj, void *data, u_int32_t format)
662 {
663 struct sb_chinfo *ch = data;
664 struct sb_info *sb = ch->parent;
665
666 ch->fmt = format;
667 sb->prio = ch->dir;
668 sb->prio16 = (ch->fmt & AFMT_16BIT)? 1 : 0;
669
670 return 0;
671 }
672
673 static int
674 sb16chan_setspeed(kobj_t obj, void *data, u_int32_t speed)
675 {
676 struct sb_chinfo *ch = data;
677
678 ch->spd = speed;
679 return speed;
680 }
681
682 static int
683 sb16chan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
684 {
685 struct sb_chinfo *ch = data;
686
687 ch->blksz = blocksize;
688 return ch->blksz;
689 }
690
691 static int
692 sb16chan_trigger(kobj_t obj, void *data, int go)
693 {
694 struct sb_chinfo *ch = data;
695 struct sb_info *sb = ch->parent;
696
697 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
698 return 0;
699
700 if (go == PCMTRIG_START)
701 ch->run = 1;
702 else
703 ch->run = 0;
704
705 sb_setup(sb);
706
707 return 0;
708 }
709
710 static int
711 sb16chan_getptr(kobj_t obj, void *data)
712 {
713 struct sb_chinfo *ch = data;
714
715 return sndbuf_dmaptr(ch->buffer);
716 }
717
718 static struct pcmchan_caps *
719 sb16chan_getcaps(kobj_t obj, void *data)
720 {
721 struct sb_chinfo *ch = data;
722 struct sb_info *sb = ch->parent;
723
724 if ((sb->prio == 0) || (sb->prio == ch->dir))
725 return &sb16x_caps;
726 else
727 return sb->prio16? &sb16_caps8 : &sb16_caps16;
728 }
729
730 static int
731 sb16chan_resetdone(kobj_t obj, void *data)
732 {
733 struct sb_chinfo *ch = data;
734 struct sb_info *sb = ch->parent;
735
736 sb->prio = 0;
737
738 return 0;
739 }
740
741 static kobj_method_t sb16chan_methods[] = {
742 KOBJMETHOD(channel_init, sb16chan_init),
743 KOBJMETHOD(channel_resetdone, sb16chan_resetdone),
744 KOBJMETHOD(channel_setformat, sb16chan_setformat),
745 KOBJMETHOD(channel_setspeed, sb16chan_setspeed),
746 KOBJMETHOD(channel_setblocksize, sb16chan_setblocksize),
747 KOBJMETHOD(channel_trigger, sb16chan_trigger),
748 KOBJMETHOD(channel_getptr, sb16chan_getptr),
749 KOBJMETHOD(channel_getcaps, sb16chan_getcaps),
750 { 0, 0 }
751 };
752 CHANNEL_DECLARE(sb16chan);
753
754 /************************************************************/
755
756 static int
757 sb16_probe(device_t dev)
758 {
759 char buf[64];
760 uintptr_t func, ver, r, f;
761
762 /* The parent device has already been probed. */
763 r = BUS_READ_IVAR(device_get_parent(dev), dev, 0, &func);
764 if (func != SCF_PCM)
765 return (ENXIO);
766
767 r = BUS_READ_IVAR(device_get_parent(dev), dev, 1, &ver);
768 f = (ver & 0xffff0000) >> 16;
769 ver &= 0x0000ffff;
770 if (f & BD_F_SB16) {
771 snprintf(buf, sizeof buf, "SB16 DSP %d.%02d%s", (int) ver >> 8, (int) ver & 0xff,
772 (f & BD_F_SB16X)? " (ViBRA16X)" : "");
773 device_set_desc_copy(dev, buf);
774 return 0;
775 } else
776 return (ENXIO);
777 }
778
779 static int
780 sb16_attach(device_t dev)
781 {
782 struct sb_info *sb;
783 uintptr_t ver;
784 char status[SND_STATUSLEN], status2[SND_STATUSLEN];
785
786 sb = (struct sb_info *)malloc(sizeof *sb, M_DEVBUF, M_NOWAIT | M_ZERO);
787 if (!sb)
788 return ENXIO;
789
790 sb->parent_dev = device_get_parent(dev);
791 BUS_READ_IVAR(sb->parent_dev, dev, 1, &ver);
792 sb->bd_id = ver & 0x0000ffff;
793 sb->bd_flags = (ver & 0xffff0000) >> 16;
794 sb->bufsize = pcm_getbuffersize(dev, 4096, SB16_BUFFSIZE, 65536);
795
796 if (sb16_alloc_resources(sb, dev))
797 goto no;
798 if (sb_reset_dsp(sb))
799 goto no;
800 if (mixer_init(dev, &sb16mix_mixer_class, sb))
801 goto no;
802 if (snd_setup_intr(dev, sb->irq, INTR_MPSAFE, sb_intr, sb, &sb->ih))
803 goto no;
804
805 if (sb->bd_flags & BD_F_SB16X)
806 pcm_setflags(dev, pcm_getflags(dev) | SD_F_SIMPLEX);
807
808 sb->prio = 0;
809
810 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0,
811 /*lowaddr*/BUS_SPACE_MAXADDR_24BIT,
812 /*highaddr*/BUS_SPACE_MAXADDR,
813 /*filter*/NULL, /*filterarg*/NULL,
814 /*maxsize*/sb->bufsize, /*nsegments*/1,
815 /*maxsegz*/0x3ffff, /*flags*/0,
816 /*lockfunc*/busdma_lock_mutex, /*lockarg*/&Giant,
817 &sb->parent_dmat) != 0) {
818 device_printf(dev, "unable to create dma tag\n");
819 goto no;
820 }
821
822 if (!(pcm_getflags(dev) & SD_F_SIMPLEX))
823 snprintf(status2, SND_STATUSLEN, ":%ld", rman_get_start(sb->drq2));
824 else
825 status2[0] = '\0';
826
827 snprintf(status, SND_STATUSLEN, "at io 0x%lx irq %ld drq %ld%s bufsz %ud",
828 rman_get_start(sb->io_base), rman_get_start(sb->irq),
829 rman_get_start(sb->drq1), status2, sb->bufsize);
830
831 if (pcm_register(dev, sb, 1, 1))
832 goto no;
833 pcm_addchan(dev, PCMDIR_REC, &sb16chan_class, sb);
834 pcm_addchan(dev, PCMDIR_PLAY, &sb16chan_class, sb);
835
836 pcm_setstatus(dev, status);
837
838 return 0;
839
840 no:
841 sb16_release_resources(sb, dev);
842 return ENXIO;
843 }
844
845 static int
846 sb16_detach(device_t dev)
847 {
848 int r;
849 struct sb_info *sb;
850
851 r = pcm_unregister(dev);
852 if (r)
853 return r;
854
855 sb = pcm_getdevinfo(dev);
856 sb16_release_resources(sb, dev);
857 return 0;
858 }
859
860 static device_method_t sb16_methods[] = {
861 /* Device interface */
862 DEVMETHOD(device_probe, sb16_probe),
863 DEVMETHOD(device_attach, sb16_attach),
864 DEVMETHOD(device_detach, sb16_detach),
865
866 { 0, 0 }
867 };
868
869 static driver_t sb16_driver = {
870 "pcm",
871 sb16_methods,
872 PCM_SOFTC_SIZE,
873 };
874
875 DRIVER_MODULE(snd_sb16, sbc, sb16_driver, pcm_devclass, 0, 0);
876 MODULE_DEPEND(snd_sb16, snd_pcm, PCM_MINVER, PCM_PREFVER, PCM_MAXVER);
877 MODULE_DEPEND(snd_sb16, snd_sbc, 1, 1, 1);
878 MODULE_VERSION(snd_sb16, 1);
Cache object: bf5dd30374c9934593577c7692d8eb4e
|