btaudio.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:28k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.     btaudio - bt878 audio dma driver for linux 2.4.x
  3.     (c) 2000-2002 Gerd Knorr <kraxel@bytesex.org>
  4.     This program is free software; you can redistribute it and/or modify
  5.     it under the terms of the GNU General Public License as published by
  6.     the Free Software Foundation; either version 2 of the License, or
  7.     (at your option) any later version.
  8.     This program is distributed in the hope that it will be useful,
  9.     but WITHOUT ANY WARRANTY; without even the implied warranty of
  10.     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  11.     GNU General Public License for more details.
  12.     You should have received a copy of the GNU General Public License
  13.     along with this program; if not, write to the Free Software
  14.     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  15. */
  16. #include <linux/version.h>
  17. #include <linux/module.h>
  18. #include <linux/errno.h>
  19. #include <linux/pci.h>
  20. #include <linux/sched.h>
  21. #include <linux/signal.h>
  22. #include <linux/types.h>
  23. #include <linux/wrapper.h>
  24. #include <linux/interrupt.h>
  25. #include <linux/init.h>
  26. #include <linux/poll.h>
  27. #include <linux/sound.h>
  28. #include <linux/soundcard.h>
  29. #include <linux/slab.h>
  30. #include <linux/kdev_t.h>
  31. #include <asm/uaccess.h>
  32. #include <asm/io.h>
  33. /* mmio access */
  34. #define btwrite(dat,adr)    writel((dat), (bta->mmio+(adr)))
  35. #define btread(adr)         readl(bta->mmio+(adr))
  36. #define btand(dat,adr)      btwrite((dat) & btread(adr), adr)
  37. #define btor(dat,adr)       btwrite((dat) | btread(adr), adr)
  38. #define btaor(dat,mask,adr) btwrite((dat) | ((mask) & btread(adr)), adr)
  39. /* registers (shifted because bta->mmio is long) */
  40. #define REG_INT_STAT      (0x100 >> 2)
  41. #define REG_INT_MASK      (0x104 >> 2)
  42. #define REG_GPIO_DMA_CTL  (0x10c >> 2)
  43. #define REG_PACKET_LEN    (0x110 >> 2)
  44. #define REG_RISC_STRT_ADD (0x114 >> 2)
  45. #define REG_RISC_COUNT    (0x120 >> 2)
  46. /* IRQ bits - REG_INT_(STAT|MASK) */
  47. #define IRQ_SCERR         (1 << 19)
  48. #define IRQ_OCERR         (1 << 18)
  49. #define IRQ_PABORT        (1 << 17)
  50. #define IRQ_RIPERR        (1 << 16)
  51. #define IRQ_PPERR         (1 << 15)
  52. #define IRQ_FDSR          (1 << 14)
  53. #define IRQ_FTRGT         (1 << 13)
  54. #define IRQ_FBUS          (1 << 12)
  55. #define IRQ_RISCI         (1 << 11)
  56. #define IRQ_OFLOW         (1 <<  3)
  57. #define IRQ_BTAUDIO       (IRQ_SCERR | IRQ_OCERR | IRQ_PABORT | IRQ_RIPERR |
  58.    IRQ_PPERR | IRQ_FDSR  | IRQ_FTRGT  | IRQ_FBUS   |
  59.    IRQ_RISCI)
  60. /* REG_GPIO_DMA_CTL bits */
  61. #define DMA_CTL_A_PWRDN   (1 << 26)
  62. #define DMA_CTL_DA_SBR    (1 << 14)
  63. #define DMA_CTL_DA_ES2    (1 << 13)
  64. #define DMA_CTL_ACAP_EN   (1 <<  4)
  65. #define DMA_CTL_RISC_EN   (1 <<  1)
  66. #define DMA_CTL_FIFO_EN   (1 <<  0)
  67. /* RISC instructions */
  68. #define RISC_WRITE        (0x01 << 28)
  69. #define RISC_JUMP         (0x07 << 28)
  70. #define RISC_SYNC         (0x08 << 28)
  71. /* RISC bits */
  72. #define RISC_WR_SOL       (1 << 27)
  73. #define RISC_WR_EOL       (1 << 26)
  74. #define RISC_IRQ          (1 << 24)
  75. #define RISC_SYNC_RESYNC  (1 << 15)
  76. #define RISC_SYNC_FM1     0x06
  77. #define RISC_SYNC_VRO     0x0c
  78. #define HWBASE_AD (448000)
  79. /* -------------------------------------------------------------- */
  80. struct btaudio {
  81. /* linked list */
  82. struct btaudio *next;
  83. /* device info */
  84. int            dsp_digital;
  85. int            dsp_analog;
  86. int            mixer_dev;
  87. struct pci_dev *pci;
  88. unsigned int   irq;
  89. unsigned long  mem;
  90. unsigned long  *mmio;
  91. /* locking */
  92. int            users;
  93. struct semaphore lock;
  94. /* risc instructions */
  95. unsigned int   risc_size;
  96. unsigned long  *risc_cpu;
  97. dma_addr_t     risc_dma;
  98. /* audio data */
  99. unsigned int   buf_size;
  100. unsigned char  *buf_cpu;
  101. dma_addr_t     buf_dma;
  102. /* buffer setup */
  103. int line_bytes;
  104. int line_count;
  105. int block_bytes;
  106. int block_count;
  107. /* read fifo management */
  108. int recording;
  109. int dma_block;
  110. int read_offset;
  111. int read_count;
  112. wait_queue_head_t readq;
  113. /* settings */
  114. int gain[3];
  115. int source;
  116. int bits;
  117. int decimation;
  118. int mixcount;
  119. int sampleshift;
  120. int channels;
  121. int analog;
  122. int rate;
  123. };
  124. struct cardinfo {
  125. char *name;
  126. int rate;
  127. };
  128. static struct btaudio *btaudios = NULL;
  129. static unsigned int debug = 0;
  130. static unsigned int irq_debug = 0;
  131. /* -------------------------------------------------------------- */
  132. #define BUF_DEFAULT 128*1024
  133. #define BUF_MIN         8192
  134. static int alloc_buffer(struct btaudio *bta)
  135. {
  136. if (NULL == bta->buf_cpu) {
  137. for (bta->buf_size = BUF_DEFAULT; bta->buf_size >= BUF_MIN;
  138.      bta->buf_size = bta->buf_size >> 1) {
  139. bta->buf_cpu = pci_alloc_consistent
  140. (bta->pci, bta->buf_size, &bta->buf_dma);
  141. if (NULL != bta->buf_cpu)
  142. break;
  143. }
  144. if (NULL == bta->buf_cpu)
  145. return -ENOMEM;
  146. memset(bta->buf_cpu,0,bta->buf_size);
  147. }
  148. if (NULL == bta->risc_cpu) {
  149. bta->risc_size = PAGE_SIZE;
  150. bta->risc_cpu = pci_alloc_consistent
  151. (bta->pci, bta->risc_size, &bta->risc_dma);
  152. if (NULL == bta->risc_cpu)
  153. return -ENOMEM;
  154. }
  155. return 0;
  156. }
  157. static void free_buffer(struct btaudio *bta)
  158. {
  159. if (NULL != bta->buf_cpu) {
  160. pci_free_consistent(bta->pci, bta->buf_size,
  161.     bta->buf_cpu, bta->buf_dma);
  162. bta->buf_cpu = NULL;
  163. }
  164. if (NULL != bta->risc_cpu) {
  165. pci_free_consistent(bta->pci, bta->risc_size,
  166.     bta->risc_cpu, bta->risc_dma);
  167. bta->risc_cpu = NULL;
  168. }
  169. }
  170. static int make_risc(struct btaudio *bta)
  171. {
  172. int rp, bp, line, block;
  173. unsigned long risc;
  174. bta->block_bytes = bta->buf_size >> 4;
  175. bta->block_count = 1 << 4;
  176. bta->line_bytes  = bta->block_bytes;
  177. bta->line_count  = bta->block_count;
  178. while (bta->line_bytes > 4095) {
  179. bta->line_bytes >>= 1;
  180. bta->line_count <<= 1;
  181. }
  182. if (bta->line_count > 255)
  183. return -EINVAL;
  184. if (debug)
  185. printk(KERN_DEBUG
  186.        "btaudio: bufsize=%d - bs=%d bc=%d - ls=%d, lc=%dn",
  187.        bta->buf_size,bta->block_bytes,bta->block_count,
  188.        bta->line_bytes,bta->line_count);
  189.         rp = 0; bp = 0;
  190. block = 0;
  191. bta->risc_cpu[rp++] = cpu_to_le32(RISC_SYNC|RISC_SYNC_FM1);
  192. bta->risc_cpu[rp++] = cpu_to_le32(0);
  193. for (line = 0; line < bta->line_count; line++) {
  194. risc  = RISC_WRITE | RISC_WR_SOL | RISC_WR_EOL;
  195. risc |= bta->line_bytes;
  196. if (0 == (bp & (bta->block_bytes-1))) {
  197. risc |= RISC_IRQ;
  198. risc |= (block  & 0x0f) << 16;
  199. risc |= (~block & 0x0f) << 20;
  200. block++;
  201. }
  202. bta->risc_cpu[rp++] = cpu_to_le32(risc);
  203. bta->risc_cpu[rp++] = cpu_to_le32(bta->buf_dma + bp);
  204. bp += bta->line_bytes;
  205. }
  206. bta->risc_cpu[rp++] = cpu_to_le32(RISC_SYNC|RISC_SYNC_VRO);
  207. bta->risc_cpu[rp++] = cpu_to_le32(0);
  208. bta->risc_cpu[rp++] = cpu_to_le32(RISC_JUMP); 
  209. bta->risc_cpu[rp++] = cpu_to_le32(bta->risc_dma);
  210. return 0;
  211. }
  212. static int start_recording(struct btaudio *bta)
  213. {
  214. int ret;
  215. if (0 != (ret = alloc_buffer(bta)))
  216. return ret;
  217. if (0 != (ret = make_risc(bta)))
  218. return ret;
  219. btwrite(bta->risc_dma, REG_RISC_STRT_ADD);
  220. btwrite((bta->line_count << 16) | bta->line_bytes,
  221. REG_PACKET_LEN);
  222. btwrite(IRQ_BTAUDIO, REG_INT_MASK);
  223. if (bta->analog) {
  224. btwrite(DMA_CTL_ACAP_EN |
  225. DMA_CTL_RISC_EN |
  226. DMA_CTL_FIFO_EN |
  227. DMA_CTL_DA_ES2  |
  228. ((bta->bits == 8) ? DMA_CTL_DA_SBR : 0) |
  229. (bta->gain[bta->source] << 28) |
  230. (bta->source            << 24) |
  231. (bta->decimation        <<  8),
  232. REG_GPIO_DMA_CTL);
  233. } else {
  234. btwrite(DMA_CTL_ACAP_EN |
  235. DMA_CTL_RISC_EN |
  236. DMA_CTL_FIFO_EN |
  237. DMA_CTL_DA_ES2  |
  238. DMA_CTL_A_PWRDN |
  239. (1 << 6)   |
  240. ((bta->bits == 8) ? DMA_CTL_DA_SBR : 0) |
  241. (bta->gain[bta->source] << 28) |
  242. (bta->source            << 24) |
  243. (bta->decimation        <<  8),
  244. REG_GPIO_DMA_CTL);
  245. }
  246. bta->dma_block = 0;
  247. bta->read_offset = 0;
  248. bta->read_count = 0;
  249. bta->recording = 1;
  250. if (debug)
  251. printk(KERN_DEBUG "btaudio: recording startedn");
  252. return 0;
  253. }
  254. static void stop_recording(struct btaudio *bta)
  255. {
  256.         btand(~15, REG_GPIO_DMA_CTL);
  257. bta->recording = 0;
  258. if (debug)
  259. printk(KERN_DEBUG "btaudio: recording stoppedn");
  260. }
  261. /* -------------------------------------------------------------- */
  262. static int btaudio_mixer_open(struct inode *inode, struct file *file)
  263. {
  264. int minor = minor(inode->i_rdev);
  265. struct btaudio *bta;
  266. for (bta = btaudios; bta != NULL; bta = bta->next)
  267. if (bta->mixer_dev == minor)
  268. break;
  269. if (NULL == bta)
  270. return -ENODEV;
  271. if (debug)
  272. printk("btaudio: open mixer [%d]n",minor);
  273. file->private_data = bta;
  274. return 0;
  275. }
  276. static int btaudio_mixer_release(struct inode *inode, struct file *file)
  277. {
  278. return 0;
  279. }
  280. static int btaudio_mixer_ioctl(struct inode *inode, struct file *file,
  281.        unsigned int cmd, unsigned long arg)
  282. {
  283. struct btaudio *bta = file->private_data;
  284. int ret,val=0,i=0;
  285. if (cmd == SOUND_MIXER_INFO) {
  286. mixer_info info;
  287. memset(&info,0,sizeof(info));
  288.                 strncpy(info.id,"bt878",sizeof(info.id)-1);
  289.                 strncpy(info.name,"Brooktree Bt878 audio",sizeof(info.name)-1);
  290.                 info.modify_counter = bta->mixcount;
  291.                 if (copy_to_user((void *)arg, &info, sizeof(info)))
  292.                         return -EFAULT;
  293. return 0;
  294. }
  295. if (cmd == SOUND_OLD_MIXER_INFO) {
  296. _old_mixer_info info;
  297. memset(&info,0,sizeof(info));
  298.                 strncpy(info.id,"bt878",sizeof(info.id)-1);
  299.                 strncpy(info.name,"Brooktree Bt878 audio",sizeof(info.name)-1);
  300.                 if (copy_to_user((void *)arg, &info, sizeof(info)))
  301.                         return -EFAULT;
  302. return 0;
  303. }
  304. if (cmd == OSS_GETVERSION)
  305. return put_user(SOUND_VERSION, (int *)arg);
  306. /* read */
  307. if (_SIOC_DIR(cmd) & _SIOC_WRITE)
  308. if (get_user(val, (int *)arg))
  309. return -EFAULT;
  310. switch (cmd) {
  311. case MIXER_READ(SOUND_MIXER_CAPS):
  312. ret = SOUND_CAP_EXCL_INPUT;
  313. break;
  314. case MIXER_READ(SOUND_MIXER_STEREODEVS):
  315. ret = 0;
  316. break;
  317. case MIXER_READ(SOUND_MIXER_RECMASK):
  318. case MIXER_READ(SOUND_MIXER_DEVMASK):
  319. ret = SOUND_MASK_LINE1|SOUND_MASK_LINE2|SOUND_MASK_LINE3;
  320. break;
  321. case MIXER_WRITE(SOUND_MIXER_RECSRC):
  322. if (val & SOUND_MASK_LINE1 && bta->source != 0)
  323. bta->source = 0;
  324. else if (val & SOUND_MASK_LINE2 && bta->source != 1)
  325. bta->source = 1;
  326. else if (val & SOUND_MASK_LINE3 && bta->source != 2)
  327. bta->source = 2;
  328. btaor((bta->gain[bta->source] << 28) |
  329.       (bta->source            << 24),
  330.       0x0cffffff, REG_GPIO_DMA_CTL);
  331. case MIXER_READ(SOUND_MIXER_RECSRC):
  332. switch (bta->source) {
  333. case 0:  ret = SOUND_MASK_LINE1; break;
  334. case 1:  ret = SOUND_MASK_LINE2; break;
  335. case 2:  ret = SOUND_MASK_LINE3; break;
  336. default: ret = 0;
  337. }
  338. break;
  339. case MIXER_WRITE(SOUND_MIXER_LINE1):
  340. case MIXER_WRITE(SOUND_MIXER_LINE2):
  341. case MIXER_WRITE(SOUND_MIXER_LINE3):
  342. if (MIXER_WRITE(SOUND_MIXER_LINE1) == cmd)
  343. i = 0;
  344. if (MIXER_WRITE(SOUND_MIXER_LINE2) == cmd)
  345. i = 1;
  346. if (MIXER_WRITE(SOUND_MIXER_LINE3) == cmd)
  347. i = 2;
  348. bta->gain[i] = (val & 0xff) * 15 / 100;
  349. if (bta->gain[i] > 15) bta->gain[i] = 15;
  350. if (bta->gain[i] <  0) bta->gain[i] =  0;
  351. if (i == bta->source)
  352. btaor((bta->gain[bta->source]<<28),
  353.       0x0fffffff, REG_GPIO_DMA_CTL);
  354. ret  = bta->gain[i] * 100 / 15;
  355. ret |= ret << 8;
  356. break;
  357. case MIXER_READ(SOUND_MIXER_LINE1):
  358. case MIXER_READ(SOUND_MIXER_LINE2):
  359. case MIXER_READ(SOUND_MIXER_LINE3):
  360. if (MIXER_READ(SOUND_MIXER_LINE1) == cmd)
  361. i = 0;
  362. if (MIXER_READ(SOUND_MIXER_LINE2) == cmd)
  363. i = 1;
  364. if (MIXER_READ(SOUND_MIXER_LINE3) == cmd)
  365. i = 2;
  366. ret  = bta->gain[i] * 100 / 15;
  367. ret |= ret << 8;
  368. break;
  369. default:
  370. return -EINVAL;
  371. }
  372. if (put_user(ret, (int *)arg))
  373. return -EFAULT;
  374. return 0;
  375. }
  376. static struct file_operations btaudio_mixer_fops = {
  377. owner:   THIS_MODULE,
  378. llseek:  no_llseek,
  379. open:    btaudio_mixer_open,
  380. release: btaudio_mixer_release,
  381. ioctl:   btaudio_mixer_ioctl,
  382. };
  383. /* -------------------------------------------------------------- */
  384. static int btaudio_dsp_open(struct inode *inode, struct file *file,
  385.     struct btaudio *bta, int analog)
  386. {
  387. down(&bta->lock);
  388. if (bta->users)
  389. goto busy;
  390. bta->users++;
  391. file->private_data = bta;
  392. bta->analog = analog;
  393. bta->dma_block = 0;
  394. bta->read_offset = 0;
  395. bta->read_count = 0;
  396. bta->sampleshift = 0;
  397. up(&bta->lock);
  398. return 0;
  399.  busy:
  400. up(&bta->lock);
  401. return -EBUSY;
  402. }
  403. static int btaudio_dsp_open_digital(struct inode *inode, struct file *file)
  404. {
  405. int minor = minor(inode->i_rdev);
  406. struct btaudio *bta;
  407. for (bta = btaudios; bta != NULL; bta = bta->next)
  408. if (bta->dsp_digital == minor)
  409. break;
  410. if (NULL == bta)
  411. return -ENODEV;
  412. if (debug)
  413. printk("btaudio: open digital dsp [%d]n",minor);
  414. return btaudio_dsp_open(inode,file,bta,0);
  415. }
  416. static int btaudio_dsp_open_analog(struct inode *inode, struct file *file)
  417. {
  418. int minor = minor(inode->i_rdev);
  419. struct btaudio *bta;
  420. for (bta = btaudios; bta != NULL; bta = bta->next)
  421. if (bta->dsp_analog == minor)
  422. break;
  423. if (NULL == bta)
  424. return -ENODEV;
  425. if (debug)
  426. printk("btaudio: open analog dsp [%d]n",minor);
  427. return btaudio_dsp_open(inode,file,bta,1);
  428. }
  429. static int btaudio_dsp_release(struct inode *inode, struct file *file)
  430. {
  431. struct btaudio *bta = file->private_data;
  432. down(&bta->lock);
  433. if (bta->recording)
  434. stop_recording(bta);
  435. bta->users--;
  436. up(&bta->lock);
  437. return 0;
  438. }
  439. static ssize_t btaudio_dsp_read(struct file *file, char *buffer,
  440. size_t swcount, loff_t *ppos)
  441. {
  442. struct btaudio *bta = file->private_data;
  443. int hwcount = swcount << bta->sampleshift;
  444. int nsrc, ndst, err, ret = 0;
  445. DECLARE_WAITQUEUE(wait, current);
  446. add_wait_queue(&bta->readq, &wait);
  447. down(&bta->lock);
  448. while (swcount > 0) {
  449. if (0 == bta->read_count) {
  450. if (!bta->recording) {
  451. if (0 != (err = start_recording(bta))) {
  452. if (0 == ret)
  453. ret = err;
  454. break;
  455. }
  456. }
  457. if (file->f_flags & O_NONBLOCK) {
  458. if (0 == ret)
  459. ret = -EAGAIN;
  460. break;
  461. }
  462. up(&bta->lock);
  463. current->state = TASK_INTERRUPTIBLE;
  464. schedule();
  465. down(&bta->lock);
  466. if(signal_pending(current)) {
  467. if (0 == ret)
  468. ret = -EINTR;
  469. break;
  470. }
  471. }
  472. nsrc = (bta->read_count < hwcount) ? bta->read_count : hwcount;
  473. if (nsrc > bta->buf_size - bta->read_offset)
  474. nsrc = bta->buf_size - bta->read_offset;
  475. ndst = nsrc >> bta->sampleshift;
  476. if ((bta->analog  && 0 == bta->sampleshift) ||
  477.     (!bta->analog && 2 == bta->channels)) {
  478. /* just copy */
  479. if (copy_to_user(buffer + ret, bta->buf_cpu + bta->read_offset, nsrc)) {
  480. if (0 == ret)
  481. ret = -EFAULT;
  482. break;
  483. }
  484. } else if (!bta->analog) {
  485. /* stereo => mono (digital audio) */
  486. __s16 *src = (__s16*)(bta->buf_cpu + bta->read_offset);
  487. __s16 *dst = (__s16*)(buffer + ret);
  488. __s16 avg;
  489. int n = ndst>>1;
  490. if (0 != verify_area(VERIFY_WRITE,dst,ndst)) {
  491. if (0 == ret)
  492. ret = -EFAULT;
  493. break;
  494. }
  495. for (; n; n--, dst++) {
  496. avg  = (__s16)le16_to_cpu(*src) / 2; src++;
  497. avg += (__s16)le16_to_cpu(*src) / 2; src++;
  498. __put_user(cpu_to_le16(avg),(__u16*)(dst));
  499. }
  500. } else if (8 == bta->bits) {
  501. /* copy + byte downsampling (audio A/D) */
  502. __u8 *src = bta->buf_cpu + bta->read_offset;
  503. __u8 *dst = buffer + ret;
  504. int n = ndst;
  505. if (0 != verify_area(VERIFY_WRITE,dst,ndst)) {
  506. if (0 == ret)
  507. ret = -EFAULT;
  508. break;
  509. }
  510. for (; n; n--, src += (1 << bta->sampleshift), dst++)
  511. __put_user(*src,(__u8*)(dst));
  512. } else {
  513. /* copy + word downsampling (audio A/D) */
  514. __u16 *src = (__u16*)(bta->buf_cpu + bta->read_offset);
  515. __u16 *dst = (__u16*)(buffer + ret);
  516. int n = ndst>>1;
  517. if (0 != verify_area(VERIFY_WRITE,dst,ndst)) {
  518. if (0 == ret)
  519. ret = -EFAULT;
  520. break;
  521. }
  522. for (; n; n--, src += (1 << bta->sampleshift), dst++)
  523. __put_user(*src,(__u16*)(dst));
  524. }
  525. ret     += ndst;
  526. swcount -= ndst;
  527. hwcount -= nsrc;
  528. bta->read_count  -= nsrc;
  529. bta->read_offset += nsrc;
  530. if (bta->read_offset == bta->buf_size)
  531. bta->read_offset = 0;
  532. }
  533. up(&bta->lock);
  534. remove_wait_queue(&bta->readq, &wait);
  535. current->state = TASK_RUNNING;
  536. return ret;
  537. }
  538. static ssize_t btaudio_dsp_write(struct file *file, const char *buffer,
  539.  size_t count, loff_t *ppos)
  540. {
  541. return -EINVAL;
  542. }
  543. static int btaudio_dsp_ioctl(struct inode *inode, struct file *file,
  544.      unsigned int cmd, unsigned long arg)
  545. {
  546. struct btaudio *bta = file->private_data;
  547. int s, i, ret, val = 0;
  548.         switch (cmd) {
  549.         case OSS_GETVERSION:
  550.                 return put_user(SOUND_VERSION, (int *)arg);
  551.         case SNDCTL_DSP_GETCAPS:
  552. return 0;
  553.         case SNDCTL_DSP_SPEED:
  554. if (get_user(val, (int*)arg))
  555. return -EFAULT;
  556. if (bta->analog) {
  557. for (s = 0; s < 16; s++)
  558. if (val << s >= HWBASE_AD*4/15)
  559. break;
  560. for (i = 15; i >= 5; i--)
  561. if (val << s <= HWBASE_AD*4/i)
  562. break;
  563. bta->sampleshift = s;
  564. bta->decimation  = i;
  565. if (debug)
  566. printk(KERN_DEBUG "btaudio: rate: req=%d  "
  567.        "dec=%d shift=%d hwrate=%d swrate=%dn",
  568.        val,i,s,(HWBASE_AD*4/i),(HWBASE_AD*4/i)>>s);
  569. } else {
  570. bta->sampleshift = (bta->channels == 2) ? 0 : 1;
  571. bta->decimation  = 0;
  572. }
  573. if (bta->recording) {
  574. down(&bta->lock);
  575. stop_recording(bta);
  576. start_recording(bta);
  577. up(&bta->lock);
  578. }
  579. /* fall through */
  580.         case SOUND_PCM_READ_RATE:
  581. if (bta->analog) {
  582. return put_user(HWBASE_AD*4/bta->decimation>>bta->sampleshift, (int*)arg);
  583. } else {
  584. return put_user(bta->rate, (int*)arg);
  585. }
  586.         case SNDCTL_DSP_STEREO:
  587. if (!bta->analog) {
  588. if (get_user(val, (int*)arg))
  589. return -EFAULT;
  590. bta->channels    = (val > 0) ? 2 : 1;
  591. bta->sampleshift = (bta->channels == 2) ? 0 : 1;
  592. if (debug)
  593. printk(KERN_INFO
  594.        "btaudio: stereo=%d channels=%dn",
  595.        val,bta->channels);
  596. } else {
  597. if (val == 1)
  598. return -EFAULT;
  599. else {
  600. bta->channels = 1;
  601. if (debug)
  602. printk(KERN_INFO
  603.        "btaudio: stereo=0 channels=1n");
  604. }
  605. }
  606. return put_user((bta->channels)-1, (int *)arg);
  607.         case SNDCTL_DSP_CHANNELS:
  608. if (!bta->analog) {
  609. if (get_user(val, (int*)arg))
  610. return -EFAULT;
  611. bta->channels    = (val > 1) ? 2 : 1;
  612. bta->sampleshift = (bta->channels == 2) ? 0 : 1;
  613. if (debug)
  614. printk(KERN_DEBUG
  615.        "btaudio: val=%d channels=%dn",
  616.        val,bta->channels);
  617. }
  618. /* fall through */
  619.         case SOUND_PCM_READ_CHANNELS:
  620. return put_user(bta->channels, (int *)arg);
  621.         case SNDCTL_DSP_GETFMTS: /* Returns a mask */
  622. if (bta->analog)
  623. return put_user(AFMT_S16_LE|AFMT_S8, (int*)arg);
  624. else
  625. return put_user(AFMT_S16_LE, (int*)arg);
  626.         case SNDCTL_DSP_SETFMT: /* Selects ONE fmt*/
  627. if (get_user(val, (int*)arg))
  628. return -EFAULT;
  629.                 if (val != AFMT_QUERY) {
  630. if (bta->analog)
  631. bta->bits = (val == AFMT_S8) ? 8 : 16;
  632. else
  633. bta->bits = 16;
  634. if (bta->recording) {
  635. down(&bta->lock);
  636. stop_recording(bta);
  637. start_recording(bta);
  638. up(&bta->lock);
  639. }
  640. }
  641. if (debug)
  642. printk(KERN_DEBUG "btaudio: fmt: bits=%dn",bta->bits);
  643.                 return put_user((bta->bits==16) ? AFMT_S16_LE : AFMT_S8,
  644. (int*)arg);
  645. break;
  646.         case SOUND_PCM_READ_BITS:
  647. return put_user(bta->bits, (int*)arg);
  648.         case SNDCTL_DSP_NONBLOCK:
  649.                 file->f_flags |= O_NONBLOCK;
  650.                 return 0;
  651.         case SNDCTL_DSP_RESET:
  652. if (bta->recording) {
  653. down(&bta->lock);
  654. stop_recording(bta);
  655. up(&bta->lock);
  656. }
  657. return 0;
  658.         case SNDCTL_DSP_GETBLKSIZE:
  659. if (!bta->recording) {
  660. if (0 != (ret = alloc_buffer(bta)))
  661. return ret;
  662. if (0 != (ret = make_risc(bta)))
  663. return ret;
  664. }
  665. return put_user(bta->block_bytes>>bta->sampleshift,(int*)arg);
  666.         case SNDCTL_DSP_SYNC:
  667. /* NOP */
  668. return 0;
  669. case SNDCTL_DSP_GETISPACE:
  670. {
  671. audio_buf_info info;
  672. if (!bta->recording)
  673. return -EINVAL;
  674. info.fragsize = bta->block_bytes>>bta->sampleshift;
  675. info.fragstotal = bta->block_count;
  676. info.bytes = bta->read_count;
  677. info.fragments = info.bytes / info.fragsize;
  678. if (debug)
  679. printk(KERN_DEBUG "btaudio: SNDCTL_DSP_GETISPACE "
  680.        "returns %d/%d/%d/%dn",
  681.        info.fragsize, info.fragstotal,
  682.        info.bytes, info.fragments);
  683. if (copy_to_user((void *)arg, &info, sizeof(info)))
  684. return -EFAULT;
  685. return 0;
  686. }
  687. #if 0 /* TODO */
  688.         case SNDCTL_DSP_GETTRIGGER:
  689.         case SNDCTL_DSP_SETTRIGGER:
  690.         case SNDCTL_DSP_SETFRAGMENT:
  691. #endif
  692. default:
  693. return -EINVAL;
  694. }
  695. }
  696. static unsigned int btaudio_dsp_poll(struct file *file, struct poll_table_struct *wait)
  697. {
  698. struct btaudio *bta = file->private_data;
  699. unsigned int mask = 0;
  700. poll_wait(file, &bta->readq, wait);
  701. if (0 != bta->read_count)
  702. mask |= (POLLIN | POLLRDNORM);
  703. return mask;
  704. }
  705. static struct file_operations btaudio_digital_dsp_fops = {
  706. owner:   THIS_MODULE,
  707. llseek:  no_llseek,
  708. open:    btaudio_dsp_open_digital,
  709. release: btaudio_dsp_release,
  710. read:    btaudio_dsp_read,
  711. write:   btaudio_dsp_write,
  712. ioctl:   btaudio_dsp_ioctl,
  713. poll:    btaudio_dsp_poll,
  714. };
  715. static struct file_operations btaudio_analog_dsp_fops = {
  716. owner:   THIS_MODULE,
  717. llseek:  no_llseek,
  718. open:    btaudio_dsp_open_analog,
  719. release: btaudio_dsp_release,
  720. read:    btaudio_dsp_read,
  721. write:   btaudio_dsp_write,
  722. ioctl:   btaudio_dsp_ioctl,
  723. poll:    btaudio_dsp_poll,
  724. };
  725. /* -------------------------------------------------------------- */
  726. static char *irq_name[] = { "", "", "", "OFLOW", "", "", "", "", "", "", "",
  727.     "RISCI", "FBUS", "FTRGT", "FDSR", "PPERR",
  728.     "RIPERR", "PABORT", "OCERR", "SCERR" };
  729. static void btaudio_irq(int irq, void *dev_id, struct pt_regs * regs)
  730. {
  731. int count = 0;
  732. u32 stat,astat;
  733. struct btaudio *bta = dev_id;
  734. for (;;) {
  735. count++;
  736. stat  = btread(REG_INT_STAT);
  737. astat = stat & btread(REG_INT_MASK);
  738. if (!astat)
  739. return;
  740. btwrite(astat,REG_INT_STAT);
  741. if (irq_debug) {
  742. int i;
  743. printk(KERN_DEBUG "btaudio: irq loop=%d risc=%x, bits:",
  744.        count, stat>>28);
  745. for (i = 0; i < (sizeof(irq_name)/sizeof(char*)); i++) {
  746. if (stat & (1 << i))
  747. printk(" %s",irq_name[i]);
  748. if (astat & (1 << i))
  749. printk("*");
  750. }
  751. printk("n");
  752. }
  753. if (stat & IRQ_RISCI) {
  754. int blocks;
  755. blocks = (stat >> 28) - bta->dma_block;
  756. if (blocks < 0)
  757. blocks += bta->block_count;
  758. bta->dma_block = stat >> 28;
  759. if (bta->read_count + 2*bta->block_bytes > bta->buf_size) {
  760. stop_recording(bta);
  761. printk(KERN_INFO "btaudio: buffer overrunn");
  762. }
  763. if (blocks > 0) {
  764. bta->read_count += blocks * bta->block_bytes;
  765. wake_up_interruptible(&bta->readq);
  766. }
  767. }
  768. if (count > 10) {
  769. printk(KERN_WARNING
  770.        "btaudio: Oops - irq mask clearedn");
  771. btwrite(0, REG_INT_MASK);
  772. }
  773. }
  774. return;
  775. }
  776. /* -------------------------------------------------------------- */
  777. static unsigned int dsp1 = -1;
  778. static unsigned int dsp2 = -1;
  779. static unsigned int mixer = -1;
  780. static int latency = -1;
  781. static int digital = 1;
  782. static int analog = 1;
  783. static int rate = 0;
  784. #define BTA_OSPREY200 1
  785. static struct cardinfo cards[] = {
  786. [0] = {
  787. name: "default",
  788. rate: 32000,
  789. },
  790. [BTA_OSPREY200] = {
  791. name: "Osprey 200",
  792. rate: 44100,
  793. },
  794. };
  795. static int __devinit btaudio_probe(struct pci_dev *pci_dev,
  796.    const struct pci_device_id *pci_id)
  797. {
  798. struct btaudio *bta;
  799. struct cardinfo *card = &cards[pci_id->driver_data];
  800. unsigned char revision,lat;
  801. int rc = -EBUSY;
  802. if (pci_enable_device(pci_dev))
  803. return -EIO;
  804. if (!request_mem_region(pci_resource_start(pci_dev,0),
  805. pci_resource_len(pci_dev,0),
  806. "btaudio")) {
  807. return -EBUSY;
  808. }
  809. bta = kmalloc(sizeof(*bta),GFP_ATOMIC);
  810. if (!bta) {
  811. rc = -ENOMEM;
  812. goto fail0;
  813. }
  814. memset(bta,0,sizeof(*bta));
  815. bta->pci  = pci_dev;
  816. bta->irq  = pci_dev->irq;
  817. bta->mem  = pci_resource_start(pci_dev,0);
  818. bta->mmio = ioremap(pci_resource_start(pci_dev,0),
  819.     pci_resource_len(pci_dev,0));
  820. bta->source     = 1;
  821. bta->bits       = 8;
  822. bta->channels   = 1;
  823. if (bta->analog) {
  824. bta->decimation  = 15;
  825. } else {
  826. bta->decimation  = 0;
  827. bta->sampleshift = 1;
  828. }
  829. /* sample rate */
  830. bta->rate = card->rate;
  831. if (rate)
  832. bta->rate = rate;
  833. init_MUTEX(&bta->lock);
  834.         init_waitqueue_head(&bta->readq);
  835. if (-1 != latency) {
  836. printk(KERN_INFO "btaudio: setting pci latency timer to %dn",
  837.        latency);
  838. pci_write_config_byte(pci_dev, PCI_LATENCY_TIMER, latency);
  839. }
  840.         pci_read_config_byte(pci_dev, PCI_CLASS_REVISION, &revision);
  841.         pci_read_config_byte(pci_dev, PCI_LATENCY_TIMER, &lat);
  842.         printk(KERN_INFO "btaudio: Bt%x (rev %d) at %02x:%02x.%x, ",
  843.        pci_dev->device,revision,pci_dev->bus->number,
  844.        PCI_SLOT(pci_dev->devfn),PCI_FUNC(pci_dev->devfn));
  845.         printk("irq: %d, latency: %d, mmio: 0x%lxn",
  846.        bta->irq, lat, bta->mem);
  847. printk("btaudio: using card config "%s"n", card->name);
  848. /* init hw */
  849.         btwrite(0, REG_GPIO_DMA_CTL);
  850.         btwrite(0, REG_INT_MASK);
  851.         btwrite(~0x0UL, REG_INT_STAT);
  852. pci_set_master(pci_dev);
  853. if ((rc = request_irq(bta->irq, btaudio_irq, SA_SHIRQ|SA_INTERRUPT,
  854.       "btaudio",(void *)bta)) < 0) {
  855. printk(KERN_WARNING
  856.        "btaudio: can't request irq (rc=%d)n",rc);
  857. goto fail1;
  858. }
  859. /* register devices */
  860. if (digital) {
  861. rc = bta->dsp_digital =
  862. register_sound_dsp(&btaudio_digital_dsp_fops,dsp1);
  863. if (rc < 0) {
  864. printk(KERN_WARNING
  865.        "btaudio: can't register digital dsp (rc=%d)n",rc);
  866. goto fail2;
  867. }
  868. printk(KERN_INFO "btaudio: registered device dsp%d [digital]n",
  869.        bta->dsp_digital >> 4);
  870. }
  871. if (analog) {
  872. rc = bta->dsp_analog =
  873. register_sound_dsp(&btaudio_analog_dsp_fops,dsp2);
  874. if (rc < 0) {
  875. printk(KERN_WARNING
  876.        "btaudio: can't register analog dsp (rc=%d)n",rc);
  877. goto fail3;
  878. }
  879. printk(KERN_INFO "btaudio: registered device dsp%d [analog]n",
  880.        bta->dsp_analog >> 4);
  881. rc = bta->mixer_dev = register_sound_mixer(&btaudio_mixer_fops,mixer);
  882. if (rc < 0) {
  883. printk(KERN_WARNING
  884.        "btaudio: can't register mixer (rc=%d)n",rc);
  885. goto fail4;
  886. }
  887. printk(KERN_INFO "btaudio: registered device mixer%dn",
  888.        bta->mixer_dev >> 4);
  889. }
  890. /* hook into linked list */
  891. bta->next = btaudios;
  892. btaudios = bta;
  893. pci_set_drvdata(pci_dev,bta);
  894.         return 0;
  895.  fail4:
  896. unregister_sound_dsp(bta->dsp_analog);
  897.  fail3:
  898. if (digital)
  899. unregister_sound_dsp(bta->dsp_digital);
  900.  fail2:
  901.         free_irq(bta->irq,bta);
  902.  fail1:
  903. kfree(bta);
  904.  fail0:
  905. release_mem_region(pci_resource_start(pci_dev,0),
  906.    pci_resource_len(pci_dev,0));
  907. return rc;
  908. }
  909. static void __devexit btaudio_remove(struct pci_dev *pci_dev)
  910. {
  911. struct btaudio *bta = pci_get_drvdata(pci_dev);
  912. struct btaudio *walk;
  913. /* turn off all DMA / IRQs */
  914.         btand(~15, REG_GPIO_DMA_CTL);
  915.         btwrite(0, REG_INT_MASK);
  916.         btwrite(~0x0UL, REG_INT_STAT);
  917. /* unregister devices */
  918. if (digital) {
  919. unregister_sound_dsp(bta->dsp_digital);
  920. }
  921. if (analog) {
  922. unregister_sound_dsp(bta->dsp_analog);
  923. unregister_sound_mixer(bta->mixer_dev);
  924. }
  925. /* free resources */
  926. free_buffer(bta);
  927.         free_irq(bta->irq,bta);
  928. release_mem_region(pci_resource_start(pci_dev,0),
  929.    pci_resource_len(pci_dev,0));
  930. /* remove from linked list */
  931. if (bta == btaudios) {
  932. btaudios = NULL;
  933. } else {
  934. for (walk = btaudios; walk->next != bta; walk = walk->next)
  935. ; /* if (NULL == walk->next) BUG(); */
  936. walk->next = bta->next;
  937. }
  938. pci_set_drvdata(pci_dev, NULL);
  939. kfree(bta);
  940. return;
  941. }
  942. /* -------------------------------------------------------------- */
  943. static struct pci_device_id btaudio_pci_tbl[] __devinitdata = {
  944.         {
  945. vendor:       PCI_VENDOR_ID_BROOKTREE,
  946. device:       0x0878,
  947. subvendor:    0x0070,
  948. subdevice:    0xff01,
  949. driver_data:  BTA_OSPREY200,
  950. },{
  951. vendor:       PCI_VENDOR_ID_BROOKTREE,
  952. device:       0x0878,
  953. subvendor:    PCI_ANY_ID,
  954. subdevice:    PCI_ANY_ID,
  955. },{
  956. vendor:       PCI_VENDOR_ID_BROOKTREE,
  957. device:       0x0878,
  958. subvendor:    PCI_ANY_ID,
  959. subdevice:    PCI_ANY_ID,
  960.         },{
  961. /* --- end of list --- */
  962. }
  963. };
  964. static struct pci_driver btaudio_pci_driver = {
  965.         name:     "btaudio",
  966.         id_table: btaudio_pci_tbl,
  967.         probe:    btaudio_probe,
  968.         remove:   __devexit_p(btaudio_remove),
  969. };
  970. static int btaudio_init_module(void)
  971. {
  972. printk(KERN_INFO "btaudio: driver version 0.7 loaded [%s%s%s]n",
  973.        digital ? "digital" : "",
  974.        analog && digital ? "+" : "",
  975.        analog ? "analog" : "");
  976. return pci_module_init(&btaudio_pci_driver);
  977. }
  978. static void btaudio_cleanup_module(void)
  979. {
  980. pci_unregister_driver(&btaudio_pci_driver);
  981. return;
  982. }
  983. module_init(btaudio_init_module);
  984. module_exit(btaudio_cleanup_module);
  985. MODULE_PARM(dsp1,"i");
  986. MODULE_PARM(dsp2,"i");
  987. MODULE_PARM(mixer,"i");
  988. MODULE_PARM(debug,"i");
  989. MODULE_PARM(irq_debug,"i");
  990. MODULE_PARM(digital,"i");
  991. MODULE_PARM(analog,"i");
  992. MODULE_PARM(rate,"i");
  993. MODULE_PARM(latency,"i");
  994. MODULE_PARM_DESC(latency,"pci latency timer");
  995. MODULE_DEVICE_TABLE(pci, btaudio_pci_tbl);
  996. MODULE_DESCRIPTION("bt878 audio dma driver");
  997. MODULE_AUTHOR("Gerd Knorr");
  998. MODULE_LICENSE("GPL");
  999. /*
  1000.  * Local variables:
  1001.  * c-basic-offset: 8
  1002.  * End:
  1003.  */