37
38#define VIA_PCI_ID 0x30581106
39#define NSEGS 4 /* Number of segments in SGD table */
40
41#define SEGS_PER_CHAN (NSEGS/2)
42
43#define TIMEOUT 50
44#define VIA_DEFAULT_BUFSZ 0x1000
45
46#undef DEB
47#define DEB(x)
48
49/* we rely on this struct being packed to 64 bits */
50struct via_dma_op {
51 u_int32_t ptr;
52 u_int32_t flags;
53#define VIA_DMAOP_EOL 0x80000000
54#define VIA_DMAOP_FLAG 0x40000000
55#define VIA_DMAOP_STOP 0x20000000
56#define VIA_DMAOP_COUNT(x) ((x)&0x00FFFFFF)
57};
58
59struct via_info;
60
61struct via_chinfo {
62 struct via_info *parent;
63 struct pcm_channel *channel;
64 struct snd_dbuf *buffer;
65 struct via_dma_op *sgd_table;
66 bus_addr_t sgd_addr;
67 int dir, blksz;
68 int base, count, mode, ctrl;
69};
70
71struct via_info {
72 bus_space_tag_t st;
73 bus_space_handle_t sh;
74 bus_dma_tag_t parent_dmat;
75 bus_dma_tag_t sgd_dmat;
76 bus_dmamap_t sgd_dmamap;
77 bus_addr_t sgd_addr;
78
79 struct resource *reg, *irq;
80 int regid, irqid;
81 void *ih;
82 struct ac97_info *codec;
83
84 unsigned int bufsz;
85
86 struct via_chinfo pch, rch;
87 struct via_dma_op *sgd_table;
88 u_int16_t codec_caps;
89};
90
91static u_int32_t via_fmt[] = {
92 AFMT_U8,
93 AFMT_STEREO | AFMT_U8,
94 AFMT_S16_LE,
95 AFMT_STEREO | AFMT_S16_LE,
96 0
97};
98static struct pcmchan_caps via_vracaps = {4000, 48000, via_fmt, 0};
99static struct pcmchan_caps via_caps = {48000, 48000, via_fmt, 0};
100
101static u_int32_t
102via_rd(struct via_info *via, int regno, int size)
103{
104
105 switch (size) {
106 case 1:
107 return bus_space_read_1(via->st, via->sh, regno);
108 case 2:
109 return bus_space_read_2(via->st, via->sh, regno);
110 case 4:
111 return bus_space_read_4(via->st, via->sh, regno);
112 default:
113 return 0xFFFFFFFF;
114 }
115}
116
117
118static void
119via_wr(struct via_info *via, int regno, u_int32_t data, int size)
120{
121
122 switch (size) {
123 case 1:
124 bus_space_write_1(via->st, via->sh, regno, data);
125 break;
126 case 2:
127 bus_space_write_2(via->st, via->sh, regno, data);
128 break;
129 case 4:
130 bus_space_write_4(via->st, via->sh, regno, data);
131 break;
132 }
133}
134
135/* -------------------------------------------------------------------- */
136/* Codec interface */
137
138static int
139via_waitready_codec(struct via_info *via)
140{
141 int i;
142
143 /* poll until codec not busy */
144 for (i = 0; (i < TIMEOUT) &&
145 (via_rd(via, VIA_CODEC_CTL, 4) & VIA_CODEC_BUSY); i++)
146 DELAY(1);
147 if (i >= TIMEOUT) {
148 printf("via: codec busy\n");
149 return 1;
150 }
151
152 return 0;
153}
154
155
156static int
157via_waitvalid_codec(struct via_info *via)
158{
159 int i;
160
161 /* poll until codec valid */
162 for (i = 0; (i < TIMEOUT) &&
163 !(via_rd(via, VIA_CODEC_CTL, 4) & VIA_CODEC_PRIVALID); i++)
164 DELAY(1);
165 if (i >= TIMEOUT) {
166 printf("via: codec invalid\n");
167 return 1;
168 }
169
170 return 0;
171}
172
173
174static int
175via_write_codec(kobj_t obj, void *addr, int reg, u_int32_t val)
176{
177 struct via_info *via = addr;
178
179 if (via_waitready_codec(via)) return -1;
180
181 via_wr(via, VIA_CODEC_CTL, VIA_CODEC_PRIVALID | VIA_CODEC_INDEX(reg) | val, 4);
182
183 return 0;
184}
185
186
187static int
188via_read_codec(kobj_t obj, void *addr, int reg)
189{
190 struct via_info *via = addr;
191
192 if (via_waitready_codec(via))
193 return -1;
194
195 via_wr(via, VIA_CODEC_CTL, VIA_CODEC_PRIVALID | VIA_CODEC_READ | VIA_CODEC_INDEX(reg),4);
196
197 if (via_waitready_codec(via))
198 return -1;
199
200 if (via_waitvalid_codec(via))
201 return -1;
202
203 return via_rd(via, VIA_CODEC_CTL, 2);
204}
205
206static kobj_method_t via_ac97_methods[] = {
207 KOBJMETHOD(ac97_read, via_read_codec),
208 KOBJMETHOD(ac97_write, via_write_codec),
209 { 0, 0 }
210};
211AC97_DECLARE(via_ac97);
212
213/* -------------------------------------------------------------------- */
214
215static int
216via_buildsgdt(struct via_chinfo *ch)
217{
218 u_int32_t phys_addr, flag;
219 int i, segs, seg_size;
220
221 /*
222 * Build the scatter/gather DMA (SGD) table.
223 * There are four slots in the table: two for play, two for record.
224 * This creates two half-buffers, one of which is playing; the other
225 * is feeding.
226 */
227 seg_size = ch->blksz;
228 segs = sndbuf_getsize(ch->buffer) / seg_size;
229 phys_addr = sndbuf_getbufaddr(ch->buffer);
230
231 for (i = 0; i < segs; i++) {
232 flag = (i == segs - 1)? VIA_DMAOP_EOL : VIA_DMAOP_FLAG;
233 ch->sgd_table[i].ptr = phys_addr + (i * seg_size);
234 ch->sgd_table[i].flags = flag | seg_size;
235 }
236
237 return 0;
238}
239
240/* channel interface */
241static void *
242viachan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
243{
244 struct via_info *via = devinfo;
245 struct via_chinfo *ch;
246
247 if (dir == PCMDIR_PLAY) {
248 ch = &via->pch;
249 ch->base = VIA_PLAY_DMAOPS_BASE;
250 ch->count = VIA_PLAY_DMAOPS_COUNT;
251 ch->ctrl = VIA_PLAY_CONTROL;
252 ch->mode = VIA_PLAY_MODE;
253 ch->sgd_addr = via->sgd_addr;
254 ch->sgd_table = &via->sgd_table[0];
255 } else {
256 ch = &via->rch;
257 ch->base = VIA_RECORD_DMAOPS_BASE;
258 ch->count = VIA_RECORD_DMAOPS_COUNT;
259 ch->ctrl = VIA_RECORD_CONTROL;
260 ch->mode = VIA_RECORD_MODE;
261 ch->sgd_addr = via->sgd_addr + sizeof(struct via_dma_op) * SEGS_PER_CHAN;
262 ch->sgd_table = &via->sgd_table[SEGS_PER_CHAN];
263 }
264
265 ch->parent = via;
266 ch->channel = c;
267 ch->buffer = b;
268 ch->dir = dir;
269
270 if (sndbuf_alloc(ch->buffer, via->parent_dmat, via->bufsz) == -1)
271 return NULL;
272 return ch;
273}
274
275static int
276viachan_setformat(kobj_t obj, void *data, u_int32_t format)
277{
278 struct via_chinfo *ch = data;
279 struct via_info *via = ch->parent;
280 int mode, mode_set;
281
282 mode_set = 0;
283 if (format & AFMT_STEREO)
284 mode_set |= VIA_RPMODE_STEREO;
285 if (format & AFMT_S16_LE)
286 mode_set |= VIA_RPMODE_16BIT;
287
288 DEB(printf("set format: dir = %d, format=%x\n", ch->dir, format));
289 mode = via_rd(via, ch->mode, 1);
290 mode &= ~(VIA_RPMODE_16BIT | VIA_RPMODE_STEREO);
291 mode |= mode_set;
292 via_wr(via, ch->mode, mode, 1);
293
294 return 0;
295}
296
297static int
298viachan_setspeed(kobj_t obj, void *data, u_int32_t speed)
299{
300 struct via_chinfo *ch = data;
301 struct via_info *via = ch->parent;
302 int reg;
303
304 /*
305 * Basic AC'97 defines a 48 kHz sample rate only. For other rates,
306 * upsampling is required.
307 *
308 * The VT82C686A does not perform upsampling, and neither do we.
309 * If the codec supports variable-rate audio (i.e. does the upsampling
310 * itself), then negotiate the rate with the codec. Otherwise,
311 * return 48 kHz cuz that's all you got.
312 */
313 if (via->codec_caps & AC97_EXTCAP_VRA) {
314 reg = (ch->dir == PCMDIR_PLAY)? AC97_REGEXT_FDACRATE : AC97_REGEXT_LADCRATE;
315 return ac97_setrate(via->codec, reg, speed);
316 } else
317 return 48000;
318}
319
320static int
321viachan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
322{
323 struct via_chinfo *ch = data;
324
325 ch->blksz = blocksize;
326 sndbuf_resize(ch->buffer, SEGS_PER_CHAN, ch->blksz);
327
328 return ch->blksz;
329}
330
331static int
332viachan_trigger(kobj_t obj, void *data, int go)
333{
334 struct via_chinfo *ch = data;
335 struct via_info *via = ch->parent;
336 struct via_dma_op *ado;
337 bus_addr_t sgd_addr = ch->sgd_addr;
338
339 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
340 return 0;
341
342 ado = ch->sgd_table;
343 DEB(printf("ado located at va=%p pa=%x\n", ado, sgd_addr));
344
345 if (go == PCMTRIG_START) {
346 via_buildsgdt(ch);
347 via_wr(via, ch->base, sgd_addr, 4);
348 via_wr(via, ch->ctrl, VIA_RPCTRL_START, 1);
349 } else
350 via_wr(via, ch->ctrl, VIA_RPCTRL_TERMINATE, 1);
351
352 DEB(printf("viachan_trigger: go=%d\n", go));
353 return 0;
354}
355
356static int
357viachan_getptr(kobj_t obj, void *data)
358{
359 struct via_chinfo *ch = data;
360 struct via_info *via = ch->parent;
361 struct via_dma_op *ado;
362 bus_addr_t sgd_addr = ch->sgd_addr;
363 int ptr, base, base1, len, seg;
364
365 ado = ch->sgd_table;
366 base1 = via_rd(via, ch->base, 4);
367 len = via_rd(via, ch->count, 4);
368 base = via_rd(via, ch->base, 4);
369 if (base != base1) /* Avoid race hazard */
370 len = via_rd(via, ch->count, 4);
371
372 DEB(printf("viachan_getptr: len / base = %x / %x\n", len, base));
373
374 /* Base points to SGD segment to do, one past current */
375
376 /* Determine how many segments have been done */
377 seg = (base - sgd_addr) / sizeof(struct via_dma_op);
378 if (seg == 0)
379 seg = SEGS_PER_CHAN;
380
381 /* Now work out offset: seg less count */
382 ptr = (seg * sndbuf_getsize(ch->buffer) / SEGS_PER_CHAN) - len;
383 if (ch->dir == PCMDIR_REC) {
384 /* DMA appears to operate on memory 'lines' of 32 bytes */
385 /* so don't return any part line - it isn't in RAM yet */
386 ptr = ptr & ~0x1f;
387 }
388
389 DEB(printf("return ptr=%d\n", ptr));
390 return ptr;
391}
392
393static struct pcmchan_caps *
394viachan_getcaps(kobj_t obj, void *data)
395{
396 struct via_chinfo *ch = data;
397 struct via_info *via = ch->parent;
398
399 return (via->codec_caps & AC97_EXTCAP_VRA)? &via_vracaps : &via_caps;
400}
401
402static kobj_method_t viachan_methods[] = {
403 KOBJMETHOD(channel_init, viachan_init),
404 KOBJMETHOD(channel_setformat, viachan_setformat),
405 KOBJMETHOD(channel_setspeed, viachan_setspeed),
406 KOBJMETHOD(channel_setblocksize, viachan_setblocksize),
407 KOBJMETHOD(channel_trigger, viachan_trigger),
408 KOBJMETHOD(channel_getptr, viachan_getptr),
409 KOBJMETHOD(channel_getcaps, viachan_getcaps),
410 { 0, 0 }
411};
412CHANNEL_DECLARE(viachan);
413
414/* -------------------------------------------------------------------- */
415
416static void
417via_intr(void *p)
418{
419 struct via_info *via = p;
420 int st;
421
422 /* DEB(printf("viachan_intr\n")); */
423 /* Read channel */
424 st = via_rd(via, VIA_PLAY_STAT, 1);
425 if (st & VIA_RPSTAT_INTR) {
426 via_wr(via, VIA_PLAY_STAT, VIA_RPSTAT_INTR, 1);
427 chn_intr(via->pch.channel);
428 }
429
430 /* Write channel */
431 st = via_rd(via, VIA_RECORD_STAT, 1);
432 if (st & VIA_RPSTAT_INTR) {
433 via_wr(via, VIA_RECORD_STAT, VIA_RPSTAT_INTR, 1);
434 chn_intr(via->rch.channel);
435 }
436}
437
438/*
439 * Probe and attach the card
440 */
441static int
442via_probe(device_t dev)
443{
444 if (pci_get_devid(dev) == VIA_PCI_ID) {
445 device_set_desc(dev, "VIA VT82C686A");
446 return 0;
447 }
448 return ENXIO;
449}
450
451
452static void
453dma_cb(void *p, bus_dma_segment_t *bds, int a, int b)
454{
455 struct via_info *via = (struct via_info *)p;
456 via->sgd_addr = bds->ds_addr;
457}
458
459
460static int
461via_attach(device_t dev)
462{
463 struct via_info *via = 0;
464 char status[SND_STATUSLEN];
465 u_int32_t data, cnt;
466
467 if ((via = malloc(sizeof *via, M_DEVBUF, M_NOWAIT | M_ZERO)) == NULL) {
468 device_printf(dev, "cannot allocate softc\n");
469 return ENXIO;
470 }
471
472 /* Get resources */
473 data = pci_read_config(dev, PCIR_COMMAND, 2);
474 data |= (PCIM_CMD_PORTEN | PCIM_CMD_BUSMASTEREN);
475 pci_write_config(dev, PCIR_COMMAND, data, 2);
476 data = pci_read_config(dev, PCIR_COMMAND, 2);
477
478 /* Wake up and reset AC97 if necessary */
479 data = pci_read_config(dev, VIA_AC97STATUS, 1);
480
481 if ((data & VIA_AC97STATUS_RDY) == 0) {
482 /* Cold reset per ac97r2.3 spec (page 95) */
483 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_EN, 1); /* Assert low */
484 DELAY(100); /* Wait T_rst_low */
485 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_EN | VIA_ACLINK_NRST, 1); /* Assert high */
486 DELAY(5); /* Wait T_rst2clk */
487 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_EN, 1); /* Assert low */
488 } else {
489 /* Warm reset */
490 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_EN, 1); /* Force no sync */
491 DELAY(100);
492 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_EN | VIA_ACLINK_SYNC, 1); /* Sync */
493 DELAY(5); /* Wait T_sync_high */
494 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_EN, 1); /* Force no sync */
495 DELAY(5); /* Wait T_sync2clk */
496 }
497
498 /* Power everything up */
499 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_DESIRED, 1);
500
501 /* Wait for codec to become ready (largest reported delay here 310ms) */
502 for (cnt = 0; cnt < 2000; cnt++) {
503 data = pci_read_config(dev, VIA_AC97STATUS, 1);
504 if (data & VIA_AC97STATUS_RDY)
505 break;
506 DELAY(5000);
507 }
508
509 via->regid = PCIR_BAR(0);
510 via->reg = bus_alloc_resource(dev, SYS_RES_IOPORT, &via->regid, 0, ~0, 1, RF_ACTIVE);
511 if (!via->reg) {
512 device_printf(dev, "cannot allocate bus resource.");
513 goto bad;
514 }
515 via->st = rman_get_bustag(via->reg);
516 via->sh = rman_get_bushandle(via->reg);
517
518 via->bufsz = pcm_getbuffersize(dev, 4096, VIA_DEFAULT_BUFSZ, 65536);
519
520 via->irqid = 0;
521 via->irq = bus_alloc_resource(dev, SYS_RES_IRQ, &via->irqid, 0, ~0, 1, RF_ACTIVE | RF_SHAREABLE);
522 if (!via->irq || snd_setup_intr(dev, via->irq, 0, via_intr, via, &via->ih)) {
523 device_printf(dev, "unable to map interrupt\n");
524 goto bad;
525 }
526
527 via_wr(via, VIA_PLAY_MODE, VIA_RPMODE_AUTOSTART | VIA_RPMODE_INTR_FLAG | VIA_RPMODE_INTR_EOL, 1);
528 via_wr(via, VIA_RECORD_MODE, VIA_RPMODE_AUTOSTART | VIA_RPMODE_INTR_FLAG | VIA_RPMODE_INTR_EOL, 1);
529
530 via->codec = AC97_CREATE(dev, via, via_ac97);
531 if (!via->codec)
532 goto bad;
533
534 if (mixer_init(dev, ac97_getmixerclass(), via->codec))
535 goto bad;
536
537 via->codec_caps = ac97_getextcaps(via->codec);
538 ac97_setextmode(via->codec,
539 via->codec_caps & (AC97_EXTCAP_VRA | AC97_EXTCAP_VRM));
540
541 /* DMA tag for buffers */
542 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0,
543 /*lowaddr*/BUS_SPACE_MAXADDR_32BIT,
544 /*highaddr*/BUS_SPACE_MAXADDR,
545 /*filter*/NULL, /*filterarg*/NULL,
546 /*maxsize*/via->bufsz, /*nsegments*/1, /*maxsegz*/0x3ffff,
547 /*flags*/0, /*lockfunc*/busdma_lock_mutex,
548 /*lockarg*/&Giant, &via->parent_dmat) != 0) {
549 device_printf(dev, "unable to create dma tag\n");
550 goto bad;
551 }
552
553 /*
554 * DMA tag for SGD table. The 686 uses scatter/gather DMA and
555 * requires a list in memory of work to do. We need only 16 bytes
556 * for this list, and it is wasteful to allocate 16K.
557 */
558 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0,
559 /*lowaddr*/BUS_SPACE_MAXADDR_32BIT,
560 /*highaddr*/BUS_SPACE_MAXADDR,
561 /*filter*/NULL, /*filterarg*/NULL,
562 /*maxsize*/NSEGS * sizeof(struct via_dma_op),
563 /*nsegments*/1, /*maxsegz*/0x3ffff,
564 /*flags*/0, /*lockfunc*/busdma_lock_mutex,
565 /*lockarg*/&Giant, &via->sgd_dmat) != 0) {
566 device_printf(dev, "unable to create dma tag\n");
567 goto bad;
568 }
569
570 if (bus_dmamem_alloc(via->sgd_dmat, (void **)&via->sgd_table, BUS_DMA_NOWAIT, &via->sgd_dmamap) == -1)
571 goto bad;
572 if (bus_dmamap_load(via->sgd_dmat, via->sgd_dmamap, via->sgd_table, NSEGS * sizeof(struct via_dma_op), dma_cb, via, 0))
573 goto bad;
574
| 37
38#define VIA_PCI_ID 0x30581106
39#define NSEGS 4 /* Number of segments in SGD table */
40
41#define SEGS_PER_CHAN (NSEGS/2)
42
43#define TIMEOUT 50
44#define VIA_DEFAULT_BUFSZ 0x1000
45
46#undef DEB
47#define DEB(x)
48
49/* we rely on this struct being packed to 64 bits */
50struct via_dma_op {
51 u_int32_t ptr;
52 u_int32_t flags;
53#define VIA_DMAOP_EOL 0x80000000
54#define VIA_DMAOP_FLAG 0x40000000
55#define VIA_DMAOP_STOP 0x20000000
56#define VIA_DMAOP_COUNT(x) ((x)&0x00FFFFFF)
57};
58
59struct via_info;
60
61struct via_chinfo {
62 struct via_info *parent;
63 struct pcm_channel *channel;
64 struct snd_dbuf *buffer;
65 struct via_dma_op *sgd_table;
66 bus_addr_t sgd_addr;
67 int dir, blksz;
68 int base, count, mode, ctrl;
69};
70
71struct via_info {
72 bus_space_tag_t st;
73 bus_space_handle_t sh;
74 bus_dma_tag_t parent_dmat;
75 bus_dma_tag_t sgd_dmat;
76 bus_dmamap_t sgd_dmamap;
77 bus_addr_t sgd_addr;
78
79 struct resource *reg, *irq;
80 int regid, irqid;
81 void *ih;
82 struct ac97_info *codec;
83
84 unsigned int bufsz;
85
86 struct via_chinfo pch, rch;
87 struct via_dma_op *sgd_table;
88 u_int16_t codec_caps;
89};
90
91static u_int32_t via_fmt[] = {
92 AFMT_U8,
93 AFMT_STEREO | AFMT_U8,
94 AFMT_S16_LE,
95 AFMT_STEREO | AFMT_S16_LE,
96 0
97};
98static struct pcmchan_caps via_vracaps = {4000, 48000, via_fmt, 0};
99static struct pcmchan_caps via_caps = {48000, 48000, via_fmt, 0};
100
101static u_int32_t
102via_rd(struct via_info *via, int regno, int size)
103{
104
105 switch (size) {
106 case 1:
107 return bus_space_read_1(via->st, via->sh, regno);
108 case 2:
109 return bus_space_read_2(via->st, via->sh, regno);
110 case 4:
111 return bus_space_read_4(via->st, via->sh, regno);
112 default:
113 return 0xFFFFFFFF;
114 }
115}
116
117
118static void
119via_wr(struct via_info *via, int regno, u_int32_t data, int size)
120{
121
122 switch (size) {
123 case 1:
124 bus_space_write_1(via->st, via->sh, regno, data);
125 break;
126 case 2:
127 bus_space_write_2(via->st, via->sh, regno, data);
128 break;
129 case 4:
130 bus_space_write_4(via->st, via->sh, regno, data);
131 break;
132 }
133}
134
135/* -------------------------------------------------------------------- */
136/* Codec interface */
137
138static int
139via_waitready_codec(struct via_info *via)
140{
141 int i;
142
143 /* poll until codec not busy */
144 for (i = 0; (i < TIMEOUT) &&
145 (via_rd(via, VIA_CODEC_CTL, 4) & VIA_CODEC_BUSY); i++)
146 DELAY(1);
147 if (i >= TIMEOUT) {
148 printf("via: codec busy\n");
149 return 1;
150 }
151
152 return 0;
153}
154
155
156static int
157via_waitvalid_codec(struct via_info *via)
158{
159 int i;
160
161 /* poll until codec valid */
162 for (i = 0; (i < TIMEOUT) &&
163 !(via_rd(via, VIA_CODEC_CTL, 4) & VIA_CODEC_PRIVALID); i++)
164 DELAY(1);
165 if (i >= TIMEOUT) {
166 printf("via: codec invalid\n");
167 return 1;
168 }
169
170 return 0;
171}
172
173
174static int
175via_write_codec(kobj_t obj, void *addr, int reg, u_int32_t val)
176{
177 struct via_info *via = addr;
178
179 if (via_waitready_codec(via)) return -1;
180
181 via_wr(via, VIA_CODEC_CTL, VIA_CODEC_PRIVALID | VIA_CODEC_INDEX(reg) | val, 4);
182
183 return 0;
184}
185
186
187static int
188via_read_codec(kobj_t obj, void *addr, int reg)
189{
190 struct via_info *via = addr;
191
192 if (via_waitready_codec(via))
193 return -1;
194
195 via_wr(via, VIA_CODEC_CTL, VIA_CODEC_PRIVALID | VIA_CODEC_READ | VIA_CODEC_INDEX(reg),4);
196
197 if (via_waitready_codec(via))
198 return -1;
199
200 if (via_waitvalid_codec(via))
201 return -1;
202
203 return via_rd(via, VIA_CODEC_CTL, 2);
204}
205
206static kobj_method_t via_ac97_methods[] = {
207 KOBJMETHOD(ac97_read, via_read_codec),
208 KOBJMETHOD(ac97_write, via_write_codec),
209 { 0, 0 }
210};
211AC97_DECLARE(via_ac97);
212
213/* -------------------------------------------------------------------- */
214
215static int
216via_buildsgdt(struct via_chinfo *ch)
217{
218 u_int32_t phys_addr, flag;
219 int i, segs, seg_size;
220
221 /*
222 * Build the scatter/gather DMA (SGD) table.
223 * There are four slots in the table: two for play, two for record.
224 * This creates two half-buffers, one of which is playing; the other
225 * is feeding.
226 */
227 seg_size = ch->blksz;
228 segs = sndbuf_getsize(ch->buffer) / seg_size;
229 phys_addr = sndbuf_getbufaddr(ch->buffer);
230
231 for (i = 0; i < segs; i++) {
232 flag = (i == segs - 1)? VIA_DMAOP_EOL : VIA_DMAOP_FLAG;
233 ch->sgd_table[i].ptr = phys_addr + (i * seg_size);
234 ch->sgd_table[i].flags = flag | seg_size;
235 }
236
237 return 0;
238}
239
240/* channel interface */
241static void *
242viachan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
243{
244 struct via_info *via = devinfo;
245 struct via_chinfo *ch;
246
247 if (dir == PCMDIR_PLAY) {
248 ch = &via->pch;
249 ch->base = VIA_PLAY_DMAOPS_BASE;
250 ch->count = VIA_PLAY_DMAOPS_COUNT;
251 ch->ctrl = VIA_PLAY_CONTROL;
252 ch->mode = VIA_PLAY_MODE;
253 ch->sgd_addr = via->sgd_addr;
254 ch->sgd_table = &via->sgd_table[0];
255 } else {
256 ch = &via->rch;
257 ch->base = VIA_RECORD_DMAOPS_BASE;
258 ch->count = VIA_RECORD_DMAOPS_COUNT;
259 ch->ctrl = VIA_RECORD_CONTROL;
260 ch->mode = VIA_RECORD_MODE;
261 ch->sgd_addr = via->sgd_addr + sizeof(struct via_dma_op) * SEGS_PER_CHAN;
262 ch->sgd_table = &via->sgd_table[SEGS_PER_CHAN];
263 }
264
265 ch->parent = via;
266 ch->channel = c;
267 ch->buffer = b;
268 ch->dir = dir;
269
270 if (sndbuf_alloc(ch->buffer, via->parent_dmat, via->bufsz) == -1)
271 return NULL;
272 return ch;
273}
274
275static int
276viachan_setformat(kobj_t obj, void *data, u_int32_t format)
277{
278 struct via_chinfo *ch = data;
279 struct via_info *via = ch->parent;
280 int mode, mode_set;
281
282 mode_set = 0;
283 if (format & AFMT_STEREO)
284 mode_set |= VIA_RPMODE_STEREO;
285 if (format & AFMT_S16_LE)
286 mode_set |= VIA_RPMODE_16BIT;
287
288 DEB(printf("set format: dir = %d, format=%x\n", ch->dir, format));
289 mode = via_rd(via, ch->mode, 1);
290 mode &= ~(VIA_RPMODE_16BIT | VIA_RPMODE_STEREO);
291 mode |= mode_set;
292 via_wr(via, ch->mode, mode, 1);
293
294 return 0;
295}
296
297static int
298viachan_setspeed(kobj_t obj, void *data, u_int32_t speed)
299{
300 struct via_chinfo *ch = data;
301 struct via_info *via = ch->parent;
302 int reg;
303
304 /*
305 * Basic AC'97 defines a 48 kHz sample rate only. For other rates,
306 * upsampling is required.
307 *
308 * The VT82C686A does not perform upsampling, and neither do we.
309 * If the codec supports variable-rate audio (i.e. does the upsampling
310 * itself), then negotiate the rate with the codec. Otherwise,
311 * return 48 kHz cuz that's all you got.
312 */
313 if (via->codec_caps & AC97_EXTCAP_VRA) {
314 reg = (ch->dir == PCMDIR_PLAY)? AC97_REGEXT_FDACRATE : AC97_REGEXT_LADCRATE;
315 return ac97_setrate(via->codec, reg, speed);
316 } else
317 return 48000;
318}
319
320static int
321viachan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
322{
323 struct via_chinfo *ch = data;
324
325 ch->blksz = blocksize;
326 sndbuf_resize(ch->buffer, SEGS_PER_CHAN, ch->blksz);
327
328 return ch->blksz;
329}
330
331static int
332viachan_trigger(kobj_t obj, void *data, int go)
333{
334 struct via_chinfo *ch = data;
335 struct via_info *via = ch->parent;
336 struct via_dma_op *ado;
337 bus_addr_t sgd_addr = ch->sgd_addr;
338
339 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
340 return 0;
341
342 ado = ch->sgd_table;
343 DEB(printf("ado located at va=%p pa=%x\n", ado, sgd_addr));
344
345 if (go == PCMTRIG_START) {
346 via_buildsgdt(ch);
347 via_wr(via, ch->base, sgd_addr, 4);
348 via_wr(via, ch->ctrl, VIA_RPCTRL_START, 1);
349 } else
350 via_wr(via, ch->ctrl, VIA_RPCTRL_TERMINATE, 1);
351
352 DEB(printf("viachan_trigger: go=%d\n", go));
353 return 0;
354}
355
356static int
357viachan_getptr(kobj_t obj, void *data)
358{
359 struct via_chinfo *ch = data;
360 struct via_info *via = ch->parent;
361 struct via_dma_op *ado;
362 bus_addr_t sgd_addr = ch->sgd_addr;
363 int ptr, base, base1, len, seg;
364
365 ado = ch->sgd_table;
366 base1 = via_rd(via, ch->base, 4);
367 len = via_rd(via, ch->count, 4);
368 base = via_rd(via, ch->base, 4);
369 if (base != base1) /* Avoid race hazard */
370 len = via_rd(via, ch->count, 4);
371
372 DEB(printf("viachan_getptr: len / base = %x / %x\n", len, base));
373
374 /* Base points to SGD segment to do, one past current */
375
376 /* Determine how many segments have been done */
377 seg = (base - sgd_addr) / sizeof(struct via_dma_op);
378 if (seg == 0)
379 seg = SEGS_PER_CHAN;
380
381 /* Now work out offset: seg less count */
382 ptr = (seg * sndbuf_getsize(ch->buffer) / SEGS_PER_CHAN) - len;
383 if (ch->dir == PCMDIR_REC) {
384 /* DMA appears to operate on memory 'lines' of 32 bytes */
385 /* so don't return any part line - it isn't in RAM yet */
386 ptr = ptr & ~0x1f;
387 }
388
389 DEB(printf("return ptr=%d\n", ptr));
390 return ptr;
391}
392
393static struct pcmchan_caps *
394viachan_getcaps(kobj_t obj, void *data)
395{
396 struct via_chinfo *ch = data;
397 struct via_info *via = ch->parent;
398
399 return (via->codec_caps & AC97_EXTCAP_VRA)? &via_vracaps : &via_caps;
400}
401
402static kobj_method_t viachan_methods[] = {
403 KOBJMETHOD(channel_init, viachan_init),
404 KOBJMETHOD(channel_setformat, viachan_setformat),
405 KOBJMETHOD(channel_setspeed, viachan_setspeed),
406 KOBJMETHOD(channel_setblocksize, viachan_setblocksize),
407 KOBJMETHOD(channel_trigger, viachan_trigger),
408 KOBJMETHOD(channel_getptr, viachan_getptr),
409 KOBJMETHOD(channel_getcaps, viachan_getcaps),
410 { 0, 0 }
411};
412CHANNEL_DECLARE(viachan);
413
414/* -------------------------------------------------------------------- */
415
416static void
417via_intr(void *p)
418{
419 struct via_info *via = p;
420 int st;
421
422 /* DEB(printf("viachan_intr\n")); */
423 /* Read channel */
424 st = via_rd(via, VIA_PLAY_STAT, 1);
425 if (st & VIA_RPSTAT_INTR) {
426 via_wr(via, VIA_PLAY_STAT, VIA_RPSTAT_INTR, 1);
427 chn_intr(via->pch.channel);
428 }
429
430 /* Write channel */
431 st = via_rd(via, VIA_RECORD_STAT, 1);
432 if (st & VIA_RPSTAT_INTR) {
433 via_wr(via, VIA_RECORD_STAT, VIA_RPSTAT_INTR, 1);
434 chn_intr(via->rch.channel);
435 }
436}
437
438/*
439 * Probe and attach the card
440 */
441static int
442via_probe(device_t dev)
443{
444 if (pci_get_devid(dev) == VIA_PCI_ID) {
445 device_set_desc(dev, "VIA VT82C686A");
446 return 0;
447 }
448 return ENXIO;
449}
450
451
452static void
453dma_cb(void *p, bus_dma_segment_t *bds, int a, int b)
454{
455 struct via_info *via = (struct via_info *)p;
456 via->sgd_addr = bds->ds_addr;
457}
458
459
460static int
461via_attach(device_t dev)
462{
463 struct via_info *via = 0;
464 char status[SND_STATUSLEN];
465 u_int32_t data, cnt;
466
467 if ((via = malloc(sizeof *via, M_DEVBUF, M_NOWAIT | M_ZERO)) == NULL) {
468 device_printf(dev, "cannot allocate softc\n");
469 return ENXIO;
470 }
471
472 /* Get resources */
473 data = pci_read_config(dev, PCIR_COMMAND, 2);
474 data |= (PCIM_CMD_PORTEN | PCIM_CMD_BUSMASTEREN);
475 pci_write_config(dev, PCIR_COMMAND, data, 2);
476 data = pci_read_config(dev, PCIR_COMMAND, 2);
477
478 /* Wake up and reset AC97 if necessary */
479 data = pci_read_config(dev, VIA_AC97STATUS, 1);
480
481 if ((data & VIA_AC97STATUS_RDY) == 0) {
482 /* Cold reset per ac97r2.3 spec (page 95) */
483 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_EN, 1); /* Assert low */
484 DELAY(100); /* Wait T_rst_low */
485 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_EN | VIA_ACLINK_NRST, 1); /* Assert high */
486 DELAY(5); /* Wait T_rst2clk */
487 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_EN, 1); /* Assert low */
488 } else {
489 /* Warm reset */
490 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_EN, 1); /* Force no sync */
491 DELAY(100);
492 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_EN | VIA_ACLINK_SYNC, 1); /* Sync */
493 DELAY(5); /* Wait T_sync_high */
494 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_EN, 1); /* Force no sync */
495 DELAY(5); /* Wait T_sync2clk */
496 }
497
498 /* Power everything up */
499 pci_write_config(dev, VIA_ACLINKCTRL, VIA_ACLINK_DESIRED, 1);
500
501 /* Wait for codec to become ready (largest reported delay here 310ms) */
502 for (cnt = 0; cnt < 2000; cnt++) {
503 data = pci_read_config(dev, VIA_AC97STATUS, 1);
504 if (data & VIA_AC97STATUS_RDY)
505 break;
506 DELAY(5000);
507 }
508
509 via->regid = PCIR_BAR(0);
510 via->reg = bus_alloc_resource(dev, SYS_RES_IOPORT, &via->regid, 0, ~0, 1, RF_ACTIVE);
511 if (!via->reg) {
512 device_printf(dev, "cannot allocate bus resource.");
513 goto bad;
514 }
515 via->st = rman_get_bustag(via->reg);
516 via->sh = rman_get_bushandle(via->reg);
517
518 via->bufsz = pcm_getbuffersize(dev, 4096, VIA_DEFAULT_BUFSZ, 65536);
519
520 via->irqid = 0;
521 via->irq = bus_alloc_resource(dev, SYS_RES_IRQ, &via->irqid, 0, ~0, 1, RF_ACTIVE | RF_SHAREABLE);
522 if (!via->irq || snd_setup_intr(dev, via->irq, 0, via_intr, via, &via->ih)) {
523 device_printf(dev, "unable to map interrupt\n");
524 goto bad;
525 }
526
527 via_wr(via, VIA_PLAY_MODE, VIA_RPMODE_AUTOSTART | VIA_RPMODE_INTR_FLAG | VIA_RPMODE_INTR_EOL, 1);
528 via_wr(via, VIA_RECORD_MODE, VIA_RPMODE_AUTOSTART | VIA_RPMODE_INTR_FLAG | VIA_RPMODE_INTR_EOL, 1);
529
530 via->codec = AC97_CREATE(dev, via, via_ac97);
531 if (!via->codec)
532 goto bad;
533
534 if (mixer_init(dev, ac97_getmixerclass(), via->codec))
535 goto bad;
536
537 via->codec_caps = ac97_getextcaps(via->codec);
538 ac97_setextmode(via->codec,
539 via->codec_caps & (AC97_EXTCAP_VRA | AC97_EXTCAP_VRM));
540
541 /* DMA tag for buffers */
542 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0,
543 /*lowaddr*/BUS_SPACE_MAXADDR_32BIT,
544 /*highaddr*/BUS_SPACE_MAXADDR,
545 /*filter*/NULL, /*filterarg*/NULL,
546 /*maxsize*/via->bufsz, /*nsegments*/1, /*maxsegz*/0x3ffff,
547 /*flags*/0, /*lockfunc*/busdma_lock_mutex,
548 /*lockarg*/&Giant, &via->parent_dmat) != 0) {
549 device_printf(dev, "unable to create dma tag\n");
550 goto bad;
551 }
552
553 /*
554 * DMA tag for SGD table. The 686 uses scatter/gather DMA and
555 * requires a list in memory of work to do. We need only 16 bytes
556 * for this list, and it is wasteful to allocate 16K.
557 */
558 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0,
559 /*lowaddr*/BUS_SPACE_MAXADDR_32BIT,
560 /*highaddr*/BUS_SPACE_MAXADDR,
561 /*filter*/NULL, /*filterarg*/NULL,
562 /*maxsize*/NSEGS * sizeof(struct via_dma_op),
563 /*nsegments*/1, /*maxsegz*/0x3ffff,
564 /*flags*/0, /*lockfunc*/busdma_lock_mutex,
565 /*lockarg*/&Giant, &via->sgd_dmat) != 0) {
566 device_printf(dev, "unable to create dma tag\n");
567 goto bad;
568 }
569
570 if (bus_dmamem_alloc(via->sgd_dmat, (void **)&via->sgd_table, BUS_DMA_NOWAIT, &via->sgd_dmamap) == -1)
571 goto bad;
572 if (bus_dmamap_load(via->sgd_dmat, via->sgd_dmamap, via->sgd_table, NSEGS * sizeof(struct via_dma_op), dma_cb, via, 0))
573 goto bad;
574
|
576
577 /* Register */
578 if (pcm_register(dev, via, 1, 1)) goto bad;
579 pcm_addchan(dev, PCMDIR_PLAY, &viachan_class, via);
580 pcm_addchan(dev, PCMDIR_REC, &viachan_class, via);
581 pcm_setstatus(dev, status);
582 return 0;
583bad:
584 if (via->codec) ac97_destroy(via->codec);
585 if (via->reg) bus_release_resource(dev, SYS_RES_IOPORT, via->regid, via->reg);
586 if (via->ih) bus_teardown_intr(dev, via->irq, via->ih);
587 if (via->irq) bus_release_resource(dev, SYS_RES_IRQ, via->irqid, via->irq);
588 if (via->parent_dmat) bus_dma_tag_destroy(via->parent_dmat);
589 if (via->sgd_dmamap) bus_dmamap_unload(via->sgd_dmat, via->sgd_dmamap);
590 if (via->sgd_dmat) bus_dma_tag_destroy(via->sgd_dmat);
591 if (via) free(via, M_DEVBUF);
592 return ENXIO;
593}
594
595static int
596via_detach(device_t dev)
597{
598 int r;
599 struct via_info *via = 0;
600
601 r = pcm_unregister(dev);
602 if (r)
603 return r;
604
605 via = pcm_getdevinfo(dev);
606 bus_release_resource(dev, SYS_RES_IOPORT, via->regid, via->reg);
607 bus_teardown_intr(dev, via->irq, via->ih);
608 bus_release_resource(dev, SYS_RES_IRQ, via->irqid, via->irq);
609 bus_dma_tag_destroy(via->parent_dmat);
610 bus_dmamap_unload(via->sgd_dmat, via->sgd_dmamap);
611 bus_dma_tag_destroy(via->sgd_dmat);
612 free(via, M_DEVBUF);
613 return 0;
614}
615
616
617static device_method_t via_methods[] = {
618 DEVMETHOD(device_probe, via_probe),
619 DEVMETHOD(device_attach, via_attach),
620 DEVMETHOD(device_detach, via_detach),
621 { 0, 0}
622};
623
624static driver_t via_driver = {
625 "pcm",
626 via_methods,
627 PCM_SOFTC_SIZE,
628};
629
630DRIVER_MODULE(snd_via82c686, pci, via_driver, pcm_devclass, 0, 0);
631MODULE_DEPEND(snd_via82c686, snd_pcm, PCM_MINVER, PCM_PREFVER, PCM_MAXVER);
632MODULE_VERSION(snd_via82c686, 1);
| 578
579 /* Register */
580 if (pcm_register(dev, via, 1, 1)) goto bad;
581 pcm_addchan(dev, PCMDIR_PLAY, &viachan_class, via);
582 pcm_addchan(dev, PCMDIR_REC, &viachan_class, via);
583 pcm_setstatus(dev, status);
584 return 0;
585bad:
586 if (via->codec) ac97_destroy(via->codec);
587 if (via->reg) bus_release_resource(dev, SYS_RES_IOPORT, via->regid, via->reg);
588 if (via->ih) bus_teardown_intr(dev, via->irq, via->ih);
589 if (via->irq) bus_release_resource(dev, SYS_RES_IRQ, via->irqid, via->irq);
590 if (via->parent_dmat) bus_dma_tag_destroy(via->parent_dmat);
591 if (via->sgd_dmamap) bus_dmamap_unload(via->sgd_dmat, via->sgd_dmamap);
592 if (via->sgd_dmat) bus_dma_tag_destroy(via->sgd_dmat);
593 if (via) free(via, M_DEVBUF);
594 return ENXIO;
595}
596
597static int
598via_detach(device_t dev)
599{
600 int r;
601 struct via_info *via = 0;
602
603 r = pcm_unregister(dev);
604 if (r)
605 return r;
606
607 via = pcm_getdevinfo(dev);
608 bus_release_resource(dev, SYS_RES_IOPORT, via->regid, via->reg);
609 bus_teardown_intr(dev, via->irq, via->ih);
610 bus_release_resource(dev, SYS_RES_IRQ, via->irqid, via->irq);
611 bus_dma_tag_destroy(via->parent_dmat);
612 bus_dmamap_unload(via->sgd_dmat, via->sgd_dmamap);
613 bus_dma_tag_destroy(via->sgd_dmat);
614 free(via, M_DEVBUF);
615 return 0;
616}
617
618
619static device_method_t via_methods[] = {
620 DEVMETHOD(device_probe, via_probe),
621 DEVMETHOD(device_attach, via_attach),
622 DEVMETHOD(device_detach, via_detach),
623 { 0, 0}
624};
625
626static driver_t via_driver = {
627 "pcm",
628 via_methods,
629 PCM_SOFTC_SIZE,
630};
631
632DRIVER_MODULE(snd_via82c686, pci, via_driver, pcm_devclass, 0, 0);
633MODULE_DEPEND(snd_via82c686, snd_pcm, PCM_MINVER, PCM_PREFVER, PCM_MAXVER);
634MODULE_VERSION(snd_via82c686, 1);
|