33
34#define PCI_VENDOR_FORTEMEDIA 0x1319
35#define PCI_DEVICE_FORTEMEDIA1 0x08011319
36#define PCI_DEVICE_FORTEMEDIA2 0x08021319 /* ??? have no idea what's this... */
37
38#define FM_PCM_VOLUME 0x00
39#define FM_FM_VOLUME 0x02
40#define FM_I2S_VOLUME 0x04
41#define FM_RECORD_SOURCE 0x06
42
43#define FM_PLAY_CTL 0x08
44#define FM_PLAY_RATE_MASK 0x0f00
45#define FM_PLAY_BUF1_LAST 0x0001
46#define FM_PLAY_BUF2_LAST 0x0002
47#define FM_PLAY_START 0x0020
48#define FM_PLAY_PAUSE 0x0040
49#define FM_PLAY_STOPNOW 0x0080
50#define FM_PLAY_16BIT 0x4000
51#define FM_PLAY_STEREO 0x8000
52
53#define FM_PLAY_DMALEN 0x0a
54#define FM_PLAY_DMABUF1 0x0c
55#define FM_PLAY_DMABUF2 0x10
56
57
58#define FM_REC_CTL 0x14
59#define FM_REC_RATE_MASK 0x0f00
60#define FM_REC_BUF1_LAST 0x0001
61#define FM_REC_BUF2_LAST 0x0002
62#define FM_REC_START 0x0020
63#define FM_REC_PAUSE 0x0040
64#define FM_REC_STOPNOW 0x0080
65#define FM_REC_16BIT 0x4000
66#define FM_REC_STEREO 0x8000
67
68
69#define FM_REC_DMALEN 0x16
70#define FM_REC_DMABUF1 0x18
71#define FM_REC_DMABUF2 0x1c
72
73#define FM_CODEC_CTL 0x22
74#define FM_VOLUME 0x26
75#define FM_VOLUME_MUTE 0x8000
76
77#define FM_CODEC_CMD 0x2a
78#define FM_CODEC_CMD_READ 0x0080
79#define FM_CODEC_CMD_VALID 0x0100
80#define FM_CODEC_CMD_BUSY 0x0200
81
82#define FM_CODEC_DATA 0x2c
83
84#define FM_IO_CTL 0x52
85#define FM_CARD_CTL 0x54
86
87#define FM_INTMASK 0x56
88#define FM_INTMASK_PLAY 0x0001
89#define FM_INTMASK_REC 0x0002
90#define FM_INTMASK_VOL 0x0040
91#define FM_INTMASK_MPU 0x0080
92
93#define FM_INTSTATUS 0x5a
94#define FM_INTSTATUS_PLAY 0x0100
95#define FM_INTSTATUS_REC 0x0200
96#define FM_INTSTATUS_VOL 0x4000
97#define FM_INTSTATUS_MPU 0x8000
98
99#define FM801_DEFAULT_BUFSZ 4096 /* Other values do not work!!! */
100
101/* debug purposes */
102#define DPRINT if(0) printf
103
104/*
105static int fm801ch_setup(struct pcm_channel *c);
106*/
107
108static u_int32_t fmts[] = {
109 AFMT_U8,
110 AFMT_STEREO | AFMT_U8,
111 AFMT_S16_LE,
112 AFMT_STEREO | AFMT_S16_LE,
113 0
114};
115
116static struct pcmchan_caps fm801ch_caps = {
117 4000, 48000,
118 fmts, 0
119};
120
121struct fm801_info;
122
123struct fm801_chinfo {
124 struct fm801_info *parent;
125 struct pcm_channel *channel;
126 struct snd_dbuf *buffer;
127 u_int32_t spd, dir, fmt; /* speed, direction, format */
128 u_int32_t shift;
129};
130
131struct fm801_info {
132 int type;
133 bus_space_tag_t st;
134 bus_space_handle_t sh;
135 bus_dma_tag_t parent_dmat;
136
137 device_t dev;
138 int num;
139 u_int32_t unit;
140
141 struct resource *reg, *irq;
142 int regtype, regid, irqid;
143 void *ih;
144
145 u_int32_t play_flip,
146 play_nextblk,
147 play_start,
148 play_blksize,
149 play_fmt,
150 play_shift,
151 play_size;
152
153 u_int32_t rec_flip,
154 rec_nextblk,
155 rec_start,
156 rec_blksize,
157 rec_fmt,
158 rec_shift,
159 rec_size;
160
161 unsigned int bufsz;
162
163 struct fm801_chinfo pch, rch;
164
165 device_t radio;
166};
167
168/* Bus Read / Write routines */
169static u_int32_t
170fm801_rd(struct fm801_info *fm801, int regno, int size)
171{
172 switch(size) {
173 case 1:
174 return (bus_space_read_1(fm801->st, fm801->sh, regno));
175 case 2:
176 return (bus_space_read_2(fm801->st, fm801->sh, regno));
177 case 4:
178 return (bus_space_read_4(fm801->st, fm801->sh, regno));
179 default:
180 return 0xffffffff;
181 }
182}
183
184static void
185fm801_wr(struct fm801_info *fm801, int regno, u_int32_t data, int size)
186{
187
188 switch(size) {
189 case 1:
190 bus_space_write_1(fm801->st, fm801->sh, regno, data);
191 break;
192 case 2:
193 bus_space_write_2(fm801->st, fm801->sh, regno, data);
194 break;
195 case 4:
196 bus_space_write_4(fm801->st, fm801->sh, regno, data);
197 break;
198 }
199}
200
201/* -------------------------------------------------------------------- */
202/*
203 * ac97 codec routines
204 */
205#define TIMO 50
206static int
207fm801_rdcd(kobj_t obj, void *devinfo, int regno)
208{
209 struct fm801_info *fm801 = (struct fm801_info *)devinfo;
210 int i;
211
212 for (i = 0; i < TIMO && fm801_rd(fm801,FM_CODEC_CMD,2) & FM_CODEC_CMD_BUSY; i++) {
213 DELAY(10000);
214 DPRINT("fm801 rdcd: 1 - DELAY\n");
215 }
216 if (i >= TIMO) {
217 printf("fm801 rdcd: codec busy\n");
218 return 0;
219 }
220
221 fm801_wr(fm801,FM_CODEC_CMD, regno|FM_CODEC_CMD_READ,2);
222
223 for (i = 0; i < TIMO && !(fm801_rd(fm801,FM_CODEC_CMD,2) & FM_CODEC_CMD_VALID); i++)
224 {
225 DELAY(10000);
226 DPRINT("fm801 rdcd: 2 - DELAY\n");
227 }
228 if (i >= TIMO) {
229 printf("fm801 rdcd: write codec invalid\n");
230 return 0;
231 }
232
233 return fm801_rd(fm801,FM_CODEC_DATA,2);
234}
235
236static int
237fm801_wrcd(kobj_t obj, void *devinfo, int regno, u_int32_t data)
238{
239 struct fm801_info *fm801 = (struct fm801_info *)devinfo;
240 int i;
241
242 DPRINT("fm801_wrcd reg 0x%x val 0x%x\n",regno, data);
243/*
244 if(regno == AC97_REG_RECSEL) return;
245*/
246 /* Poll until codec is ready */
247 for (i = 0; i < TIMO && fm801_rd(fm801,FM_CODEC_CMD,2) & FM_CODEC_CMD_BUSY; i++) {
248 DELAY(10000);
249 DPRINT("fm801 rdcd: 1 - DELAY\n");
250 }
251 if (i >= TIMO) {
252 printf("fm801 wrcd: read codec busy\n");
253 return -1;
254 }
255
256 fm801_wr(fm801,FM_CODEC_DATA,data, 2);
257 fm801_wr(fm801,FM_CODEC_CMD, regno,2);
258
259 /* wait until codec is ready */
260 for (i = 0; i < TIMO && fm801_rd(fm801,FM_CODEC_CMD,2) & FM_CODEC_CMD_BUSY; i++) {
261 DELAY(10000);
262 DPRINT("fm801 wrcd: 2 - DELAY\n");
263 }
264 if (i >= TIMO) {
265 printf("fm801 wrcd: read codec busy\n");
266 return -1;
267 }
268 DPRINT("fm801 wrcd release reg 0x%x val 0x%x\n",regno, data);
269 return 0;
270}
271
272static kobj_method_t fm801_ac97_methods[] = {
273 KOBJMETHOD(ac97_read, fm801_rdcd),
274 KOBJMETHOD(ac97_write, fm801_wrcd),
275 { 0, 0 }
276};
277AC97_DECLARE(fm801_ac97);
278
279/* -------------------------------------------------------------------- */
280
281/*
282 * The interrupt handler
283 */
284static void
285fm801_intr(void *p)
286{
287 struct fm801_info *fm801 = (struct fm801_info *)p;
288 u_int32_t intsrc = fm801_rd(fm801, FM_INTSTATUS, 2);
289
290 DPRINT("\nfm801_intr intsrc 0x%x ", intsrc);
291
292 if(intsrc & FM_INTSTATUS_PLAY) {
293 fm801->play_flip++;
294 if(fm801->play_flip & 1) {
295 fm801_wr(fm801, FM_PLAY_DMABUF1, fm801->play_start,4);
296 } else
297 fm801_wr(fm801, FM_PLAY_DMABUF2, fm801->play_nextblk,4);
298 chn_intr(fm801->pch.channel);
299 }
300
301 if(intsrc & FM_INTSTATUS_REC) {
302 fm801->rec_flip++;
303 if(fm801->rec_flip & 1) {
304 fm801_wr(fm801, FM_REC_DMABUF1, fm801->rec_start,4);
305 } else
306 fm801_wr(fm801, FM_REC_DMABUF2, fm801->rec_nextblk,4);
307 chn_intr(fm801->rch.channel);
308 }
309
310 if ( intsrc & FM_INTSTATUS_MPU ) {
311 /* This is a TODOish thing... */
312 fm801_wr(fm801, FM_INTSTATUS, intsrc & FM_INTSTATUS_MPU,2);
313 }
314
315 if ( intsrc & FM_INTSTATUS_VOL ) {
316 /* This is a TODOish thing... */
317 fm801_wr(fm801, FM_INTSTATUS, intsrc & FM_INTSTATUS_VOL,2);
318 }
319
320 DPRINT("fm801_intr clear\n\n");
321 fm801_wr(fm801, FM_INTSTATUS, intsrc & (FM_INTSTATUS_PLAY | FM_INTSTATUS_REC), 2);
322}
323
324/* -------------------------------------------------------------------- */
325/* channel interface */
326static void *
327fm801ch_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
328{
329 struct fm801_info *fm801 = (struct fm801_info *)devinfo;
330 struct fm801_chinfo *ch = (dir == PCMDIR_PLAY)? &fm801->pch : &fm801->rch;
331
332 DPRINT("fm801ch_init, direction = %d\n", dir);
333 ch->parent = fm801;
334 ch->channel = c;
335 ch->buffer = b;
336 ch->dir = dir;
337 if (sndbuf_alloc(ch->buffer, fm801->parent_dmat, fm801->bufsz) == -1) return NULL;
338 return (void *)ch;
339}
340
341static int
342fm801ch_setformat(kobj_t obj, void *data, u_int32_t format)
343{
344 struct fm801_chinfo *ch = data;
345 struct fm801_info *fm801 = ch->parent;
346
347 DPRINT("fm801ch_setformat 0x%x : %s, %s, %s, %s\n", format,
348 (format & AFMT_STEREO)?"stereo":"mono",
349 (format & (AFMT_S16_LE | AFMT_S16_BE | AFMT_U16_LE | AFMT_U16_BE)) ? "16bit":"8bit",
350 (format & AFMT_SIGNED)? "signed":"unsigned",
351 (format & AFMT_BIGENDIAN)?"bigendiah":"littleendian" );
352
353 if(ch->dir == PCMDIR_PLAY) {
354 fm801->play_fmt = (format & AFMT_STEREO)? FM_PLAY_STEREO : 0;
355 fm801->play_fmt |= (format & AFMT_16BIT) ? FM_PLAY_16BIT : 0;
356 return 0;
357 }
358
359 if(ch->dir == PCMDIR_REC ) {
360 fm801->rec_fmt = (format & AFMT_STEREO)? FM_REC_STEREO:0;
361 fm801->rec_fmt |= (format & AFMT_16BIT) ? FM_PLAY_16BIT : 0;
362 return 0;
363 }
364
365 return 0;
366}
367
368struct {
369 int limit;
370 int rate;
371} fm801_rates[11] = {
372 { 6600, 5500 },
373 { 8750, 8000 },
374 { 10250, 9600 },
375 { 13200, 11025 },
376 { 17500, 16000 },
377 { 20500, 19200 },
378 { 26500, 22050 },
379 { 35000, 32000 },
380 { 41000, 38400 },
381 { 46000, 44100 },
382 { 48000, 48000 },
383/* anything above -> 48000 */
384};
385
386static int
387fm801ch_setspeed(kobj_t obj, void *data, u_int32_t speed)
388{
389 struct fm801_chinfo *ch = data;
390 struct fm801_info *fm801 = ch->parent;
391 register int i;
392
393
394 for (i = 0; i < 10 && fm801_rates[i].limit <= speed; i++) ;
395
396 if(ch->dir == PCMDIR_PLAY) {
397 fm801->pch.spd = fm801_rates[i].rate;
398 fm801->play_shift = (i<<8);
399 fm801->play_shift &= FM_PLAY_RATE_MASK;
400 }
401
402 if(ch->dir == PCMDIR_REC ) {
403 fm801->rch.spd = fm801_rates[i].rate;
404 fm801->rec_shift = (i<<8);
405 fm801->rec_shift &= FM_REC_RATE_MASK;
406 }
407
408 ch->spd = fm801_rates[i].rate;
409
410 return fm801_rates[i].rate;
411}
412
413static int
414fm801ch_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
415{
416 struct fm801_chinfo *ch = data;
417 struct fm801_info *fm801 = ch->parent;
418
419 if(ch->dir == PCMDIR_PLAY) {
420 if(fm801->play_flip) return fm801->play_blksize;
421 fm801->play_blksize = blocksize;
422 }
423
424 if(ch->dir == PCMDIR_REC) {
425 if(fm801->rec_flip) return fm801->rec_blksize;
426 fm801->rec_blksize = blocksize;
427 }
428
429 DPRINT("fm801ch_setblocksize %d (dir %d)\n",blocksize, ch->dir);
430
431 return blocksize;
432}
433
434static int
435fm801ch_trigger(kobj_t obj, void *data, int go)
436{
437 struct fm801_chinfo *ch = data;
438 struct fm801_info *fm801 = ch->parent;
439 u_int32_t baseaddr = sndbuf_getbufaddr(ch->buffer);
440 u_int32_t k1;
441
442 DPRINT("fm801ch_trigger go %d , ", go);
443
444 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD) {
445 return 0;
446 }
447
448 if (ch->dir == PCMDIR_PLAY) {
449 if (go == PCMTRIG_START) {
450
451 fm801->play_start = baseaddr;
452 fm801->play_nextblk = fm801->play_start + fm801->play_blksize;
453 fm801->play_flip = 0;
454 fm801_wr(fm801, FM_PLAY_DMALEN, fm801->play_blksize - 1, 2);
455 fm801_wr(fm801, FM_PLAY_DMABUF1,fm801->play_start,4);
456 fm801_wr(fm801, FM_PLAY_DMABUF2,fm801->play_nextblk,4);
457 fm801_wr(fm801, FM_PLAY_CTL,
458 FM_PLAY_START | FM_PLAY_STOPNOW | fm801->play_fmt | fm801->play_shift,
459 2 );
460 } else {
461 fm801->play_flip = 0;
462 k1 = fm801_rd(fm801, FM_PLAY_CTL,2);
463 fm801_wr(fm801, FM_PLAY_CTL,
464 (k1 & ~(FM_PLAY_STOPNOW | FM_PLAY_START)) |
465 FM_PLAY_BUF1_LAST | FM_PLAY_BUF2_LAST, 2 );
466 }
467 } else if(ch->dir == PCMDIR_REC) {
468 if (go == PCMTRIG_START) {
469 fm801->rec_start = baseaddr;
470 fm801->rec_nextblk = fm801->rec_start + fm801->rec_blksize;
471 fm801->rec_flip = 0;
472 fm801_wr(fm801, FM_REC_DMALEN, fm801->rec_blksize - 1, 2);
473 fm801_wr(fm801, FM_REC_DMABUF1,fm801->rec_start,4);
474 fm801_wr(fm801, FM_REC_DMABUF2,fm801->rec_nextblk,4);
475 fm801_wr(fm801, FM_REC_CTL,
476 FM_REC_START | FM_REC_STOPNOW | fm801->rec_fmt | fm801->rec_shift,
477 2 );
478 } else {
479 fm801->rec_flip = 0;
480 k1 = fm801_rd(fm801, FM_REC_CTL,2);
481 fm801_wr(fm801, FM_REC_CTL,
482 (k1 & ~(FM_REC_STOPNOW | FM_REC_START)) |
483 FM_REC_BUF1_LAST | FM_REC_BUF2_LAST, 2);
484 }
485 }
486
487 return 0;
488}
489
490/* Almost ALSA copy */
491static int
492fm801ch_getptr(kobj_t obj, void *data)
493{
494 struct fm801_chinfo *ch = data;
495 struct fm801_info *fm801 = ch->parent;
496 int result = 0;
497
498 if (ch->dir == PCMDIR_PLAY) {
499 result = fm801_rd(fm801,
500 (fm801->play_flip&1) ?
501 FM_PLAY_DMABUF2:FM_PLAY_DMABUF1, 4) - fm801->play_start;
502 }
503
504 if (ch->dir == PCMDIR_REC) {
505 result = fm801_rd(fm801,
506 (fm801->rec_flip&1) ?
507 FM_REC_DMABUF2:FM_REC_DMABUF1, 4) - fm801->rec_start;
508 }
509
510 return result;
511}
512
513static struct pcmchan_caps *
514fm801ch_getcaps(kobj_t obj, void *data)
515{
516 return &fm801ch_caps;
517}
518
519static kobj_method_t fm801ch_methods[] = {
520 KOBJMETHOD(channel_init, fm801ch_init),
521 KOBJMETHOD(channel_setformat, fm801ch_setformat),
522 KOBJMETHOD(channel_setspeed, fm801ch_setspeed),
523 KOBJMETHOD(channel_setblocksize, fm801ch_setblocksize),
524 KOBJMETHOD(channel_trigger, fm801ch_trigger),
525 KOBJMETHOD(channel_getptr, fm801ch_getptr),
526 KOBJMETHOD(channel_getcaps, fm801ch_getcaps),
527 { 0, 0 }
528};
529CHANNEL_DECLARE(fm801ch);
530
531/* -------------------------------------------------------------------- */
532
533/*
534 * Init routine is taken from an original NetBSD driver
535 */
536static int
537fm801_init(struct fm801_info *fm801)
538{
539 u_int32_t k1;
540
541 /* reset codec */
542 fm801_wr(fm801, FM_CODEC_CTL, 0x0020,2);
543 DELAY(100000);
544 fm801_wr(fm801, FM_CODEC_CTL, 0x0000,2);
545 DELAY(100000);
546
547 fm801_wr(fm801, FM_PCM_VOLUME, 0x0808,2);
548 fm801_wr(fm801, FM_FM_VOLUME, 0x0808,2);
549 fm801_wr(fm801, FM_I2S_VOLUME, 0x0808,2);
550 fm801_wr(fm801, 0x40,0x107f,2); /* enable legacy audio */
551
552 fm801_wr((void *)fm801, FM_RECORD_SOURCE, 0x0000,2);
553
554 /* Unmask playback, record and mpu interrupts, mask the rest */
555 k1 = fm801_rd((void *)fm801, FM_INTMASK,2);
556 fm801_wr(fm801, FM_INTMASK,
557 (k1 & ~(FM_INTMASK_PLAY | FM_INTMASK_REC | FM_INTMASK_MPU)) |
558 FM_INTMASK_VOL,2);
559 fm801_wr(fm801, FM_INTSTATUS,
560 FM_INTSTATUS_PLAY | FM_INTSTATUS_REC | FM_INTSTATUS_MPU |
561 FM_INTSTATUS_VOL,2);
562
563 DPRINT("FM801 init Ok\n");
564 return 0;
565}
566
567static int
568fm801_pci_attach(device_t dev)
569{
570 u_int32_t data;
571 struct ac97_info *codec = 0;
572 struct fm801_info *fm801;
573 int i;
574 int mapped = 0;
575 char status[SND_STATUSLEN];
576
577 if ((fm801 = (struct fm801_info *)malloc(sizeof(*fm801), M_DEVBUF, M_NOWAIT | M_ZERO)) == NULL) {
578 device_printf(dev, "cannot allocate softc\n");
579 return ENXIO;
580 }
581
582 fm801->type = pci_get_devid(dev);
583
584 data = pci_read_config(dev, PCIR_COMMAND, 2);
585 data |= (PCIM_CMD_PORTEN|PCIM_CMD_MEMEN|PCIM_CMD_BUSMASTEREN);
586 pci_write_config(dev, PCIR_COMMAND, data, 2);
587 data = pci_read_config(dev, PCIR_COMMAND, 2);
588
589 for (i = 0; (mapped == 0) && (i < PCI_MAXMAPS_0); i++) {
590 fm801->regid = PCIR_BAR(i);
591 fm801->regtype = SYS_RES_MEMORY;
592 fm801->reg = bus_alloc_resource(dev, fm801->regtype, &fm801->regid,
593 0, ~0, 1, RF_ACTIVE);
594 if(!fm801->reg)
595 {
596 fm801->regtype = SYS_RES_IOPORT;
597 fm801->reg = bus_alloc_resource(dev, fm801->regtype, &fm801->regid,
598 0, ~0, 1, RF_ACTIVE);
599 }
600
601 if(fm801->reg) {
602 fm801->st = rman_get_bustag(fm801->reg);
603 fm801->sh = rman_get_bushandle(fm801->reg);
604 mapped++;
605 }
606 }
607
608 if (mapped == 0) {
609 device_printf(dev, "unable to map register space\n");
610 goto oops;
611 }
612
613 fm801->bufsz = pcm_getbuffersize(dev, 4096, FM801_DEFAULT_BUFSZ, 65536);
614
615 fm801_init(fm801);
616
617 codec = AC97_CREATE(dev, fm801, fm801_ac97);
618 if (codec == NULL) goto oops;
619
620 if (mixer_init(dev, ac97_getmixerclass(), codec) == -1) goto oops;
621
622 fm801->irqid = 0;
623 fm801->irq = bus_alloc_resource(dev, SYS_RES_IRQ, &fm801->irqid,
624 0, ~0, 1, RF_ACTIVE | RF_SHAREABLE);
625 if (!fm801->irq || snd_setup_intr(dev, fm801->irq, 0, fm801_intr, fm801, &fm801->ih)) {
626 device_printf(dev, "unable to map interrupt\n");
627 goto oops;
628 }
629
630 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0,
631 /*lowaddr*/BUS_SPACE_MAXADDR_32BIT,
632 /*highaddr*/BUS_SPACE_MAXADDR,
633 /*filter*/NULL, /*filterarg*/NULL,
634 /*maxsize*/fm801->bufsz, /*nsegments*/1, /*maxsegz*/0x3ffff,
635 /*flags*/0, /*lockfunc*/busdma_lock_mutex,
636 /*lockarg*/&Giant, &fm801->parent_dmat) != 0) {
637 device_printf(dev, "unable to create dma tag\n");
638 goto oops;
639 }
640
| 33
34#define PCI_VENDOR_FORTEMEDIA 0x1319
35#define PCI_DEVICE_FORTEMEDIA1 0x08011319
36#define PCI_DEVICE_FORTEMEDIA2 0x08021319 /* ??? have no idea what's this... */
37
38#define FM_PCM_VOLUME 0x00
39#define FM_FM_VOLUME 0x02
40#define FM_I2S_VOLUME 0x04
41#define FM_RECORD_SOURCE 0x06
42
43#define FM_PLAY_CTL 0x08
44#define FM_PLAY_RATE_MASK 0x0f00
45#define FM_PLAY_BUF1_LAST 0x0001
46#define FM_PLAY_BUF2_LAST 0x0002
47#define FM_PLAY_START 0x0020
48#define FM_PLAY_PAUSE 0x0040
49#define FM_PLAY_STOPNOW 0x0080
50#define FM_PLAY_16BIT 0x4000
51#define FM_PLAY_STEREO 0x8000
52
53#define FM_PLAY_DMALEN 0x0a
54#define FM_PLAY_DMABUF1 0x0c
55#define FM_PLAY_DMABUF2 0x10
56
57
58#define FM_REC_CTL 0x14
59#define FM_REC_RATE_MASK 0x0f00
60#define FM_REC_BUF1_LAST 0x0001
61#define FM_REC_BUF2_LAST 0x0002
62#define FM_REC_START 0x0020
63#define FM_REC_PAUSE 0x0040
64#define FM_REC_STOPNOW 0x0080
65#define FM_REC_16BIT 0x4000
66#define FM_REC_STEREO 0x8000
67
68
69#define FM_REC_DMALEN 0x16
70#define FM_REC_DMABUF1 0x18
71#define FM_REC_DMABUF2 0x1c
72
73#define FM_CODEC_CTL 0x22
74#define FM_VOLUME 0x26
75#define FM_VOLUME_MUTE 0x8000
76
77#define FM_CODEC_CMD 0x2a
78#define FM_CODEC_CMD_READ 0x0080
79#define FM_CODEC_CMD_VALID 0x0100
80#define FM_CODEC_CMD_BUSY 0x0200
81
82#define FM_CODEC_DATA 0x2c
83
84#define FM_IO_CTL 0x52
85#define FM_CARD_CTL 0x54
86
87#define FM_INTMASK 0x56
88#define FM_INTMASK_PLAY 0x0001
89#define FM_INTMASK_REC 0x0002
90#define FM_INTMASK_VOL 0x0040
91#define FM_INTMASK_MPU 0x0080
92
93#define FM_INTSTATUS 0x5a
94#define FM_INTSTATUS_PLAY 0x0100
95#define FM_INTSTATUS_REC 0x0200
96#define FM_INTSTATUS_VOL 0x4000
97#define FM_INTSTATUS_MPU 0x8000
98
99#define FM801_DEFAULT_BUFSZ 4096 /* Other values do not work!!! */
100
101/* debug purposes */
102#define DPRINT if(0) printf
103
104/*
105static int fm801ch_setup(struct pcm_channel *c);
106*/
107
108static u_int32_t fmts[] = {
109 AFMT_U8,
110 AFMT_STEREO | AFMT_U8,
111 AFMT_S16_LE,
112 AFMT_STEREO | AFMT_S16_LE,
113 0
114};
115
116static struct pcmchan_caps fm801ch_caps = {
117 4000, 48000,
118 fmts, 0
119};
120
121struct fm801_info;
122
123struct fm801_chinfo {
124 struct fm801_info *parent;
125 struct pcm_channel *channel;
126 struct snd_dbuf *buffer;
127 u_int32_t spd, dir, fmt; /* speed, direction, format */
128 u_int32_t shift;
129};
130
131struct fm801_info {
132 int type;
133 bus_space_tag_t st;
134 bus_space_handle_t sh;
135 bus_dma_tag_t parent_dmat;
136
137 device_t dev;
138 int num;
139 u_int32_t unit;
140
141 struct resource *reg, *irq;
142 int regtype, regid, irqid;
143 void *ih;
144
145 u_int32_t play_flip,
146 play_nextblk,
147 play_start,
148 play_blksize,
149 play_fmt,
150 play_shift,
151 play_size;
152
153 u_int32_t rec_flip,
154 rec_nextblk,
155 rec_start,
156 rec_blksize,
157 rec_fmt,
158 rec_shift,
159 rec_size;
160
161 unsigned int bufsz;
162
163 struct fm801_chinfo pch, rch;
164
165 device_t radio;
166};
167
168/* Bus Read / Write routines */
169static u_int32_t
170fm801_rd(struct fm801_info *fm801, int regno, int size)
171{
172 switch(size) {
173 case 1:
174 return (bus_space_read_1(fm801->st, fm801->sh, regno));
175 case 2:
176 return (bus_space_read_2(fm801->st, fm801->sh, regno));
177 case 4:
178 return (bus_space_read_4(fm801->st, fm801->sh, regno));
179 default:
180 return 0xffffffff;
181 }
182}
183
184static void
185fm801_wr(struct fm801_info *fm801, int regno, u_int32_t data, int size)
186{
187
188 switch(size) {
189 case 1:
190 bus_space_write_1(fm801->st, fm801->sh, regno, data);
191 break;
192 case 2:
193 bus_space_write_2(fm801->st, fm801->sh, regno, data);
194 break;
195 case 4:
196 bus_space_write_4(fm801->st, fm801->sh, regno, data);
197 break;
198 }
199}
200
201/* -------------------------------------------------------------------- */
202/*
203 * ac97 codec routines
204 */
205#define TIMO 50
206static int
207fm801_rdcd(kobj_t obj, void *devinfo, int regno)
208{
209 struct fm801_info *fm801 = (struct fm801_info *)devinfo;
210 int i;
211
212 for (i = 0; i < TIMO && fm801_rd(fm801,FM_CODEC_CMD,2) & FM_CODEC_CMD_BUSY; i++) {
213 DELAY(10000);
214 DPRINT("fm801 rdcd: 1 - DELAY\n");
215 }
216 if (i >= TIMO) {
217 printf("fm801 rdcd: codec busy\n");
218 return 0;
219 }
220
221 fm801_wr(fm801,FM_CODEC_CMD, regno|FM_CODEC_CMD_READ,2);
222
223 for (i = 0; i < TIMO && !(fm801_rd(fm801,FM_CODEC_CMD,2) & FM_CODEC_CMD_VALID); i++)
224 {
225 DELAY(10000);
226 DPRINT("fm801 rdcd: 2 - DELAY\n");
227 }
228 if (i >= TIMO) {
229 printf("fm801 rdcd: write codec invalid\n");
230 return 0;
231 }
232
233 return fm801_rd(fm801,FM_CODEC_DATA,2);
234}
235
236static int
237fm801_wrcd(kobj_t obj, void *devinfo, int regno, u_int32_t data)
238{
239 struct fm801_info *fm801 = (struct fm801_info *)devinfo;
240 int i;
241
242 DPRINT("fm801_wrcd reg 0x%x val 0x%x\n",regno, data);
243/*
244 if(regno == AC97_REG_RECSEL) return;
245*/
246 /* Poll until codec is ready */
247 for (i = 0; i < TIMO && fm801_rd(fm801,FM_CODEC_CMD,2) & FM_CODEC_CMD_BUSY; i++) {
248 DELAY(10000);
249 DPRINT("fm801 rdcd: 1 - DELAY\n");
250 }
251 if (i >= TIMO) {
252 printf("fm801 wrcd: read codec busy\n");
253 return -1;
254 }
255
256 fm801_wr(fm801,FM_CODEC_DATA,data, 2);
257 fm801_wr(fm801,FM_CODEC_CMD, regno,2);
258
259 /* wait until codec is ready */
260 for (i = 0; i < TIMO && fm801_rd(fm801,FM_CODEC_CMD,2) & FM_CODEC_CMD_BUSY; i++) {
261 DELAY(10000);
262 DPRINT("fm801 wrcd: 2 - DELAY\n");
263 }
264 if (i >= TIMO) {
265 printf("fm801 wrcd: read codec busy\n");
266 return -1;
267 }
268 DPRINT("fm801 wrcd release reg 0x%x val 0x%x\n",regno, data);
269 return 0;
270}
271
272static kobj_method_t fm801_ac97_methods[] = {
273 KOBJMETHOD(ac97_read, fm801_rdcd),
274 KOBJMETHOD(ac97_write, fm801_wrcd),
275 { 0, 0 }
276};
277AC97_DECLARE(fm801_ac97);
278
279/* -------------------------------------------------------------------- */
280
281/*
282 * The interrupt handler
283 */
284static void
285fm801_intr(void *p)
286{
287 struct fm801_info *fm801 = (struct fm801_info *)p;
288 u_int32_t intsrc = fm801_rd(fm801, FM_INTSTATUS, 2);
289
290 DPRINT("\nfm801_intr intsrc 0x%x ", intsrc);
291
292 if(intsrc & FM_INTSTATUS_PLAY) {
293 fm801->play_flip++;
294 if(fm801->play_flip & 1) {
295 fm801_wr(fm801, FM_PLAY_DMABUF1, fm801->play_start,4);
296 } else
297 fm801_wr(fm801, FM_PLAY_DMABUF2, fm801->play_nextblk,4);
298 chn_intr(fm801->pch.channel);
299 }
300
301 if(intsrc & FM_INTSTATUS_REC) {
302 fm801->rec_flip++;
303 if(fm801->rec_flip & 1) {
304 fm801_wr(fm801, FM_REC_DMABUF1, fm801->rec_start,4);
305 } else
306 fm801_wr(fm801, FM_REC_DMABUF2, fm801->rec_nextblk,4);
307 chn_intr(fm801->rch.channel);
308 }
309
310 if ( intsrc & FM_INTSTATUS_MPU ) {
311 /* This is a TODOish thing... */
312 fm801_wr(fm801, FM_INTSTATUS, intsrc & FM_INTSTATUS_MPU,2);
313 }
314
315 if ( intsrc & FM_INTSTATUS_VOL ) {
316 /* This is a TODOish thing... */
317 fm801_wr(fm801, FM_INTSTATUS, intsrc & FM_INTSTATUS_VOL,2);
318 }
319
320 DPRINT("fm801_intr clear\n\n");
321 fm801_wr(fm801, FM_INTSTATUS, intsrc & (FM_INTSTATUS_PLAY | FM_INTSTATUS_REC), 2);
322}
323
324/* -------------------------------------------------------------------- */
325/* channel interface */
326static void *
327fm801ch_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
328{
329 struct fm801_info *fm801 = (struct fm801_info *)devinfo;
330 struct fm801_chinfo *ch = (dir == PCMDIR_PLAY)? &fm801->pch : &fm801->rch;
331
332 DPRINT("fm801ch_init, direction = %d\n", dir);
333 ch->parent = fm801;
334 ch->channel = c;
335 ch->buffer = b;
336 ch->dir = dir;
337 if (sndbuf_alloc(ch->buffer, fm801->parent_dmat, fm801->bufsz) == -1) return NULL;
338 return (void *)ch;
339}
340
341static int
342fm801ch_setformat(kobj_t obj, void *data, u_int32_t format)
343{
344 struct fm801_chinfo *ch = data;
345 struct fm801_info *fm801 = ch->parent;
346
347 DPRINT("fm801ch_setformat 0x%x : %s, %s, %s, %s\n", format,
348 (format & AFMT_STEREO)?"stereo":"mono",
349 (format & (AFMT_S16_LE | AFMT_S16_BE | AFMT_U16_LE | AFMT_U16_BE)) ? "16bit":"8bit",
350 (format & AFMT_SIGNED)? "signed":"unsigned",
351 (format & AFMT_BIGENDIAN)?"bigendiah":"littleendian" );
352
353 if(ch->dir == PCMDIR_PLAY) {
354 fm801->play_fmt = (format & AFMT_STEREO)? FM_PLAY_STEREO : 0;
355 fm801->play_fmt |= (format & AFMT_16BIT) ? FM_PLAY_16BIT : 0;
356 return 0;
357 }
358
359 if(ch->dir == PCMDIR_REC ) {
360 fm801->rec_fmt = (format & AFMT_STEREO)? FM_REC_STEREO:0;
361 fm801->rec_fmt |= (format & AFMT_16BIT) ? FM_PLAY_16BIT : 0;
362 return 0;
363 }
364
365 return 0;
366}
367
368struct {
369 int limit;
370 int rate;
371} fm801_rates[11] = {
372 { 6600, 5500 },
373 { 8750, 8000 },
374 { 10250, 9600 },
375 { 13200, 11025 },
376 { 17500, 16000 },
377 { 20500, 19200 },
378 { 26500, 22050 },
379 { 35000, 32000 },
380 { 41000, 38400 },
381 { 46000, 44100 },
382 { 48000, 48000 },
383/* anything above -> 48000 */
384};
385
386static int
387fm801ch_setspeed(kobj_t obj, void *data, u_int32_t speed)
388{
389 struct fm801_chinfo *ch = data;
390 struct fm801_info *fm801 = ch->parent;
391 register int i;
392
393
394 for (i = 0; i < 10 && fm801_rates[i].limit <= speed; i++) ;
395
396 if(ch->dir == PCMDIR_PLAY) {
397 fm801->pch.spd = fm801_rates[i].rate;
398 fm801->play_shift = (i<<8);
399 fm801->play_shift &= FM_PLAY_RATE_MASK;
400 }
401
402 if(ch->dir == PCMDIR_REC ) {
403 fm801->rch.spd = fm801_rates[i].rate;
404 fm801->rec_shift = (i<<8);
405 fm801->rec_shift &= FM_REC_RATE_MASK;
406 }
407
408 ch->spd = fm801_rates[i].rate;
409
410 return fm801_rates[i].rate;
411}
412
413static int
414fm801ch_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
415{
416 struct fm801_chinfo *ch = data;
417 struct fm801_info *fm801 = ch->parent;
418
419 if(ch->dir == PCMDIR_PLAY) {
420 if(fm801->play_flip) return fm801->play_blksize;
421 fm801->play_blksize = blocksize;
422 }
423
424 if(ch->dir == PCMDIR_REC) {
425 if(fm801->rec_flip) return fm801->rec_blksize;
426 fm801->rec_blksize = blocksize;
427 }
428
429 DPRINT("fm801ch_setblocksize %d (dir %d)\n",blocksize, ch->dir);
430
431 return blocksize;
432}
433
434static int
435fm801ch_trigger(kobj_t obj, void *data, int go)
436{
437 struct fm801_chinfo *ch = data;
438 struct fm801_info *fm801 = ch->parent;
439 u_int32_t baseaddr = sndbuf_getbufaddr(ch->buffer);
440 u_int32_t k1;
441
442 DPRINT("fm801ch_trigger go %d , ", go);
443
444 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD) {
445 return 0;
446 }
447
448 if (ch->dir == PCMDIR_PLAY) {
449 if (go == PCMTRIG_START) {
450
451 fm801->play_start = baseaddr;
452 fm801->play_nextblk = fm801->play_start + fm801->play_blksize;
453 fm801->play_flip = 0;
454 fm801_wr(fm801, FM_PLAY_DMALEN, fm801->play_blksize - 1, 2);
455 fm801_wr(fm801, FM_PLAY_DMABUF1,fm801->play_start,4);
456 fm801_wr(fm801, FM_PLAY_DMABUF2,fm801->play_nextblk,4);
457 fm801_wr(fm801, FM_PLAY_CTL,
458 FM_PLAY_START | FM_PLAY_STOPNOW | fm801->play_fmt | fm801->play_shift,
459 2 );
460 } else {
461 fm801->play_flip = 0;
462 k1 = fm801_rd(fm801, FM_PLAY_CTL,2);
463 fm801_wr(fm801, FM_PLAY_CTL,
464 (k1 & ~(FM_PLAY_STOPNOW | FM_PLAY_START)) |
465 FM_PLAY_BUF1_LAST | FM_PLAY_BUF2_LAST, 2 );
466 }
467 } else if(ch->dir == PCMDIR_REC) {
468 if (go == PCMTRIG_START) {
469 fm801->rec_start = baseaddr;
470 fm801->rec_nextblk = fm801->rec_start + fm801->rec_blksize;
471 fm801->rec_flip = 0;
472 fm801_wr(fm801, FM_REC_DMALEN, fm801->rec_blksize - 1, 2);
473 fm801_wr(fm801, FM_REC_DMABUF1,fm801->rec_start,4);
474 fm801_wr(fm801, FM_REC_DMABUF2,fm801->rec_nextblk,4);
475 fm801_wr(fm801, FM_REC_CTL,
476 FM_REC_START | FM_REC_STOPNOW | fm801->rec_fmt | fm801->rec_shift,
477 2 );
478 } else {
479 fm801->rec_flip = 0;
480 k1 = fm801_rd(fm801, FM_REC_CTL,2);
481 fm801_wr(fm801, FM_REC_CTL,
482 (k1 & ~(FM_REC_STOPNOW | FM_REC_START)) |
483 FM_REC_BUF1_LAST | FM_REC_BUF2_LAST, 2);
484 }
485 }
486
487 return 0;
488}
489
490/* Almost ALSA copy */
491static int
492fm801ch_getptr(kobj_t obj, void *data)
493{
494 struct fm801_chinfo *ch = data;
495 struct fm801_info *fm801 = ch->parent;
496 int result = 0;
497
498 if (ch->dir == PCMDIR_PLAY) {
499 result = fm801_rd(fm801,
500 (fm801->play_flip&1) ?
501 FM_PLAY_DMABUF2:FM_PLAY_DMABUF1, 4) - fm801->play_start;
502 }
503
504 if (ch->dir == PCMDIR_REC) {
505 result = fm801_rd(fm801,
506 (fm801->rec_flip&1) ?
507 FM_REC_DMABUF2:FM_REC_DMABUF1, 4) - fm801->rec_start;
508 }
509
510 return result;
511}
512
513static struct pcmchan_caps *
514fm801ch_getcaps(kobj_t obj, void *data)
515{
516 return &fm801ch_caps;
517}
518
519static kobj_method_t fm801ch_methods[] = {
520 KOBJMETHOD(channel_init, fm801ch_init),
521 KOBJMETHOD(channel_setformat, fm801ch_setformat),
522 KOBJMETHOD(channel_setspeed, fm801ch_setspeed),
523 KOBJMETHOD(channel_setblocksize, fm801ch_setblocksize),
524 KOBJMETHOD(channel_trigger, fm801ch_trigger),
525 KOBJMETHOD(channel_getptr, fm801ch_getptr),
526 KOBJMETHOD(channel_getcaps, fm801ch_getcaps),
527 { 0, 0 }
528};
529CHANNEL_DECLARE(fm801ch);
530
531/* -------------------------------------------------------------------- */
532
533/*
534 * Init routine is taken from an original NetBSD driver
535 */
536static int
537fm801_init(struct fm801_info *fm801)
538{
539 u_int32_t k1;
540
541 /* reset codec */
542 fm801_wr(fm801, FM_CODEC_CTL, 0x0020,2);
543 DELAY(100000);
544 fm801_wr(fm801, FM_CODEC_CTL, 0x0000,2);
545 DELAY(100000);
546
547 fm801_wr(fm801, FM_PCM_VOLUME, 0x0808,2);
548 fm801_wr(fm801, FM_FM_VOLUME, 0x0808,2);
549 fm801_wr(fm801, FM_I2S_VOLUME, 0x0808,2);
550 fm801_wr(fm801, 0x40,0x107f,2); /* enable legacy audio */
551
552 fm801_wr((void *)fm801, FM_RECORD_SOURCE, 0x0000,2);
553
554 /* Unmask playback, record and mpu interrupts, mask the rest */
555 k1 = fm801_rd((void *)fm801, FM_INTMASK,2);
556 fm801_wr(fm801, FM_INTMASK,
557 (k1 & ~(FM_INTMASK_PLAY | FM_INTMASK_REC | FM_INTMASK_MPU)) |
558 FM_INTMASK_VOL,2);
559 fm801_wr(fm801, FM_INTSTATUS,
560 FM_INTSTATUS_PLAY | FM_INTSTATUS_REC | FM_INTSTATUS_MPU |
561 FM_INTSTATUS_VOL,2);
562
563 DPRINT("FM801 init Ok\n");
564 return 0;
565}
566
567static int
568fm801_pci_attach(device_t dev)
569{
570 u_int32_t data;
571 struct ac97_info *codec = 0;
572 struct fm801_info *fm801;
573 int i;
574 int mapped = 0;
575 char status[SND_STATUSLEN];
576
577 if ((fm801 = (struct fm801_info *)malloc(sizeof(*fm801), M_DEVBUF, M_NOWAIT | M_ZERO)) == NULL) {
578 device_printf(dev, "cannot allocate softc\n");
579 return ENXIO;
580 }
581
582 fm801->type = pci_get_devid(dev);
583
584 data = pci_read_config(dev, PCIR_COMMAND, 2);
585 data |= (PCIM_CMD_PORTEN|PCIM_CMD_MEMEN|PCIM_CMD_BUSMASTEREN);
586 pci_write_config(dev, PCIR_COMMAND, data, 2);
587 data = pci_read_config(dev, PCIR_COMMAND, 2);
588
589 for (i = 0; (mapped == 0) && (i < PCI_MAXMAPS_0); i++) {
590 fm801->regid = PCIR_BAR(i);
591 fm801->regtype = SYS_RES_MEMORY;
592 fm801->reg = bus_alloc_resource(dev, fm801->regtype, &fm801->regid,
593 0, ~0, 1, RF_ACTIVE);
594 if(!fm801->reg)
595 {
596 fm801->regtype = SYS_RES_IOPORT;
597 fm801->reg = bus_alloc_resource(dev, fm801->regtype, &fm801->regid,
598 0, ~0, 1, RF_ACTIVE);
599 }
600
601 if(fm801->reg) {
602 fm801->st = rman_get_bustag(fm801->reg);
603 fm801->sh = rman_get_bushandle(fm801->reg);
604 mapped++;
605 }
606 }
607
608 if (mapped == 0) {
609 device_printf(dev, "unable to map register space\n");
610 goto oops;
611 }
612
613 fm801->bufsz = pcm_getbuffersize(dev, 4096, FM801_DEFAULT_BUFSZ, 65536);
614
615 fm801_init(fm801);
616
617 codec = AC97_CREATE(dev, fm801, fm801_ac97);
618 if (codec == NULL) goto oops;
619
620 if (mixer_init(dev, ac97_getmixerclass(), codec) == -1) goto oops;
621
622 fm801->irqid = 0;
623 fm801->irq = bus_alloc_resource(dev, SYS_RES_IRQ, &fm801->irqid,
624 0, ~0, 1, RF_ACTIVE | RF_SHAREABLE);
625 if (!fm801->irq || snd_setup_intr(dev, fm801->irq, 0, fm801_intr, fm801, &fm801->ih)) {
626 device_printf(dev, "unable to map interrupt\n");
627 goto oops;
628 }
629
630 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0,
631 /*lowaddr*/BUS_SPACE_MAXADDR_32BIT,
632 /*highaddr*/BUS_SPACE_MAXADDR,
633 /*filter*/NULL, /*filterarg*/NULL,
634 /*maxsize*/fm801->bufsz, /*nsegments*/1, /*maxsegz*/0x3ffff,
635 /*flags*/0, /*lockfunc*/busdma_lock_mutex,
636 /*lockarg*/&Giant, &fm801->parent_dmat) != 0) {
637 device_printf(dev, "unable to create dma tag\n");
638 goto oops;
639 }
640
|
644
645#define FM801_MAXPLAYCH 1
646 if (pcm_register(dev, fm801, FM801_MAXPLAYCH, 1)) goto oops;
647 pcm_addchan(dev, PCMDIR_PLAY, &fm801ch_class, fm801);
648 pcm_addchan(dev, PCMDIR_REC, &fm801ch_class, fm801);
649 pcm_setstatus(dev, status);
650
651 fm801->radio = device_add_child(dev, "radio", -1);
652 bus_generic_attach(dev);
653
654 return 0;
655
656oops:
657 if (codec) ac97_destroy(codec);
658 if (fm801->reg) bus_release_resource(dev, fm801->regtype, fm801->regid, fm801->reg);
659 if (fm801->ih) bus_teardown_intr(dev, fm801->irq, fm801->ih);
660 if (fm801->irq) bus_release_resource(dev, SYS_RES_IRQ, fm801->irqid, fm801->irq);
661 if (fm801->parent_dmat) bus_dma_tag_destroy(fm801->parent_dmat);
662 free(fm801, M_DEVBUF);
663 return ENXIO;
664}
665
666static int
667fm801_pci_detach(device_t dev)
668{
669 int r;
670 struct fm801_info *fm801;
671
672 DPRINT("Forte Media FM801 detach\n");
673
674 fm801 = pcm_getdevinfo(dev);
675
676 r = bus_generic_detach(dev);
677 if (r)
678 return r;
679 if (fm801->radio != NULL) {
680 r = device_delete_child(dev, fm801->radio);
681 if (r)
682 return r;
683 fm801->radio = NULL;
684 }
685
686 r = pcm_unregister(dev);
687 if (r)
688 return r;
689
690 bus_release_resource(dev, fm801->regtype, fm801->regid, fm801->reg);
691 bus_teardown_intr(dev, fm801->irq, fm801->ih);
692 bus_release_resource(dev, SYS_RES_IRQ, fm801->irqid, fm801->irq);
693 bus_dma_tag_destroy(fm801->parent_dmat);
694 free(fm801, M_DEVBUF);
695 return 0;
696}
697
698static int
699fm801_pci_probe( device_t dev )
700{
701 u_int32_t data;
702 int id, regtype, regid, result;
703 struct resource *reg;
704 bus_space_tag_t st;
705 bus_space_handle_t sh;
706
707 result = ENXIO;
708
709 if ((id = pci_get_devid(dev)) == PCI_DEVICE_FORTEMEDIA1 ) {
710 data = pci_read_config(dev, PCIR_COMMAND, 2);
711 data |= (PCIM_CMD_PORTEN|PCIM_CMD_BUSMASTEREN);
712 pci_write_config(dev, PCIR_COMMAND, data, 2);
713 data = pci_read_config(dev, PCIR_COMMAND, 2);
714
715 regid = PCIR_BAR(0);
716 regtype = SYS_RES_IOPORT;
717 reg = bus_alloc_resource(dev, regtype, ®id, 0, ~0, 1,
718 RF_ACTIVE);
719
720 if (reg == NULL)
721 return ENXIO;
722
723 st = rman_get_bustag(reg);
724 sh = rman_get_bushandle(reg);
725 /*
726 * XXX: quick check that device actually has sound capabilities.
727 * The problem is that some cards built around FM801 chip only
728 * have radio tuner onboard, but no sound capabilities. There
729 * is no "official" way to quickly check this, because all
730 * IDs are exactly the same. The only difference is 0x28
731 * device control register, described in FM801 specification
732 * as "SRC/Mixer Test Control/DFC Status", but without
733 * any more detailed explanation. According to specs, and
734 * available sample cards (SF256-PCP-R and SF256-PCS-R) its
735 * power-on value should be `0', while on AC97-less tuner
736 * card (SF64-PCR) it was 0x80.
737 */
738 if (bus_space_read_1(st, sh, 0x28) == 0) {
739 device_set_desc(dev,
740 "Forte Media FM801 Audio Controller");
741 result = 0;
742 }
743
744 bus_release_resource(dev, regtype, regid, reg);
745 }
746/*
747 if ((id = pci_get_devid(dev)) == PCI_DEVICE_FORTEMEDIA2 ) {
748 device_set_desc(dev, "Forte Media FM801 Joystick (Not Supported)");
749 return ENXIO;
750 }
751*/
752 return (result);
753}
754
755static struct resource *
756fm801_alloc_resource(device_t bus, device_t child, int type, int *rid,
757 u_long start, u_long end, u_long count, u_int flags)
758{
759 struct fm801_info *fm801;
760
761 fm801 = pcm_getdevinfo(bus);
762
763 if (type == SYS_RES_IOPORT && *rid == PCIR_BAR(0))
764 return (fm801->reg);
765
766 return (NULL);
767}
768
769static int
770fm801_release_resource(device_t bus, device_t child, int type, int rid,
771 struct resource *r)
772{
773 return (0);
774}
775
776static device_method_t fm801_methods[] = {
777 /* Device interface */
778 DEVMETHOD(device_probe, fm801_pci_probe),
779 DEVMETHOD(device_attach, fm801_pci_attach),
780 DEVMETHOD(device_detach, fm801_pci_detach),
781 DEVMETHOD(device_shutdown, bus_generic_shutdown),
782 DEVMETHOD(device_suspend, bus_generic_suspend),
783 DEVMETHOD(device_resume, bus_generic_resume),
784
785 /* Bus interface */
786 DEVMETHOD(bus_print_child, bus_generic_print_child),
787 DEVMETHOD(bus_alloc_resource, fm801_alloc_resource),
788 DEVMETHOD(bus_release_resource, fm801_release_resource),
789 DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
790 DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
791 { 0, 0}
792};
793
794static driver_t fm801_driver = {
795 "pcm",
796 fm801_methods,
797 PCM_SOFTC_SIZE,
798};
799
800DRIVER_MODULE(snd_fm801, pci, fm801_driver, pcm_devclass, 0, 0);
801MODULE_DEPEND(snd_fm801, snd_pcm, PCM_MINVER, PCM_PREFVER, PCM_MAXVER);
802MODULE_VERSION(snd_fm801, 1);
| 644
645#define FM801_MAXPLAYCH 1
646 if (pcm_register(dev, fm801, FM801_MAXPLAYCH, 1)) goto oops;
647 pcm_addchan(dev, PCMDIR_PLAY, &fm801ch_class, fm801);
648 pcm_addchan(dev, PCMDIR_REC, &fm801ch_class, fm801);
649 pcm_setstatus(dev, status);
650
651 fm801->radio = device_add_child(dev, "radio", -1);
652 bus_generic_attach(dev);
653
654 return 0;
655
656oops:
657 if (codec) ac97_destroy(codec);
658 if (fm801->reg) bus_release_resource(dev, fm801->regtype, fm801->regid, fm801->reg);
659 if (fm801->ih) bus_teardown_intr(dev, fm801->irq, fm801->ih);
660 if (fm801->irq) bus_release_resource(dev, SYS_RES_IRQ, fm801->irqid, fm801->irq);
661 if (fm801->parent_dmat) bus_dma_tag_destroy(fm801->parent_dmat);
662 free(fm801, M_DEVBUF);
663 return ENXIO;
664}
665
666static int
667fm801_pci_detach(device_t dev)
668{
669 int r;
670 struct fm801_info *fm801;
671
672 DPRINT("Forte Media FM801 detach\n");
673
674 fm801 = pcm_getdevinfo(dev);
675
676 r = bus_generic_detach(dev);
677 if (r)
678 return r;
679 if (fm801->radio != NULL) {
680 r = device_delete_child(dev, fm801->radio);
681 if (r)
682 return r;
683 fm801->radio = NULL;
684 }
685
686 r = pcm_unregister(dev);
687 if (r)
688 return r;
689
690 bus_release_resource(dev, fm801->regtype, fm801->regid, fm801->reg);
691 bus_teardown_intr(dev, fm801->irq, fm801->ih);
692 bus_release_resource(dev, SYS_RES_IRQ, fm801->irqid, fm801->irq);
693 bus_dma_tag_destroy(fm801->parent_dmat);
694 free(fm801, M_DEVBUF);
695 return 0;
696}
697
698static int
699fm801_pci_probe( device_t dev )
700{
701 u_int32_t data;
702 int id, regtype, regid, result;
703 struct resource *reg;
704 bus_space_tag_t st;
705 bus_space_handle_t sh;
706
707 result = ENXIO;
708
709 if ((id = pci_get_devid(dev)) == PCI_DEVICE_FORTEMEDIA1 ) {
710 data = pci_read_config(dev, PCIR_COMMAND, 2);
711 data |= (PCIM_CMD_PORTEN|PCIM_CMD_BUSMASTEREN);
712 pci_write_config(dev, PCIR_COMMAND, data, 2);
713 data = pci_read_config(dev, PCIR_COMMAND, 2);
714
715 regid = PCIR_BAR(0);
716 regtype = SYS_RES_IOPORT;
717 reg = bus_alloc_resource(dev, regtype, ®id, 0, ~0, 1,
718 RF_ACTIVE);
719
720 if (reg == NULL)
721 return ENXIO;
722
723 st = rman_get_bustag(reg);
724 sh = rman_get_bushandle(reg);
725 /*
726 * XXX: quick check that device actually has sound capabilities.
727 * The problem is that some cards built around FM801 chip only
728 * have radio tuner onboard, but no sound capabilities. There
729 * is no "official" way to quickly check this, because all
730 * IDs are exactly the same. The only difference is 0x28
731 * device control register, described in FM801 specification
732 * as "SRC/Mixer Test Control/DFC Status", but without
733 * any more detailed explanation. According to specs, and
734 * available sample cards (SF256-PCP-R and SF256-PCS-R) its
735 * power-on value should be `0', while on AC97-less tuner
736 * card (SF64-PCR) it was 0x80.
737 */
738 if (bus_space_read_1(st, sh, 0x28) == 0) {
739 device_set_desc(dev,
740 "Forte Media FM801 Audio Controller");
741 result = 0;
742 }
743
744 bus_release_resource(dev, regtype, regid, reg);
745 }
746/*
747 if ((id = pci_get_devid(dev)) == PCI_DEVICE_FORTEMEDIA2 ) {
748 device_set_desc(dev, "Forte Media FM801 Joystick (Not Supported)");
749 return ENXIO;
750 }
751*/
752 return (result);
753}
754
755static struct resource *
756fm801_alloc_resource(device_t bus, device_t child, int type, int *rid,
757 u_long start, u_long end, u_long count, u_int flags)
758{
759 struct fm801_info *fm801;
760
761 fm801 = pcm_getdevinfo(bus);
762
763 if (type == SYS_RES_IOPORT && *rid == PCIR_BAR(0))
764 return (fm801->reg);
765
766 return (NULL);
767}
768
769static int
770fm801_release_resource(device_t bus, device_t child, int type, int rid,
771 struct resource *r)
772{
773 return (0);
774}
775
776static device_method_t fm801_methods[] = {
777 /* Device interface */
778 DEVMETHOD(device_probe, fm801_pci_probe),
779 DEVMETHOD(device_attach, fm801_pci_attach),
780 DEVMETHOD(device_detach, fm801_pci_detach),
781 DEVMETHOD(device_shutdown, bus_generic_shutdown),
782 DEVMETHOD(device_suspend, bus_generic_suspend),
783 DEVMETHOD(device_resume, bus_generic_resume),
784
785 /* Bus interface */
786 DEVMETHOD(bus_print_child, bus_generic_print_child),
787 DEVMETHOD(bus_alloc_resource, fm801_alloc_resource),
788 DEVMETHOD(bus_release_resource, fm801_release_resource),
789 DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
790 DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
791 { 0, 0}
792};
793
794static driver_t fm801_driver = {
795 "pcm",
796 fm801_methods,
797 PCM_SOFTC_SIZE,
798};
799
800DRIVER_MODULE(snd_fm801, pci, fm801_driver, pcm_devclass, 0, 0);
801MODULE_DEPEND(snd_fm801, snd_pcm, PCM_MINVER, PCM_PREFVER, PCM_MAXVER);
802MODULE_VERSION(snd_fm801, 1);
|