fm801.c revision 70291
1/* 2 * Copyright (c) 2000 Dmitry Dicky diwil@dataart.com 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS `AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 * 26 * $FreeBSD: head/sys/dev/sound/pci/fm801.c 70291 2000-12-23 03:16:13Z cg $ 27 */ 28 29#include <dev/sound/pcm/sound.h> 30#include <dev/sound/pcm/ac97.h> 31#include <pci/pcireg.h> 32#include <pci/pcivar.h> 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_BUFFSIZE 1024*4 /* Other values do not work!!! */ 100 101/* debug purposes */ 102#define DPRINT if(0) printf 103 104/* 105static int fm801ch_setup(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 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 pcm_channel *channel; 126 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 struct fm801_chinfo pch, rch; 162}; 163 164/* Bus Read / Write routines */ 165static u_int32_t 166fm801_rd(struct fm801_info *fm801, int regno, int size) 167{ 168 switch(size) { 169 case 1: 170 return (bus_space_read_1(fm801->st, fm801->sh, regno)); 171 case 2: 172 return (bus_space_read_2(fm801->st, fm801->sh, regno)); 173 case 4: 174 return (bus_space_read_4(fm801->st, fm801->sh, regno)); 175 default: 176 return 0xffffffff; 177 } 178} 179 180static void 181fm801_wr(struct fm801_info *fm801, int regno, u_int32_t data, int size) 182{ 183 switch(size) { 184 case 1: 185 return bus_space_write_1(fm801->st, fm801->sh, regno, data); 186 case 2: 187 return bus_space_write_2(fm801->st, fm801->sh, regno, data); 188 case 4: 189 return bus_space_write_4(fm801->st, fm801->sh, regno, data); 190 default: 191 return; 192 } 193} 194 195/* -------------------------------------------------------------------- */ 196/* 197 * ac97 codec routines 198 */ 199#define TIMO 50 200static int 201fm801_rdcd(kobj_t obj, void *devinfo, int regno) 202{ 203 struct fm801_info *fm801 = (struct fm801_info *)devinfo; 204 int i; 205 206 for (i = 0; i < TIMO && fm801_rd(fm801,FM_CODEC_CMD,2) & FM_CODEC_CMD_BUSY; i++) { 207 DELAY(10000); 208 DPRINT("fm801 rdcd: 1 - DELAY\n"); 209 } 210 if (i >= TIMO) { 211 printf("fm801 rdcd: codec busy\n"); 212 return 0; 213 } 214 215 fm801_wr(fm801,FM_CODEC_CMD, regno|FM_CODEC_CMD_READ,2); 216 217 for (i = 0; i < TIMO && !(fm801_rd(fm801,FM_CODEC_CMD,2) & FM_CODEC_CMD_VALID); i++) 218 { 219 DELAY(10000); 220 DPRINT("fm801 rdcd: 2 - DELAY\n"); 221 } 222 if (i >= TIMO) { 223 printf("fm801 rdcd: write codec invalid\n"); 224 return 0; 225 } 226 227 return fm801_rd(fm801,FM_CODEC_DATA,2); 228} 229 230static int 231fm801_wrcd(kobj_t obj, void *devinfo, int regno, u_int32_t data) 232{ 233 struct fm801_info *fm801 = (struct fm801_info *)devinfo; 234 int i; 235 236 DPRINT("fm801_wrcd reg 0x%x val 0x%x\n",regno, data); 237/* 238 if(regno == AC97_REG_RECSEL) return; 239*/ 240 /* Poll until codec is ready */ 241 for (i = 0; i < TIMO && fm801_rd(fm801,FM_CODEC_CMD,2) & FM_CODEC_CMD_BUSY; i++) { 242 DELAY(10000); 243 DPRINT("fm801 rdcd: 1 - DELAY\n"); 244 } 245 if (i >= TIMO) { 246 printf("fm801 wrcd: read codec busy\n"); 247 return -1; 248 } 249 250 fm801_wr(fm801,FM_CODEC_DATA,data, 2); 251 fm801_wr(fm801,FM_CODEC_CMD, regno,2); 252 253 /* wait until codec is ready */ 254 for (i = 0; i < TIMO && fm801_rd(fm801,FM_CODEC_CMD,2) & FM_CODEC_CMD_BUSY; i++) { 255 DELAY(10000); 256 DPRINT("fm801 wrcd: 2 - DELAY\n"); 257 } 258 if (i >= TIMO) { 259 printf("fm801 wrcd: read codec busy\n"); 260 return -1; 261 } 262 DPRINT("fm801 wrcd release reg 0x%x val 0x%x\n",regno, data); 263 return 0; 264} 265 266static kobj_method_t fm801_ac97_methods[] = { 267 KOBJMETHOD(ac97_read, fm801_rdcd), 268 KOBJMETHOD(ac97_write, fm801_wrcd), 269 { 0, 0 } 270}; 271AC97_DECLARE(fm801_ac97); 272 273/* -------------------------------------------------------------------- */ 274 275/* 276 * The interrupt handler 277 */ 278static void 279fm801_intr(void *p) 280{ 281 struct fm801_info *fm801 = (struct fm801_info *)p; 282 u_int32_t intsrc = fm801_rd(fm801, FM_INTSTATUS, 2); 283 struct fm801_chinfo *ch = &(fm801->pch); 284 snd_dbuf *b = ch->buffer; 285 286 DPRINT("\nfm801_intr intsrc 0x%x ", intsrc); 287 DPRINT("rp %d, rl %d, fp %d fl %d, size=%d\n", 288 b->rp,b->rl, b->fp,b->fl, b->blksz); 289 290 if(intsrc & FM_INTSTATUS_PLAY) { 291 fm801->play_flip++; 292 if(fm801->play_flip & 1) { 293 fm801_wr(fm801, FM_PLAY_DMABUF1, fm801->play_start,4); 294 } else 295 fm801_wr(fm801, FM_PLAY_DMABUF2, fm801->play_nextblk,4); 296 chn_intr(fm801->pch.channel); 297 } 298 299 if(intsrc & FM_INTSTATUS_REC) { 300 fm801->rec_flip++; 301 if(fm801->rec_flip & 1) { 302 fm801_wr(fm801, FM_REC_DMABUF1, fm801->rec_start,4); 303 } else 304 fm801_wr(fm801, FM_REC_DMABUF2, fm801->rec_nextblk,4); 305 chn_intr(fm801->rch.channel); 306 } 307 308 if ( intsrc & FM_INTSTATUS_MPU ) { 309 /* This is a TODOish thing... */ 310 fm801_wr(fm801, FM_INTSTATUS, intsrc & FM_INTSTATUS_MPU,2); 311 } 312 313 if ( intsrc & FM_INTSTATUS_VOL ) { 314 /* This is a TODOish thing... */ 315 fm801_wr(fm801, FM_INTSTATUS, intsrc & FM_INTSTATUS_VOL,2); 316 } 317 318 DPRINT("fm801_intr clear\n\n"); 319 fm801_wr(fm801, FM_INTSTATUS, intsrc & (FM_INTSTATUS_PLAY | FM_INTSTATUS_REC), 2); 320} 321 322/* -------------------------------------------------------------------- */ 323/* channel interface */ 324static void * 325fm801ch_init(kobj_t obj, void *devinfo, snd_dbuf *b, pcm_channel *c, int dir) 326{ 327 struct fm801_info *fm801 = (struct fm801_info *)devinfo; 328 struct fm801_chinfo *ch = (dir == PCMDIR_PLAY)? &fm801->pch : &fm801->rch; 329 330 DPRINT("fm801ch_init, direction = %d\n", dir); 331 ch->parent = fm801; 332 ch->channel = c; 333 ch->buffer = b; 334 ch->dir = dir; 335 if (sndbuf_alloc(ch->buffer, fm801->parent_dmat, FM801_BUFFSIZE) == -1) return NULL; 336 return (void *)ch; 337} 338 339static int 340fm801ch_setformat(kobj_t obj, void *data, u_int32_t format) 341{ 342 struct fm801_chinfo *ch = data; 343 struct fm801_info *fm801 = ch->parent; 344 345 DPRINT("fm801ch_setformat 0x%x : %s, %s, %s, %s\n", format, 346 (format & AFMT_STEREO)?"stereo":"mono", 347 (format & (AFMT_S16_LE | AFMT_S16_BE | AFMT_U16_LE | AFMT_U16_BE)) ? "16bit":"8bit", 348 (format & AFMT_SIGNED)? "signed":"unsigned", 349 (format & AFMT_BIGENDIAN)?"bigendiah":"littleendian" ); 350 351 if(ch->dir == PCMDIR_PLAY) { 352 fm801->play_fmt = (format & AFMT_STEREO)? FM_PLAY_STEREO : 0; 353 fm801->play_fmt |= (format & AFMT_16BIT) ? FM_PLAY_16BIT : 0; 354 return 0; 355 } 356 357 if(ch->dir == PCMDIR_REC ) { 358 fm801->rec_fmt = (format & AFMT_STEREO)? FM_REC_STEREO:0; 359 fm801->rec_fmt |= (format & AFMT_16BIT) ? FM_PLAY_16BIT : 0; 360 return 0; 361 } 362 363 return 0; 364} 365 366struct { 367 int limit; 368 int rate; 369} fm801_rates[11] = { 370 { 6600, 5500 }, 371 { 8750, 8000 }, 372 { 10250, 9600 }, 373 { 13200, 11025 }, 374 { 17500, 16000 }, 375 { 20500, 19200 }, 376 { 26500, 22050 }, 377 { 35000, 32000 }, 378 { 41000, 38400 }, 379 { 46000, 44100 }, 380 { 48000, 48000 }, 381/* anything above -> 48000 */ 382}; 383 384static int 385fm801ch_setspeed(kobj_t obj, void *data, u_int32_t speed) 386{ 387 struct fm801_chinfo *ch = data; 388 struct fm801_info *fm801 = ch->parent; 389 register int i; 390 391 392 for (i = 0; i < 10 && fm801_rates[i].limit <= speed; i++) ; 393 394 if(ch->dir == PCMDIR_PLAY) { 395 fm801->pch.spd = fm801_rates[i].rate; 396 fm801->play_shift = (i<<8); 397 fm801->play_shift &= FM_PLAY_RATE_MASK; 398 } 399 400 if(ch->dir == PCMDIR_REC ) { 401 fm801->rch.spd = fm801_rates[i].rate; 402 fm801->rec_shift = (i<<8); 403 fm801->rec_shift &= FM_REC_RATE_MASK; 404 } 405 406 ch->spd = fm801_rates[i].rate; 407 408 return fm801_rates[i].rate; 409} 410 411static int 412fm801ch_setblocksize(kobj_t obj, void *data, u_int32_t blocksize) 413{ 414 struct fm801_chinfo *ch = data; 415 struct fm801_info *fm801 = ch->parent; 416 417 if(ch->dir == PCMDIR_PLAY) { 418 if(fm801->play_flip) return fm801->play_blksize; 419 fm801->play_blksize = blocksize; 420 } 421 422 if(ch->dir == PCMDIR_REC) { 423 if(fm801->rec_flip) return fm801->rec_blksize; 424 fm801->rec_blksize = blocksize; 425 } 426 427 DPRINT("fm801ch_setblocksize %d (dir %d)\n",blocksize, ch->dir); 428 429 return blocksize; 430} 431 432static int 433fm801ch_trigger(kobj_t obj, void *data, int go) 434{ 435 struct fm801_chinfo *ch = data; 436 struct fm801_info *fm801 = ch->parent; 437 u_int32_t baseaddr = vtophys(sndbuf_getbuf(ch->buffer)); 438 snd_dbuf *b = ch->buffer; 439 u_int32_t k1; 440 441 DPRINT("fm801ch_trigger go %d , ", go); 442 DPRINT("rp %d, rl %d, fp %d fl %d, dl %d, blksize=%d\n", 443 b->rp,b->rl, b->fp,b->fl, b->dl, b->blksz); 444 445 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD) { 446 return 0; 447 } 448 449 if (ch->dir == PCMDIR_PLAY) { 450 if (go == PCMTRIG_START) { 451 452 fm801->play_start = baseaddr; 453 fm801->play_nextblk = fm801->play_start + fm801->play_blksize; 454 fm801->play_flip = 0; 455 fm801_wr(fm801, FM_PLAY_DMALEN, fm801->play_blksize - 1, 2); 456 fm801_wr(fm801, FM_PLAY_DMABUF1,fm801->play_start,4); 457 fm801_wr(fm801, FM_PLAY_DMABUF2,fm801->play_nextblk,4); 458 fm801_wr(fm801, FM_PLAY_CTL, 459 FM_PLAY_START | FM_PLAY_STOPNOW | fm801->play_fmt | fm801->play_shift, 460 2 ); 461 } else { 462 fm801->play_flip = 0; 463 k1 = fm801_rd(fm801, FM_PLAY_CTL,2); 464 fm801_wr(fm801, FM_PLAY_CTL, 465 (k1 & ~(FM_PLAY_STOPNOW | FM_PLAY_START)) | 466 FM_PLAY_BUF1_LAST | FM_PLAY_BUF2_LAST, 2 ); 467 } 468 } else if(ch->dir == PCMDIR_REC) { 469 if (go == PCMTRIG_START) { 470 fm801->rec_start = baseaddr; 471 fm801->rec_nextblk = fm801->rec_start + fm801->rec_blksize; 472 fm801->rec_flip = 0; 473 fm801_wr(fm801, FM_REC_DMALEN, fm801->rec_blksize - 1, 2); 474 fm801_wr(fm801, FM_REC_DMABUF1,fm801->rec_start,4); 475 fm801_wr(fm801, FM_REC_DMABUF2,fm801->rec_nextblk,4); 476 fm801_wr(fm801, FM_REC_CTL, 477 FM_REC_START | FM_REC_STOPNOW | fm801->rec_fmt | fm801->rec_shift, 478 2 ); 479 } else { 480 fm801->rec_flip = 0; 481 k1 = fm801_rd(fm801, FM_REC_CTL,2); 482 fm801_wr(fm801, FM_REC_CTL, 483 (k1 & ~(FM_REC_STOPNOW | FM_REC_START)) | 484 FM_REC_BUF1_LAST | FM_REC_BUF2_LAST, 2); 485 } 486 } 487 488 return 0; 489} 490 491/* Almost ALSA copy */ 492static int 493fm801ch_getptr(kobj_t obj, void *data) 494{ 495 struct fm801_chinfo *ch = data; 496 struct fm801_info *fm801 = ch->parent; 497 int result = 0; 498 snd_dbuf *b = ch->buffer; 499 500 if (ch->dir == PCMDIR_PLAY) { 501 result = fm801_rd(fm801, 502 (fm801->play_flip&1) ? 503 FM_PLAY_DMABUF2:FM_PLAY_DMABUF1, 4) - fm801->play_start; 504 } 505 506 if (ch->dir == PCMDIR_REC) { 507 result = fm801_rd(fm801, 508 (fm801->rec_flip&1) ? 509 FM_REC_DMABUF2:FM_REC_DMABUF1, 4) - fm801->rec_start; 510 } 511 512 DPRINT("fm801ch_getptr:%d, rp %d, rl %d, fp %d fl %d\n", 513 result, b->rp,b->rl, b->fp,b->fl); 514 515 return result; 516} 517 518static pcmchan_caps * 519fm801ch_getcaps(kobj_t obj, void *data) 520{ 521 return &fm801ch_caps; 522} 523 524static kobj_method_t fm801ch_methods[] = { 525 KOBJMETHOD(channel_init, fm801ch_init), 526 KOBJMETHOD(channel_setformat, fm801ch_setformat), 527 KOBJMETHOD(channel_setspeed, fm801ch_setspeed), 528 KOBJMETHOD(channel_setblocksize, fm801ch_setblocksize), 529 KOBJMETHOD(channel_trigger, fm801ch_trigger), 530 KOBJMETHOD(channel_getptr, fm801ch_getptr), 531 KOBJMETHOD(channel_getcaps, fm801ch_getcaps), 532 { 0, 0 } 533}; 534CHANNEL_DECLARE(fm801ch); 535 536/* -------------------------------------------------------------------- */ 537 538/* 539 * Init routine is taken from an original NetBSD driver 540 */ 541static int 542fm801_init(struct fm801_info *fm801) 543{ 544 u_int32_t k1; 545 546 /* reset codec */ 547 fm801_wr(fm801, FM_CODEC_CTL, 0x0020,2); 548 DELAY(100000); 549 fm801_wr(fm801, FM_CODEC_CTL, 0x0000,2); 550 DELAY(100000); 551 552 fm801_wr(fm801, FM_PCM_VOLUME, 0x0808,2); 553 fm801_wr(fm801, FM_FM_VOLUME, 0x0808,2); 554 fm801_wr(fm801, FM_I2S_VOLUME, 0x0808,2); 555 fm801_wr(fm801, 0x40,0x107f,2); /* enable legacy audio */ 556 557 fm801_wr((void *)fm801, FM_RECORD_SOURCE, 0x0000,2); 558 559 /* Unmask playback, record and mpu interrupts, mask the rest */ 560 k1 = fm801_rd((void *)fm801, FM_INTMASK,2); 561 fm801_wr(fm801, FM_INTMASK, 562 (k1 & ~(FM_INTMASK_PLAY | FM_INTMASK_REC | FM_INTMASK_MPU)) | 563 FM_INTMASK_VOL,2); 564 fm801_wr(fm801, FM_INTSTATUS, 565 FM_INTSTATUS_PLAY | FM_INTSTATUS_REC | FM_INTSTATUS_MPU | 566 FM_INTSTATUS_VOL,2); 567 568 DPRINT("FM801 init Ok\n"); 569 return 0; 570} 571 572static int 573fm801_pci_attach(device_t dev) 574{ 575 u_int32_t data; 576 struct ac97_info *codec = 0; 577 struct fm801_info *fm801; 578 int i; 579 int mapped = 0; 580 char status[SND_STATUSLEN]; 581 582 if ((fm801 = (struct fm801_info *)malloc(sizeof(*fm801),M_DEVBUF, M_NOWAIT)) == NULL) { 583 device_printf(dev, "cannot allocate softc\n"); 584 return ENXIO; 585 } 586 587 bzero(fm801, sizeof(*fm801)); 588 fm801->type = pci_get_devid(dev); 589 590 data = pci_read_config(dev, PCIR_COMMAND, 2); 591 data |= (PCIM_CMD_PORTEN|PCIM_CMD_MEMEN|PCIM_CMD_BUSMASTEREN); 592 pci_write_config(dev, PCIR_COMMAND, data, 2); 593 data = pci_read_config(dev, PCIR_COMMAND, 2); 594 595 for (i = 0; (mapped == 0) && (i < PCI_MAXMAPS_0); i++) { 596 fm801->regid = PCIR_MAPS + i*4; 597 fm801->regtype = SYS_RES_MEMORY; 598 fm801->reg = bus_alloc_resource(dev, fm801->regtype, &fm801->regid, 599 0, ~0, 1, RF_ACTIVE); 600 if(!fm801->reg) 601 { 602 fm801->regtype = SYS_RES_IOPORT; 603 fm801->reg = bus_alloc_resource(dev, fm801->regtype, &fm801->regid, 604 0, ~0, 1, RF_ACTIVE); 605 } 606 607 if(fm801->reg) { 608 fm801->st = rman_get_bustag(fm801->reg); 609 fm801->sh = rman_get_bushandle(fm801->reg); 610 mapped++; 611 } 612 } 613 614 if (mapped == 0) { 615 device_printf(dev, "unable to map register space\n"); 616 goto oops; 617 } 618 619 fm801_init(fm801); 620 621 codec = AC97_CREATE(dev, fm801, fm801_ac97); 622 if (codec == NULL) goto oops; 623 624 if (mixer_init(dev, ac97_getmixerclass(), codec) == -1) goto oops; 625 626 fm801->irqid = 0; 627 fm801->irq = bus_alloc_resource(dev, SYS_RES_IRQ, &fm801->irqid, 628 0, ~0, 1, RF_ACTIVE | RF_SHAREABLE); 629 if (!fm801->irq || 630 bus_setup_intr(dev, fm801->irq, INTR_TYPE_TTY, 631 fm801_intr, fm801, &fm801->ih)) { 632 device_printf(dev, "unable to map interrupt\n"); 633 goto oops; 634 } 635 636 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0, 637 /*lowaddr*/BUS_SPACE_MAXADDR_32BIT, 638 /*highaddr*/BUS_SPACE_MAXADDR, 639 /*filter*/NULL, /*filterarg*/NULL, 640 /*maxsize*/FM801_BUFFSIZE, /*nsegments*/1, /*maxsegz*/0x3ffff, 641 /*flags*/0, &fm801->parent_dmat) != 0) { 642 device_printf(dev, "unable to create dma tag\n"); 643 goto oops; 644 } 645 646 snprintf(status, 64, "at %s 0x%lx irq %ld", 647 (fm801->regtype == SYS_RES_IOPORT)? "io" : "memory", 648 rman_get_start(fm801->reg), rman_get_start(fm801->irq)); 649 650#define FM801_MAXPLAYCH 1 651 if (pcm_register(dev, fm801, FM801_MAXPLAYCH, 1)) goto oops; 652 pcm_addchan(dev, PCMDIR_PLAY, &fm801ch_class, fm801); 653 pcm_addchan(dev, PCMDIR_REC, &fm801ch_class, fm801); 654 pcm_setstatus(dev, status); 655 656 return 0; 657 658oops: 659 if (codec) ac97_destroy(codec); 660 if (fm801->reg) bus_release_resource(dev, fm801->regtype, fm801->regid, fm801->reg); 661 if (fm801->ih) bus_teardown_intr(dev, fm801->irq, fm801->ih); 662 if (fm801->irq) bus_release_resource(dev, SYS_RES_IRQ, fm801->irqid, fm801->irq); 663 if (fm801->parent_dmat) bus_dma_tag_destroy(fm801->parent_dmat); 664 free(fm801, M_DEVBUF); 665 return ENXIO; 666} 667 668static int 669fm801_pci_detach(device_t dev) 670{ 671 int r; 672 struct fm801_info *fm801; 673 674 DPRINT("Forte Media FM801 detach\n"); 675 676 r = pcm_unregister(dev); 677 if (r) 678 return r; 679 680 fm801 = pcm_getdevinfo(dev); 681 bus_release_resource(dev, fm801->regtype, fm801->regid, fm801->reg); 682 bus_teardown_intr(dev, fm801->irq, fm801->ih); 683 bus_release_resource(dev, SYS_RES_IRQ, fm801->irqid, fm801->irq); 684 bus_dma_tag_destroy(fm801->parent_dmat); 685 free(fm801, M_DEVBUF); 686 return 0; 687} 688 689static int 690fm801_pci_probe( device_t dev ) 691{ 692 int id; 693 if ((id = pci_get_devid(dev)) == PCI_DEVICE_FORTEMEDIA1 ) { 694 device_set_desc(dev, "Forte Media FM801 Audio Controller"); 695 return 0; 696 } 697/* 698 if ((id = pci_get_devid(dev)) == PCI_DEVICE_FORTEMEDIA2 ) { 699 device_set_desc(dev, "Forte Media FM801 Joystick (Not Supported)"); 700 return ENXIO; 701 } 702*/ 703 return ENXIO; 704} 705 706static device_method_t fm801_methods[] = { 707 /* Device interface */ 708 DEVMETHOD(device_probe, fm801_pci_probe), 709 DEVMETHOD(device_attach, fm801_pci_attach), 710 DEVMETHOD(device_detach, fm801_pci_detach), 711 { 0, 0} 712}; 713 714static driver_t fm801_driver = { 715 "pcm", 716 fm801_methods, 717 sizeof(snddev_info), 718}; 719 720static devclass_t pcm_devclass; 721 722DRIVER_MODULE(fm801, pci, fm801_driver, pcm_devclass, 0, 0); 723