开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
ymfpci.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：73k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

ymfpci.c：源码内容
  1. /*
  2.  *  Copyright 1999 Jaroslav Kysela <perex@suse.cz>
  3.  *  Copyright 2000 Alan Cox <alan@redhat.com>
  4.  *
  5.  *  Yamaha YMF7xx driver.
  6.  *
  7.  *  This code is a result of high-speed collision
  8.  *  between ymfpci.c of ALSA and cs46xx.c of Linux.
  9.  *  -- Pete Zaitcev <zaitcev@yahoo.com>; 2000/09/18
  10.  *
  11.  *   This program is free software; you can redistribute it and/or modify
  12.  *   it under the terms of the GNU General Public License as published by
  13.  *   the Free Software Foundation; either version 2 of the License, or
  14.  *   (at your option) any later version.
  15.  *
  16.  *   This program is distributed in the hope that it will be useful,
  17.  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
  18.  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19.  *   GNU General Public License for more details.
  20.  *
  21.  *   You should have received a copy of the GNU General Public License
  22.  *   along with this program; if not, write to the Free Software
  23.  *   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  24.  *
  25.  * TODO:
  26.  *  - Use P44Slot for 44.1 playback (beware of idle buzzing in P44Slot).
  27.  *  - 96KHz playback for DVD - use pitch of 2.0.
  28.  *  - Retain DMA buffer on close, do not wait the end of frame.
  29.  *  - Resolve XXX tagged questions.
  30.  *  - Cannot play 5133Hz.
  31.  *  - 2001/01/07 Consider if we can remove voice_lock, like so:
  32.  *     : Allocate/deallocate voices in open/close under semafore.
  33.  *     : We access voices in interrupt, that only for pcms that open.
  34.  *    voice_lock around playback_prepare closes interrupts for insane duration.
  35.  *  - Revisit the way voice_alloc is done - too confusing, overcomplicated.
  36.  *    Should support various channel types, however.
  37.  *  - Remove prog_dmabuf from read/write, leave it in open.
  38.  *  - 2001/01/07 Replace the OPL3 part of CONFIG_SOUND_YMFPCI_LEGACY code with
  39.  *    native synthesizer through a playback slot.
  40.  *  - Use new 2.3.x cache coherent PCI DMA routines instead of virt_to_bus.
  41.  *  - Make the thing big endian compatible. ALSA has it done.
  42.  *  - 2001/11/29 ac97_save_state
  43.  */
  45. #include <linux/config.h>
  46. #include <linux/module.h>
  47. #include <linux/init.h>
  48. #include <linux/ioport.h>
  49. #include <linux/delay.h>
  50. #include <linux/pci.h>
  51. #include <linux/slab.h>
  52. #include <linux/poll.h>
  53. #include <linux/soundcard.h>
  54. #include <linux/ac97_codec.h>
  55. #include <linux/sound.h>
  57. #include <asm/io.h>
  58. #include <asm/dma.h>
  59. #include <asm/uaccess.h>
  61. #ifdef CONFIG_SOUND_YMFPCI_LEGACY
  62. # include "sound_config.h"
  63. # include "mpu401.h"
  64. #endif
  65. #include "ymfpci.h"
  67. /*
  68.  * I do not believe in debug levels as I never can guess what
  69.  * part of the code is going to be problematic in the future.
  70.  * Don't forget to run your klogd with -c 8.
  71.  *
  72.  * Example (do not remove):
  73.  * #define YMFDBG(fmt, arg...)  do{ printk(KERN_DEBUG fmt, ##arg); }while(0)
  74.  */
  75. #define YMFDBGW(fmt, arg...)  /* */ /* write counts */
  76. #define YMFDBGI(fmt, arg...)  /* */ /* interrupts */
  77. #define YMFDBGX(fmt, arg...)  /* */ /* ioctl */
  79. static int ymf_playback_trigger(ymfpci_t *unit, struct ymf_pcm *ypcm, int cmd);
  80. static void ymf_capture_trigger(ymfpci_t *unit, struct ymf_pcm *ypcm, int cmd);
  81. static void ymfpci_voice_free(ymfpci_t *unit, ymfpci_voice_t *pvoice);
  82. static int ymf_capture_alloc(struct ymf_unit *unit, int *pbank);
  83. static int ymf_playback_prepare(struct ymf_state *state);
  84. static int ymf_capture_prepare(struct ymf_state *state);
  85. static struct ymf_state *ymf_state_alloc(ymfpci_t *unit);
  87. static void ymfpci_aclink_reset(struct pci_dev * pci);
  88. static void ymfpci_disable_dsp(ymfpci_t *unit);
  89. static void ymfpci_download_image(ymfpci_t *codec);
  90. static void ymf_memload(ymfpci_t *unit);
  92. static LIST_HEAD(ymf_devs);
  94. /*
  95.  *  constants
  96.  */
  98. static struct pci_device_id ymf_id_tbl[] __devinitdata = {
  99. #define DEV(v, d, data) 
  100.   { PCI_VENDOR_ID_##v, PCI_DEVICE_ID_##v##_##d, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (unsigned long)data }
  101. DEV (YAMAHA, 724,  "YMF724"),
  102. DEV (YAMAHA, 724F, "YMF724F"),
  103. DEV (YAMAHA, 740,  "YMF740"),
  104. DEV (YAMAHA, 740C, "YMF740C"),
  105. DEV (YAMAHA, 744,  "YMF744"),
  106. DEV (YAMAHA, 754,  "YMF754"),
  107. #undef DEV
  108. { }
  109. };
  110. MODULE_DEVICE_TABLE(pci, ymf_id_tbl);
  112. /*
  113.  *  common I/O routines
  114.  */
  116. static inline u8 ymfpci_readb(ymfpci_t *codec, u32 offset)
  117. {
  118. return readb(codec->reg_area_virt + offset);
  119. }
  121. static inline void ymfpci_writeb(ymfpci_t *codec, u32 offset, u8 val)
  122. {
  123. writeb(val, codec->reg_area_virt + offset);
  124. }
  126. static inline u16 ymfpci_readw(ymfpci_t *codec, u32 offset)
  127. {
  128. return readw(codec->reg_area_virt + offset);
  129. }
  131. static inline void ymfpci_writew(ymfpci_t *codec, u32 offset, u16 val)
  132. {
  133. writew(val, codec->reg_area_virt + offset);
  134. }
  136. static inline u32 ymfpci_readl(ymfpci_t *codec, u32 offset)
  137. {
  138. return readl(codec->reg_area_virt + offset);
  139. }
  141. static inline void ymfpci_writel(ymfpci_t *codec, u32 offset, u32 val)
  142. {
  143. writel(val, codec->reg_area_virt + offset);
  144. }
  146. static int ymfpci_codec_ready(ymfpci_t *codec, int secondary, int sched)
  147. {
  148. signed long end_time;
  149. u32 reg = secondary ? YDSXGR_SECSTATUSADR : YDSXGR_PRISTATUSADR;
  151. end_time = jiffies + 3 * (HZ / 4);
  152. do {
  153. if ((ymfpci_readw(codec, reg) & 0x8000) == 0)
  154. return 0;
  155. if (sched) {
  156. set_current_state(TASK_UNINTERRUPTIBLE);
  157. schedule_timeout(1);
  158. }
  159. } while (end_time - (signed long)jiffies >= 0);
  160. printk(KERN_ERR "ymfpci_codec_ready: codec %i is not ready [0x%x]n",
  161.     secondary, ymfpci_readw(codec, reg));
  162. return -EBUSY;
  163. }
  165. static void ymfpci_codec_write(struct ac97_codec *dev, u8 reg, u16 val)
  166. {
  167. ymfpci_t *codec = dev->private_data;
  168. u32 cmd;
  170. /* XXX Do make use of dev->id */
  171. ymfpci_codec_ready(codec, 0, 0);
  172. cmd = ((YDSXG_AC97WRITECMD | reg) << 16) | val;
  173. ymfpci_writel(codec, YDSXGR_AC97CMDDATA, cmd);
  174. }
  176. static u16 ymfpci_codec_read(struct ac97_codec *dev, u8 reg)
  177. {
  178. ymfpci_t *unit = dev->private_data;
  179. int i;
  181. if (ymfpci_codec_ready(unit, 0, 0))
  182. return ~0;
  183. ymfpci_writew(unit, YDSXGR_AC97CMDADR, YDSXG_AC97READCMD | reg);
  184. if (ymfpci_codec_ready(unit, 0, 0))
  185. return ~0;
  186. if (unit->pci->device == PCI_DEVICE_ID_YAMAHA_744 && unit->rev < 2) {
  187. for (i = 0; i < 600; i++)
  188. ymfpci_readw(unit, YDSXGR_PRISTATUSDATA);
  189. }
  190. return ymfpci_readw(unit, YDSXGR_PRISTATUSDATA);
  191. }
  193. /*
  194.  *  Misc routines
  195.  */
  197. /*
  198.  * Calculate the actual sampling rate relatetively to the base clock (48kHz).
  199.  */
  200. static u32 ymfpci_calc_delta(u32 rate)
  201. {
  202. switch (rate) {
  203. case 8000: return 0x02aaab00;
  204. case 11025: return 0x03accd00;
  205. case 16000: return 0x05555500;
  206. case 22050: return 0x07599a00;
  207. case 32000: return 0x0aaaab00;
  208. case 44100: return 0x0eb33300;
  209. default: return ((rate << 16) / 48000) << 12;
  210. }
  211. }
  213. static u32 def_rate[8] = {
  214. 100, 2000, 8000, 11025, 16000, 22050, 32000, 48000
  215. };
  217. static u32 ymfpci_calc_lpfK(u32 rate)
  218. {
  219. u32 i;
  220. static u32 val[8] = {
  221. 0x00570000, 0x06AA0000, 0x18B20000, 0x20930000,
  222. 0x2B9A0000, 0x35A10000, 0x3EAA0000, 0x40000000
  223. };
  225. if (rate == 44100)
  226. return 0x40000000; /* FIXME: What's the right value? */
  227. for (i = 0; i < 8; i++)
  228. if (rate <= def_rate[i])
  229. return val[i];
  230. return val[0];
  231. }
  233. static u32 ymfpci_calc_lpfQ(u32 rate)
  234. {
  235. u32 i;
  236. static u32 val[8] = {
  237. 0x35280000, 0x34A70000, 0x32020000, 0x31770000,
  238. 0x31390000, 0x31C90000, 0x33D00000, 0x40000000
  239. };
  241. if (rate == 44100)
  242. return 0x370A0000;
  243. for (i = 0; i < 8; i++)
  244. if (rate <= def_rate[i])
  245. return val[i];
  246. return val[0];
  247. }
  249. static u32 ymf_calc_lend(u32 rate)
  250. {
  251. return (rate * YMF_SAMPF) / 48000;
  252. }
  254. /*
  255.  * We ever allow only a few formats, but let's be generic, for smaller surprise.
  256.  */
  257. static int ymf_pcm_format_width(int format)
  258. {
  259. static int mask16 = AFMT_S16_LE|AFMT_S16_BE|AFMT_U16_LE|AFMT_U16_BE;
  261. if ((format & (format-1)) != 0) {
  262. printk(KERN_ERR "ymfpci: format 0x%x is not a power of 2n", format);
  263. return 8;
  264. }
  266. if (format == AFMT_IMA_ADPCM) return 4;
  267. if ((format & mask16) != 0) return 16;
  268. return 8;
  269. }
  271. static void ymf_pcm_update_shift(struct ymf_pcm_format *f)
  272. {
  273. f->shift = 0;
  274. if (f->voices == 2)
  275. f->shift++;
  276. if (ymf_pcm_format_width(f->format) == 16)
  277. f->shift++;
  278. }
  280. /* Are you sure 32K is not too much? See if mpg123 skips on loaded systems. */
  281. #define DMABUF_DEFAULTORDER (15-PAGE_SHIFT)
  282. #define DMABUF_MINORDER 1
  284. /* allocate DMA buffer, playback and recording buffer should be allocated seperately */
  285. static int alloc_dmabuf(struct ymf_dmabuf *dmabuf)
  286. {
  287. void *rawbuf = NULL;
  288. int order;
  289. struct page * map,  * mapend;
  291. /* alloc as big a chunk as we can */
  292. for (order = DMABUF_DEFAULTORDER; order >= DMABUF_MINORDER; order--)
  293. if((rawbuf = (void *)__get_free_pages(GFP_KERNEL|GFP_DMA, order)))
  294. break;
  296. if (!rawbuf)
  297. return -ENOMEM;
  299. #if 0
  300. printk(KERN_DEBUG "ymfpci: allocated %ld (order = %d) bytes at %pn",
  301.        PAGE_SIZE << order, order, rawbuf);
  302. #endif
  304. dmabuf->ready  = dmabuf->mapped = 0;
  305. dmabuf->rawbuf = rawbuf;
  306. dmabuf->buforder = order;
  308. /* now mark the pages as reserved; otherwise remap_page_range doesn't do what we want */
  309. mapend = virt_to_page(rawbuf + (PAGE_SIZE << order) - 1);
  310. for (map = virt_to_page(rawbuf); map <= mapend; map++)
  311. set_bit(PG_reserved, &map->flags);
  313. return 0;
  314. }
  316. /* free DMA buffer */
  317. static void dealloc_dmabuf(struct ymf_dmabuf *dmabuf)
  318. {
  319. struct page *map, *mapend;
  321. if (dmabuf->rawbuf) {
  322. /* undo marking the pages as reserved */
  323. mapend = virt_to_page(dmabuf->rawbuf + (PAGE_SIZE << dmabuf->buforder) - 1);
  324. for (map = virt_to_page(dmabuf->rawbuf); map <= mapend; map++)
  325. clear_bit(PG_reserved, &map->flags);
  326. free_pages((unsigned long)dmabuf->rawbuf,dmabuf->buforder);
  327. }
  328. dmabuf->rawbuf = NULL;
  329. dmabuf->mapped = dmabuf->ready = 0;
  330. }
  332. static int prog_dmabuf(struct ymf_state *state, int rec)
  333. {
  334. struct ymf_dmabuf *dmabuf;
  335. int w_16;
  336. unsigned bufsize;
  337. unsigned long flags;
  338. int redzone, redfrags;
  339. int ret;
  341. w_16 = ymf_pcm_format_width(state->format.format) == 16;
  342. dmabuf = rec ? &state->rpcm.dmabuf : &state->wpcm.dmabuf;
  344. spin_lock_irqsave(&state->unit->reg_lock, flags);
  345. dmabuf->hwptr = dmabuf->swptr = 0;
  346. dmabuf->total_bytes = 0;
  347. dmabuf->count = 0;
  348. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  350. /* allocate DMA buffer if not allocated yet */
  351. if (!dmabuf->rawbuf)
  352. if ((ret = alloc_dmabuf(dmabuf)))
  353. return ret;
  355. /*
  356.  * Create fake fragment sizes and numbers for OSS ioctls.
  357.  * Import what Doom might have set with SNDCTL_DSP_SETFRAGMENT.
  358.  */
  359. bufsize = PAGE_SIZE << dmabuf->buforder;
  360. /* By default we give 4 big buffers. */
  361. dmabuf->fragshift = (dmabuf->buforder + PAGE_SHIFT - 2);
  362. if (dmabuf->ossfragshift > 3 &&
  363.     dmabuf->ossfragshift < dmabuf->fragshift) {
  364. /* If OSS set smaller fragments, give more smaller buffers. */
  365. dmabuf->fragshift = dmabuf->ossfragshift;
  366. }
  367. dmabuf->fragsize = 1 << dmabuf->fragshift;
  369. dmabuf->numfrag = bufsize >> dmabuf->fragshift;
  370. dmabuf->dmasize = dmabuf->numfrag << dmabuf->fragshift;
  372. if (dmabuf->ossmaxfrags >= 2) {
  373. redzone = ymf_calc_lend(state->format.rate);
  374. redzone <<= state->format.shift;
  375. redzone *= 3;
  376. redfrags = (redzone + dmabuf->fragsize-1) >> dmabuf->fragshift;
  378. if (dmabuf->ossmaxfrags + redfrags < dmabuf->numfrag) {
  379. dmabuf->numfrag = dmabuf->ossmaxfrags + redfrags;
  380. dmabuf->dmasize = dmabuf->numfrag << dmabuf->fragshift;
  381. }
  382. }
  384. memset(dmabuf->rawbuf, w_16 ? 0 : 0x80, dmabuf->dmasize);
  386. /*
  387.  * Now set up the ring 
  388.  */
  390. /* XXX   ret = rec? cap_pre(): pbk_pre();  */
  391. spin_lock_irqsave(&state->unit->voice_lock, flags);
  392. if (rec) {
  393. if ((ret = ymf_capture_prepare(state)) != 0) {
  394. spin_unlock_irqrestore(&state->unit->voice_lock, flags);
  395. return ret;
  396. }
  397. } else {
  398. if ((ret = ymf_playback_prepare(state)) != 0) {
  399. spin_unlock_irqrestore(&state->unit->voice_lock, flags);
  400. return ret;
  401. }
  402. }
  403. spin_unlock_irqrestore(&state->unit->voice_lock, flags);
  405. /* set the ready flag for the dma buffer (this comment is not stupid) */
  406. dmabuf->ready = 1;
  408. #if 0
  409. printk(KERN_DEBUG "prog_dmabuf: rate %d format 0x%x,"
  410.     " numfrag %d fragsize %d dmasize %dn",
  411.        state->format.rate, state->format.format, dmabuf->numfrag,
  412.        dmabuf->fragsize, dmabuf->dmasize);
  413. #endif
  415. return 0;
  416. }
  418. static void ymf_start_dac(struct ymf_state *state)
  419. {
  420. ymf_playback_trigger(state->unit, &state->wpcm, 1);
  421. }
  423. // static void ymf_start_adc(struct ymf_state *state)
  424. // {
  425. //  ymf_capture_trigger(state->unit, &state->rpcm, 1);
  426. // }
  428. /*
  429.  * Wait until output is drained.
  430.  * This does not kill the hardware for the sake of ioctls.
  431.  */
  432. static void ymf_wait_dac(struct ymf_state *state)
  433. {
  434. struct ymf_unit *unit = state->unit;
  435. struct ymf_pcm *ypcm = &state->wpcm;
  436. DECLARE_WAITQUEUE(waita, current);
  437. unsigned long flags;
  439. add_wait_queue(&ypcm->dmabuf.wait, &waita);
  441. spin_lock_irqsave(&unit->reg_lock, flags);
  442. if (ypcm->dmabuf.count != 0 && !ypcm->running) {
  443. ymf_playback_trigger(unit, ypcm, 1);
  444. }
  446. #if 0
  447. if (file->f_flags & O_NONBLOCK) {
  448. /*
  449.  * XXX Our  mistake is to attach DMA buffer to state
  450.  * rather than to some per-device structure.
  451.  * Cannot skip waiting, can only make it shorter.
  452.  */
  453. }
  454. #endif
  456. set_current_state(TASK_UNINTERRUPTIBLE);
  457. while (ypcm->running) {
  458. spin_unlock_irqrestore(&unit->reg_lock, flags);
  459. schedule();
  460. spin_lock_irqsave(&unit->reg_lock, flags);
  461. set_current_state(TASK_UNINTERRUPTIBLE);
  462. }
  463. spin_unlock_irqrestore(&unit->reg_lock, flags);
  465. set_current_state(TASK_RUNNING);
  466. remove_wait_queue(&ypcm->dmabuf.wait, &waita);
  468. /*
  469.  * This function may take up to 4 seconds to reach this point
  470.  * (32K circular buffer, 8000 Hz). User notices.
  471.  */
  472. }
  474. /* Can just stop, without wait. Or can we? */
  475. static void ymf_stop_adc(struct ymf_state *state)
  476. {
  477. struct ymf_unit *unit = state->unit;
  478. unsigned long flags;
  480. spin_lock_irqsave(&unit->reg_lock, flags);
  481. ymf_capture_trigger(unit, &state->rpcm, 0);
  482. spin_unlock_irqrestore(&unit->reg_lock, flags);
  483. }
  485. /*
  486.  *  Hardware start management
  487.  */
  489. static void ymfpci_hw_start(ymfpci_t *unit)
  490. {
  491. unsigned long flags;
  493. spin_lock_irqsave(&unit->reg_lock, flags);
  494. if (unit->start_count++ == 0) {
  495. ymfpci_writel(unit, YDSXGR_MODE,
  496.     ymfpci_readl(unit, YDSXGR_MODE) | 3);
  497. unit->active_bank = ymfpci_readl(unit, YDSXGR_CTRLSELECT) & 1;
  498. }
  499. spin_unlock_irqrestore(&unit->reg_lock, flags);
  500. }
  502. static void ymfpci_hw_stop(ymfpci_t *unit)
  503. {
  504. unsigned long flags;
  505. long timeout = 1000;
  507. spin_lock_irqsave(&unit->reg_lock, flags);
  508. if (--unit->start_count == 0) {
  509. ymfpci_writel(unit, YDSXGR_MODE,
  510.     ymfpci_readl(unit, YDSXGR_MODE) & ~3);
  511. while (timeout-- > 0) {
  512. if ((ymfpci_readl(unit, YDSXGR_STATUS) & 2) == 0)
  513. break;
  514. }
  515. }
  516. spin_unlock_irqrestore(&unit->reg_lock, flags);
  517. }
  519. /*
  520.  *  Playback voice management
  521.  */
  523. static int voice_alloc(ymfpci_t *codec, ymfpci_voice_type_t type, int pair, ymfpci_voice_t *rvoice[])
  524. {
  525. ymfpci_voice_t *voice, *voice2;
  526. int idx;
  528. for (idx = 0; idx < YDSXG_PLAYBACK_VOICES; idx += pair ? 2 : 1) {
  529. voice = &codec->voices[idx];
  530. voice2 = pair ? &codec->voices[idx+1] : NULL;
  531. if (voice->use || (voice2 && voice2->use))
  532. continue;
  533. voice->use = 1;
  534. if (voice2)
  535. voice2->use = 1;
  536. switch (type) {
  537. case YMFPCI_PCM:
  538. voice->pcm = 1;
  539. if (voice2)
  540. voice2->pcm = 1;
  541. break;
  542. case YMFPCI_SYNTH:
  543. voice->synth = 1;
  544. break;
  545. case YMFPCI_MIDI:
  546. voice->midi = 1;
  547. break;
  548. }
  549. ymfpci_hw_start(codec);
  550. rvoice[0] = voice;
  551. if (voice2) {
  552. ymfpci_hw_start(codec);
  553. rvoice[1] = voice2;
  554. }
  555. return 0;
  556. }
  557. return -EBUSY; /* Your audio channel is open by someone else. */
  558. }
  560. static void ymfpci_voice_free(ymfpci_t *unit, ymfpci_voice_t *pvoice)
  561. {
  562. ymfpci_hw_stop(unit);
  563. pvoice->use = pvoice->pcm = pvoice->synth = pvoice->midi = 0;
  564. pvoice->ypcm = NULL;
  565. }
  567. /*
  568.  */
  570. static void ymf_pcm_interrupt(ymfpci_t *codec, ymfpci_voice_t *voice)
  571. {
  572. struct ymf_pcm *ypcm;
  573. int redzone;
  574. int pos, delta, swptr;
  575. int played, distance;
  576. struct ymf_state *state;
  577. struct ymf_dmabuf *dmabuf;
  578. char silence;
  580. if ((ypcm = voice->ypcm) == NULL) {
  581. return;
  582. }
  583. if ((state = ypcm->state) == NULL) {
  584. ypcm->running = 0; // lock it
  585. return;
  586. }
  587. dmabuf = &ypcm->dmabuf;
  588. spin_lock(&codec->reg_lock);
  589. if (ypcm->running) {
  590. YMFDBGI("ymfpci: %d, intr bank %d count %d start 0x%x:%xn",
  591.    voice->number, codec->active_bank, dmabuf->count,
  592.    voice->bank[0].start, voice->bank[1].start);
  593. silence = (ymf_pcm_format_width(state->format.format) == 16) ?
  594.     0 : 0x80;
  595. /* We need actual left-hand-side redzone size here. */
  596. redzone = ymf_calc_lend(state->format.rate);
  597. redzone <<= (state->format.shift + 1);
  598. swptr = dmabuf->swptr;
  600. pos = voice->bank[codec->active_bank].start;
  601. pos <<= state->format.shift;
  602. if (pos < 0 || pos >= dmabuf->dmasize) { /* ucode bug */
  603. printk(KERN_ERR "ymfpci%d: runaway voice %d: hwptr %d=>%d dmasize %dn",
  604.     codec->dev_audio, voice->number,
  605.     dmabuf->hwptr, pos, dmabuf->dmasize);
  606. pos = 0;
  607. }
  608. if (pos < dmabuf->hwptr) {
  609. delta = dmabuf->dmasize - dmabuf->hwptr;
  610. memset(dmabuf->rawbuf + dmabuf->hwptr, silence, delta);
  611. delta += pos;
  612. memset(dmabuf->rawbuf, silence, pos);
  613. } else {
  614. delta = pos - dmabuf->hwptr;
  615. memset(dmabuf->rawbuf + dmabuf->hwptr, silence, delta);
  616. }
  617. dmabuf->hwptr = pos;
  619. if (dmabuf->count == 0) {
  620. printk(KERN_ERR "ymfpci%d: %d: strain: hwptr %dn",
  621.     codec->dev_audio, voice->number, dmabuf->hwptr);
  622. ymf_playback_trigger(codec, ypcm, 0);
  623. }
  625. if (swptr <= pos) {
  626. distance = pos - swptr;
  627. } else {
  628. distance = dmabuf->dmasize - (swptr - pos);
  629. }
  630. if (distance < redzone) {
  631. /*
  632.  * hwptr inside redzone => DMA ran out of samples.
  633.  */
  634. if (delta < dmabuf->count) {
  635. /*
  636.  * Lost interrupt or other screwage.
  637.  */
  638. printk(KERN_ERR "ymfpci%d: %d: lost: delta %d"
  639.     " hwptr %d swptr %d distance %d count %dn",
  640.     codec->dev_audio, voice->number, delta,
  641.     dmabuf->hwptr, swptr, distance, dmabuf->count);
  642. } else {
  643. /*
  644.  * Normal end of DMA.
  645.  */
  646. YMFDBGI("ymfpci%d: %d: done: delta %d"
  647.     " hwptr %d swptr %d distance %d count %dn",
  648.     codec->dev_audio, voice->number, delta,
  649.     dmabuf->hwptr, swptr, distance, dmabuf->count);
  650. }
  651. played = dmabuf->count;
  652. if (ypcm->running) {
  653. ymf_playback_trigger(codec, ypcm, 0);
  654. }
  655. } else {
  656. /*
  657.  * hwptr is chipping away towards a remote swptr.
  658.  * Calculate other distance and apply it to count.
  659.  */
  660. if (swptr >= pos) {
  661. distance = swptr - pos;
  662. } else {
  663. distance = dmabuf->dmasize - (pos - swptr);
  664. }
  665. if (distance < dmabuf->count) {
  666. played = dmabuf->count - distance;
  667. } else {
  668. played = 0;
  669. }
  670. }
  672. dmabuf->total_bytes += played;
  673. dmabuf->count -= played;
  674. if (dmabuf->count < dmabuf->dmasize / 2) {
  675. wake_up(&dmabuf->wait);
  676. }
  677. }
  678. spin_unlock(&codec->reg_lock);
  679. }
  681. static void ymf_cap_interrupt(ymfpci_t *unit, struct ymf_capture *cap)
  682. {
  683. struct ymf_pcm *ypcm;
  684. int redzone;
  685. struct ymf_state *state;
  686. struct ymf_dmabuf *dmabuf;
  687. int pos, delta;
  688. int cnt;
  690. if ((ypcm = cap->ypcm) == NULL) {
  691. return;
  692. }
  693. if ((state = ypcm->state) == NULL) {
  694. ypcm->running = 0; // lock it
  695. return;
  696. }
  697. dmabuf = &ypcm->dmabuf;
  698. spin_lock(&unit->reg_lock);
  699. if (ypcm->running) {
  700. redzone = ymf_calc_lend(state->format.rate);
  701. redzone <<= (state->format.shift + 1);
  703. pos = cap->bank[unit->active_bank].start;
  704. // pos <<= state->format.shift;
  705. if (pos < 0 || pos >= dmabuf->dmasize) { /* ucode bug */
  706. printk(KERN_ERR "ymfpci%d: runaway capture %d: hwptr %d=>%d dmasize %dn",
  707.     unit->dev_audio, ypcm->capture_bank_number,
  708.     dmabuf->hwptr, pos, dmabuf->dmasize);
  709. pos = 0;
  710. }
  711. if (pos < dmabuf->hwptr) {
  712. delta = dmabuf->dmasize - dmabuf->hwptr;
  713. delta += pos;
  714. } else {
  715. delta = pos - dmabuf->hwptr;
  716. }
  717. dmabuf->hwptr = pos;
  719. cnt = dmabuf->count;
  720. cnt += delta;
  721. if (cnt + redzone > dmabuf->dmasize) {
  722. /* Overflow - bump swptr */
  723. dmabuf->count = dmabuf->dmasize - redzone;
  724. dmabuf->swptr = dmabuf->hwptr + redzone;
  725. if (dmabuf->swptr >= dmabuf->dmasize) {
  726. dmabuf->swptr -= dmabuf->dmasize;
  727. }
  728. } else {
  729. dmabuf->count = cnt;
  730. }
  732. dmabuf->total_bytes += delta;
  733. if (dmabuf->count) { /* && is_sleeping  XXX */
  734. wake_up(&dmabuf->wait);
  735. }
  736. }
  737. spin_unlock(&unit->reg_lock);
  738. }
  740. static int ymf_playback_trigger(ymfpci_t *codec, struct ymf_pcm *ypcm, int cmd)
  741. {
  743. if (ypcm->voices[0] == NULL) {
  744. return -EINVAL;
  745. }
  746. if (cmd != 0) {
  747. codec->ctrl_playback[ypcm->voices[0]->number + 1] = virt_to_bus(ypcm->voices[0]->bank);
  748. if (ypcm->voices[1] != NULL)
  749. codec->ctrl_playback[ypcm->voices[1]->number + 1] = virt_to_bus(ypcm->voices[1]->bank);
  750. ypcm->running = 1;
  751. } else {
  752. codec->ctrl_playback[ypcm->voices[0]->number + 1] = 0;
  753. if (ypcm->voices[1] != NULL)
  754. codec->ctrl_playback[ypcm->voices[1]->number + 1] = 0;
  755. ypcm->running = 0;
  756. }
  757. return 0;
  758. }
  760. static void ymf_capture_trigger(ymfpci_t *codec, struct ymf_pcm *ypcm, int cmd)
  761. {
  762. u32 tmp;
  764. if (cmd != 0) {
  765. tmp = ymfpci_readl(codec, YDSXGR_MAPOFREC) | (1 << ypcm->capture_bank_number);
  766. ymfpci_writel(codec, YDSXGR_MAPOFREC, tmp);
  767. ypcm->running = 1;
  768. } else {
  769. tmp = ymfpci_readl(codec, YDSXGR_MAPOFREC) & ~(1 << ypcm->capture_bank_number);
  770. ymfpci_writel(codec, YDSXGR_MAPOFREC, tmp);
  771. ypcm->running = 0;
  772. }
  773. }
  775. static int ymfpci_pcm_voice_alloc(struct ymf_pcm *ypcm, int voices)
  776. {
  777. struct ymf_unit *unit;
  778. int err;
  780. unit = ypcm->state->unit;
  781. if (ypcm->voices[1] != NULL && voices < 2) {
  782. ymfpci_voice_free(unit, ypcm->voices[1]);
  783. ypcm->voices[1] = NULL;
  784. }
  785. if (voices == 1 && ypcm->voices[0] != NULL)
  786. return 0; /* already allocated */
  787. if (voices == 2 && ypcm->voices[0] != NULL && ypcm->voices[1] != NULL)
  788. return 0; /* already allocated */
  789. if (voices > 1) {
  790. if (ypcm->voices[0] != NULL && ypcm->voices[1] == NULL) {
  791. ymfpci_voice_free(unit, ypcm->voices[0]);
  792. ypcm->voices[0] = NULL;
  793. }
  794. if ((err = voice_alloc(unit, YMFPCI_PCM, 1, ypcm->voices)) < 0)
  795. return err;
  796. ypcm->voices[0]->ypcm = ypcm;
  797. ypcm->voices[1]->ypcm = ypcm;
  798. } else {
  799. if ((err = voice_alloc(unit, YMFPCI_PCM, 0, ypcm->voices)) < 0)
  800. return err;
  801. ypcm->voices[0]->ypcm = ypcm;
  802. }
  803. return 0;
  804. }
  806. static void ymf_pcm_init_voice(ymfpci_voice_t *voice, int stereo,
  807.     int rate, int w_16, unsigned long addr, unsigned int end, int spdif)
  808. {
  809. u32 format;
  810. u32 delta = ymfpci_calc_delta(rate);
  811. u32 lpfQ = ymfpci_calc_lpfQ(rate);
  812. u32 lpfK = ymfpci_calc_lpfK(rate);
  813. ymfpci_playback_bank_t *bank;
  814. int nbank;
  816. format = (stereo ? 0x00010000 : 0) | (w_16 ? 0 : 0x80000000);
  817. if (stereo)
  818. end >>= 1;
  819. if (w_16)
  820. end >>= 1;
  821. for (nbank = 0; nbank < 2; nbank++) {
  822. bank = &voice->bank[nbank];
  823. bank->format = format;
  824. bank->loop_default = 0; /* 0-loops forever, otherwise count */
  825. bank->base = addr;
  826. bank->loop_start = 0;
  827. bank->loop_end = end;
  828. bank->loop_frac = 0;
  829. bank->eg_gain_end = 0x40000000;
  830. bank->lpfQ = lpfQ;
  831. bank->status = 0;
  832. bank->num_of_frames = 0;
  833. bank->loop_count = 0;
  834. bank->start = 0;
  835. bank->start_frac = 0;
  836. bank->delta =
  837. bank->delta_end = delta;
  838. bank->lpfK =
  839. bank->lpfK_end = lpfK;
  840. bank->eg_gain = 0x40000000;
  841. bank->lpfD1 =
  842. bank->lpfD2 = 0;
  844. bank->left_gain = 
  845. bank->right_gain =
  846. bank->left_gain_end =
  847. bank->right_gain_end =
  848. bank->eff1_gain =
  849. bank->eff2_gain =
  850. bank->eff3_gain =
  851. bank->eff1_gain_end =
  852. bank->eff2_gain_end =
  853. bank->eff3_gain_end = 0;
  855. if (!stereo) {
  856. if (!spdif) {
  857. bank->left_gain = 
  858. bank->right_gain =
  859. bank->left_gain_end =
  860. bank->right_gain_end = 0x40000000;
  861. } else {
  862. bank->eff2_gain =
  863. bank->eff2_gain_end =
  864. bank->eff3_gain =
  865. bank->eff3_gain_end = 0x40000000;
  866. }
  867. } else {
  868. if (!spdif) {
  869. if ((voice->number & 1) == 0) {
  870. bank->left_gain =
  871. bank->left_gain_end = 0x40000000;
  872. } else {
  873. bank->format |= 1;
  874. bank->right_gain =
  875. bank->right_gain_end = 0x40000000;
  876. }
  877. } else {
  878. if ((voice->number & 1) == 0) {
  879. bank->eff2_gain =
  880. bank->eff2_gain_end = 0x40000000;
  881. } else {
  882. bank->format |= 1;
  883. bank->eff3_gain =
  884. bank->eff3_gain_end = 0x40000000;
  885. }
  886. }
  887. }
  888. }
  889. }
  891. /*
  892.  * XXX Capture channel allocation is entirely fake at the moment.
  893.  * We use only one channel and mark it busy as required.
  894.  */
  895. static int ymf_capture_alloc(struct ymf_unit *unit, int *pbank)
  896. {
  897. struct ymf_capture *cap;
  898. int cbank;
  900. cbank = 1; /* Only ADC slot is used for now. */
  901. cap = &unit->capture[cbank];
  902. if (cap->use)
  903. return -EBUSY;
  904. cap->use = 1;
  905. *pbank = cbank;
  906. return 0;
  907. }
  909. static int ymf_playback_prepare(struct ymf_state *state)
  910. {
  911. struct ymf_pcm *ypcm = &state->wpcm;
  912. int err, nvoice;
  914. if ((err = ymfpci_pcm_voice_alloc(ypcm, state->format.voices)) < 0) {
  915. /* Somebody started 32 mpg123's in parallel? */
  916. printk(KERN_INFO "ymfpci%d: cannot allocate voicen",
  917.     state->unit->dev_audio);
  918. return err;
  919. }
  921. for (nvoice = 0; nvoice < state->format.voices; nvoice++) {
  922. ymf_pcm_init_voice(ypcm->voices[nvoice],
  923.     state->format.voices == 2, state->format.rate,
  924.     ymf_pcm_format_width(state->format.format) == 16,
  925.     virt_to_bus(ypcm->dmabuf.rawbuf), ypcm->dmabuf.dmasize,
  926.     ypcm->spdif);
  927. }
  928. return 0;
  929. }
  931. static int ymf_capture_prepare(struct ymf_state *state)
  932. {
  933. ymfpci_t *unit = state->unit;
  934. struct ymf_pcm *ypcm = &state->rpcm;
  935. ymfpci_capture_bank_t * bank;
  936. /* XXX This is confusing, gotta rename one of them banks... */
  937. int nbank; /* flip-flop bank */
  938. int cbank; /* input [super-]bank */
  939. struct ymf_capture *cap;
  940. u32 rate, format;
  942. if (ypcm->capture_bank_number == -1) {
  943. if (ymf_capture_alloc(unit, &cbank) != 0)
  944. return -EBUSY;
  946. ypcm->capture_bank_number = cbank;
  948. cap = &unit->capture[cbank];
  949. cap->bank = unit->bank_capture[cbank][0];
  950. cap->ypcm = ypcm;
  951. ymfpci_hw_start(unit);
  952. }
  954. // ypcm->frag_size = snd_pcm_lib_transfer_fragment(substream);
  955. // frag_size is replaced with nonfragged byte-aligned rolling buffer
  956. rate = ((48000 * 4096) / state->format.rate) - 1;
  957. format = 0;
  958. if (state->format.voices == 2)
  959. format |= 2;
  960. if (ymf_pcm_format_width(state->format.format) == 8)
  961. format |= 1;
  962. switch (ypcm->capture_bank_number) {
  963. case 0:
  964. ymfpci_writel(unit, YDSXGR_RECFORMAT, format);
  965. ymfpci_writel(unit, YDSXGR_RECSLOTSR, rate);
  966. break;
  967. case 1:
  968. ymfpci_writel(unit, YDSXGR_ADCFORMAT, format);
  969. ymfpci_writel(unit, YDSXGR_ADCSLOTSR, rate);
  970. break;
  971. }
  972. for (nbank = 0; nbank < 2; nbank++) {
  973. bank = unit->bank_capture[ypcm->capture_bank_number][nbank];
  974. bank->base = virt_to_bus(ypcm->dmabuf.rawbuf);
  975. // bank->loop_end = ypcm->dmabuf.dmasize >> state->format.shift;
  976. bank->loop_end = ypcm->dmabuf.dmasize;
  977. bank->start = 0;
  978. bank->num_of_loops = 0;
  979. }
  980. #if 0 /* s/pdif */
  981. if (state->digital.dig_valid)
  982. /*state->digital.type == SND_PCM_DIG_AES_IEC958*/
  983. ymfpci_writew(codec, YDSXGR_SPDIFOUTSTATUS,
  984.     state->digital.dig_status[0] | (state->digital.dig_status[1] << 8));
  985. #endif
  986. return 0;
  987. }
  989. void ymf_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  990. {
  991. ymfpci_t *codec = dev_id;
  992. u32 status, nvoice, mode;
  993. struct ymf_voice *voice;
  994. struct ymf_capture *cap;
  996. status = ymfpci_readl(codec, YDSXGR_STATUS);
  997. if (status & 0x80000000) {
  998. codec->active_bank = ymfpci_readl(codec, YDSXGR_CTRLSELECT) & 1;
  999. spin_lock(&codec->voice_lock);
  1000. for (nvoice = 0; nvoice < YDSXG_PLAYBACK_VOICES; nvoice++) {
  1001. voice = &codec->voices[nvoice];
  1002. if (voice->use)
  1003. ymf_pcm_interrupt(codec, voice);
  1004. }
  1005. for (nvoice = 0; nvoice < YDSXG_CAPTURE_VOICES; nvoice++) {
  1006. cap = &codec->capture[nvoice];
  1007. if (cap->use)
  1008. ymf_cap_interrupt(codec, cap);
  1009. }
  1010. spin_unlock(&codec->voice_lock);
  1011. spin_lock(&codec->reg_lock);
  1012. ymfpci_writel(codec, YDSXGR_STATUS, 0x80000000);
  1013. mode = ymfpci_readl(codec, YDSXGR_MODE) | 2;
  1014. ymfpci_writel(codec, YDSXGR_MODE, mode);
  1015. spin_unlock(&codec->reg_lock);
  1016. }
  1018. status = ymfpci_readl(codec, YDSXGR_INTFLAG);
  1019. if (status & 1) {
  1020. /* timer handler */
  1021. ymfpci_writel(codec, YDSXGR_INTFLAG, ~0);
  1022. }
  1023. }
  1025. static void ymf_pcm_free_substream(struct ymf_pcm *ypcm)
  1026. {
  1027. unsigned long flags;
  1028. struct ymf_unit *unit;
  1030. unit = ypcm->state->unit;
  1032. if (ypcm->type == PLAYBACK_VOICE) {
  1033. spin_lock_irqsave(&unit->voice_lock, flags);
  1034. if (ypcm->voices[1])
  1035. ymfpci_voice_free(unit, ypcm->voices[1]);
  1036. if (ypcm->voices[0])
  1037. ymfpci_voice_free(unit, ypcm->voices[0]);
  1038. spin_unlock_irqrestore(&unit->voice_lock, flags);
  1039. } else {
  1040. if (ypcm->capture_bank_number != -1) {
  1041. unit->capture[ypcm->capture_bank_number].use = 0;
  1042. ypcm->capture_bank_number = -1;
  1043. ymfpci_hw_stop(unit);
  1044. }
  1045. }
  1046. }
  1048. static struct ymf_state *ymf_state_alloc(ymfpci_t *unit)
  1049. {
  1050. struct ymf_pcm *ypcm;
  1051. struct ymf_state *state;
  1053. if ((state = kmalloc(sizeof(struct ymf_state), GFP_KERNEL)) == NULL) {
  1054. goto out0;
  1055. }
  1056. memset(state, 0, sizeof(struct ymf_state));
  1058. ypcm = &state->wpcm;
  1059. ypcm->state = state;
  1060. ypcm->type = PLAYBACK_VOICE;
  1061. ypcm->capture_bank_number = -1;
  1062. init_waitqueue_head(&ypcm->dmabuf.wait);
  1064. ypcm = &state->rpcm;
  1065. ypcm->state = state;
  1066. ypcm->type = CAPTURE_AC97;
  1067. ypcm->capture_bank_number = -1;
  1068. init_waitqueue_head(&ypcm->dmabuf.wait);
  1070. state->unit = unit;
  1072. state->format.format = AFMT_U8;
  1073. state->format.rate = 8000;
  1074. state->format.voices = 1;
  1075. ymf_pcm_update_shift(&state->format);
  1077. return state;
  1079. out0:
  1080. return NULL;
  1081. }
  1083. /* AES/IEC958 channel status bits */
  1084. #define SND_PCM_AES0_PROFESSIONAL (1<<0) /* 0 = consumer, 1 = professional */
  1085. #define SND_PCM_AES0_NONAUDIO (1<<1) /* 0 = audio, 1 = non-audio */
  1086. #define SND_PCM_AES0_PRO_EMPHASIS (7<<2) /* mask - emphasis */
  1087. #define SND_PCM_AES0_PRO_EMPHASIS_NOTID (0<<2) /* emphasis not indicated */
  1088. #define SND_PCM_AES0_PRO_EMPHASIS_NONE (1<<2) /* none emphasis */
  1089. #define SND_PCM_AES0_PRO_EMPHASIS_5015 (3<<2) /* 50/15us emphasis */
  1090. #define SND_PCM_AES0_PRO_EMPHASIS_CCITT (7<<2) /* CCITT J.17 emphasis */
  1091. #define SND_PCM_AES0_PRO_FREQ_UNLOCKED (1<<5) /* source sample frequency: 0 = locked, 1 = unlocked */
  1092. #define SND_PCM_AES0_PRO_FS (3<<6) /* mask - sample frequency */
  1093. #define SND_PCM_AES0_PRO_FS_NOTID (0<<6) /* fs not indicated */
  1094. #define SND_PCM_AES0_PRO_FS_44100 (1<<6) /* 44.1kHz */
  1095. #define SND_PCM_AES0_PRO_FS_48000 (2<<6) /* 48kHz */
  1096. #define SND_PCM_AES0_PRO_FS_32000 (3<<6) /* 32kHz */
  1097. #define SND_PCM_AES0_CON_NOT_COPYRIGHT (1<<2) /* 0 = copyright, 1 = not copyright */
  1098. #define SND_PCM_AES0_CON_EMPHASIS (7<<3) /* mask - emphasis */
  1099. #define SND_PCM_AES0_CON_EMPHASIS_NONE (0<<3) /* none emphasis */
  1100. #define SND_PCM_AES0_CON_EMPHASIS_5015 (1<<3) /* 50/15us emphasis */
  1101. #define SND_PCM_AES0_CON_MODE (3<<6) /* mask - mode */
  1102. #define SND_PCM_AES1_PRO_MODE (15<<0) /* mask - channel mode */
  1103. #define SND_PCM_AES1_PRO_MODE_NOTID (0<<0) /* not indicated */
  1104. #define SND_PCM_AES1_PRO_MODE_STEREOPHONIC (2<<0) /* stereophonic - ch A is left */
  1105. #define SND_PCM_AES1_PRO_MODE_SINGLE (4<<0) /* single channel */
  1106. #define SND_PCM_AES1_PRO_MODE_TWO (8<<0) /* two channels */
  1107. #define SND_PCM_AES1_PRO_MODE_PRIMARY (12<<0) /* primary/secondary */
  1108. #define SND_PCM_AES1_PRO_MODE_BYTE3 (15<<0) /* vector to byte 3 */
  1109. #define SND_PCM_AES1_PRO_USERBITS (15<<4) /* mask - user bits */
  1110. #define SND_PCM_AES1_PRO_USERBITS_NOTID (0<<4) /* not indicated */
  1111. #define SND_PCM_AES1_PRO_USERBITS_192 (8<<4) /* 192-bit structure */
  1112. #define SND_PCM_AES1_PRO_USERBITS_UDEF (12<<4) /* user defined application */
  1113. #define SND_PCM_AES1_CON_CATEGORY 0x7f
  1114. #define SND_PCM_AES1_CON_GENERAL 0x00
  1115. #define SND_PCM_AES1_CON_EXPERIMENTAL 0x40
  1116. #define SND_PCM_AES1_CON_SOLIDMEM_MASK 0x0f
  1117. #define SND_PCM_AES1_CON_SOLIDMEM_ID 0x08
  1118. #define SND_PCM_AES1_CON_BROADCAST1_MASK 0x07
  1119. #define SND_PCM_AES1_CON_BROADCAST1_ID 0x04
  1120. #define SND_PCM_AES1_CON_DIGDIGCONV_MASK 0x07
  1121. #define SND_PCM_AES1_CON_DIGDIGCONV_ID 0x02
  1122. #define SND_PCM_AES1_CON_ADC_COPYRIGHT_MASK 0x1f
  1123. #define SND_PCM_AES1_CON_ADC_COPYRIGHT_ID 0x06
  1124. #define SND_PCM_AES1_CON_ADC_MASK 0x1f
  1125. #define SND_PCM_AES1_CON_ADC_ID 0x16
  1126. #define SND_PCM_AES1_CON_BROADCAST2_MASK 0x0f
  1127. #define SND_PCM_AES1_CON_BROADCAST2_ID 0x0e
  1128. #define SND_PCM_AES1_CON_LASEROPT_MASK 0x07
  1129. #define SND_PCM_AES1_CON_LASEROPT_ID 0x01
  1130. #define SND_PCM_AES1_CON_MUSICAL_MASK 0x07
  1131. #define SND_PCM_AES1_CON_MUSICAL_ID 0x05
  1132. #define SND_PCM_AES1_CON_MAGNETIC_MASK 0x07
  1133. #define SND_PCM_AES1_CON_MAGNETIC_ID 0x03
  1134. #define SND_PCM_AES1_CON_IEC908_CD (SND_PCM_AES1_CON_LASEROPT_ID|0x00)
  1135. #define SND_PCM_AES1_CON_NON_IEC908_CD (SND_PCM_AES1_CON_LASEROPT_ID|0x08)
  1136. #define SND_PCM_AES1_CON_PCM_CODER (SND_PCM_AES1_CON_DIGDIGCONV_ID|0x00)
  1137. #define SND_PCM_AES1_CON_SAMPLER (SND_PCM_AES1_CON_DIGDIGCONV_ID|0x20)
  1138. #define SND_PCM_AES1_CON_MIXER (SND_PCM_AES1_CON_DIGDIGCONV_ID|0x10)
  1139. #define SND_PCM_AES1_CON_RATE_CONVERTER (SND_PCM_AES1_CON_DIGDIGCONV_ID|0x18)
  1140. #define SND_PCM_AES1_CON_SYNTHESIZER (SND_PCM_AES1_CON_MUSICAL_ID|0x00)
  1141. #define SND_PCM_AES1_CON_MICROPHONE (SND_PCM_AES1_CON_MUSICAL_ID|0x08)
  1142. #define SND_PCM_AES1_CON_DAT (SND_PCM_AES1_CON_MAGNETIC_ID|0x00)
  1143. #define SND_PCM_AES1_CON_VCR (SND_PCM_AES1_CON_MAGNETIC_ID|0x08)
  1144. #define SND_PCM_AES1_CON_ORIGINAL (1<<7) /* this bits depends on the category code */
  1145. #define SND_PCM_AES2_PRO_SBITS (7<<0) /* mask - sample bits */
  1146. #define SND_PCM_AES2_PRO_SBITS_20 (2<<0) /* 20-bit - coordination */
  1147. #define SND_PCM_AES2_PRO_SBITS_24 (4<<0) /* 24-bit - main audio */
  1148. #define SND_PCM_AES2_PRO_SBITS_UDEF (6<<0) /* user defined application */
  1149. #define SND_PCM_AES2_PRO_WORDLEN (7<<3) /* mask - source word length */
  1150. #define SND_PCM_AES2_PRO_WORDLEN_NOTID (0<<3) /* not indicated */
  1151. #define SND_PCM_AES2_PRO_WORDLEN_22_18 (2<<3) /* 22-bit or 18-bit */
  1152. #define SND_PCM_AES2_PRO_WORDLEN_23_19 (4<<3) /* 23-bit or 19-bit */
  1153. #define SND_PCM_AES2_PRO_WORDLEN_24_20 (5<<3) /* 24-bit or 20-bit */
  1154. #define SND_PCM_AES2_PRO_WORDLEN_20_16 (6<<3) /* 20-bit or 16-bit */
  1155. #define SND_PCM_AES2_CON_SOURCE (15<<0) /* mask - source number */
  1156. #define SND_PCM_AES2_CON_SOURCE_UNSPEC (0<<0) /* unspecified */
  1157. #define SND_PCM_AES2_CON_CHANNEL (15<<4) /* mask - channel number */
  1158. #define SND_PCM_AES2_CON_CHANNEL_UNSPEC (0<<4) /* unspecified */
  1159. #define SND_PCM_AES3_CON_FS (15<<0) /* mask - sample frequency */
  1160. #define SND_PCM_AES3_CON_FS_44100 (0<<0) /* 44.1kHz */
  1161. #define SND_PCM_AES3_CON_FS_48000 (2<<0) /* 48kHz */
  1162. #define SND_PCM_AES3_CON_FS_32000 (3<<0) /* 32kHz */
  1163. #define SND_PCM_AES3_CON_CLOCK (3<<4) /* mask - clock accuracy */
  1164. #define SND_PCM_AES3_CON_CLOCK_1000PPM (0<<4) /* 1000 ppm */
  1165. #define SND_PCM_AES3_CON_CLOCK_50PPM (1<<4) /* 50 ppm */
  1166. #define SND_PCM_AES3_CON_CLOCK_VARIABLE (2<<4) /* variable pitch */
  1168. /*
  1169.  * User interface
  1170.  */
  1172. /*
  1173.  * in this loop, dmabuf.count signifies the amount of data that is
  1174.  * waiting to be copied to the user's buffer.  it is filled by the dma
  1175.  * machine and drained by this loop.
  1176.  */
  1177. static ssize_t
  1178. ymf_read(struct file *file, char *buffer, size_t count, loff_t *ppos)
  1179. {
  1180. struct ymf_state *state = (struct ymf_state *)file->private_data;
  1181. struct ymf_dmabuf *dmabuf = &state->rpcm.dmabuf;
  1182. struct ymf_unit *unit = state->unit;
  1183. DECLARE_WAITQUEUE(waita, current);
  1184. ssize_t ret;
  1185. unsigned long flags;
  1186. unsigned int swptr;
  1187. int cnt; /* This many to go in this revolution */
  1189. if (ppos != &file->f_pos)
  1190. return -ESPIPE;
  1191. if (dmabuf->mapped)
  1192. return -ENXIO;
  1193. if (!dmabuf->ready && (ret = prog_dmabuf(state, 1)))
  1194. return ret;
  1195. ret = 0;
  1197. add_wait_queue(&dmabuf->wait, &waita);
  1198. set_current_state(TASK_INTERRUPTIBLE);
  1199. while (count > 0) {
  1200. spin_lock_irqsave(&unit->reg_lock, flags);
  1201. if (unit->suspended) {
  1202. spin_unlock_irqrestore(&unit->reg_lock, flags);
  1203. schedule();
  1204. set_current_state(TASK_INTERRUPTIBLE);
  1205. if (signal_pending(current)) {
  1206. if (!ret) ret = -EAGAIN;
  1207. break;
  1208. }
  1209. continue;
  1210. }
  1211. swptr = dmabuf->swptr;
  1212. cnt = dmabuf->dmasize - swptr;
  1213. if (dmabuf->count < cnt)
  1214. cnt = dmabuf->count;
  1215. spin_unlock_irqrestore(&unit->reg_lock, flags);
  1217. if (cnt > count)
  1218. cnt = count;
  1219. if (cnt <= 0) {
  1220. unsigned long tmo;
  1221. /* buffer is empty, start the dma machine and wait for data to be
  1222.    recorded */
  1223. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1224. if (!state->rpcm.running) {
  1225. ymf_capture_trigger(state->unit, &state->rpcm, 1);
  1226. }
  1227. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1228. if (file->f_flags & O_NONBLOCK) {
  1229. if (!ret) ret = -EAGAIN;
  1230. break;
  1231. }
  1232. /* This isnt strictly right for the 810  but it'll do */
  1233. tmo = (dmabuf->dmasize * HZ) / (state->format.rate * 2);
  1234. tmo >>= state->format.shift;
  1235. /* There are two situations when sleep_on_timeout returns, one is when
  1236.    the interrupt is serviced correctly and the process is waked up by
  1237.    ISR ON TIME. Another is when timeout is expired, which means that
  1238.    either interrupt is NOT serviced correctly (pending interrupt) or it
  1239.    is TOO LATE for the process to be scheduled to run (scheduler latency)
  1240.    which results in a (potential) buffer overrun. And worse, there is
  1241.    NOTHING we can do to prevent it. */
  1242. tmo = schedule_timeout(tmo);
  1243. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1244. set_current_state(TASK_INTERRUPTIBLE);
  1245. if (tmo == 0 && dmabuf->count == 0) {
  1246. printk(KERN_ERR "ymfpci%d: recording schedule timeout, "
  1247.     "dmasz %u fragsz %u count %i hwptr %u swptr %un",
  1248.     state->unit->dev_audio,
  1249.     dmabuf->dmasize, dmabuf->fragsize, dmabuf->count,
  1250.     dmabuf->hwptr, dmabuf->swptr);
  1251. }
  1252. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1253. if (signal_pending(current)) {
  1254. if (!ret) ret = -ERESTARTSYS;
  1255. break;
  1256. }
  1257. continue;
  1258. }
  1260. if (copy_to_user(buffer, dmabuf->rawbuf + swptr, cnt)) {
  1261. if (!ret) ret = -EFAULT;
  1262. break;
  1263. }
  1265. swptr = (swptr + cnt) % dmabuf->dmasize;
  1267. spin_lock_irqsave(&unit->reg_lock, flags);
  1268. if (unit->suspended) {
  1269. spin_unlock_irqrestore(&unit->reg_lock, flags);
  1270. continue;
  1271. }
  1273. dmabuf->swptr = swptr;
  1274. dmabuf->count -= cnt;
  1275. // spin_unlock_irqrestore(&unit->reg_lock, flags);
  1277. count -= cnt;
  1278. buffer += cnt;
  1279. ret += cnt;
  1280. // spin_lock_irqsave(&unit->reg_lock, flags);
  1281. if (!state->rpcm.running) {
  1282. ymf_capture_trigger(unit, &state->rpcm, 1);
  1283. }
  1284. spin_unlock_irqrestore(&unit->reg_lock, flags);
  1285. }
  1286. set_current_state(TASK_RUNNING);
  1287. remove_wait_queue(&dmabuf->wait, &waita);
  1289. return ret;
  1290. }
  1292. static ssize_t
  1293. ymf_write(struct file *file, const char *buffer, size_t count, loff_t *ppos)
  1294. {
  1295. struct ymf_state *state = (struct ymf_state *)file->private_data;
  1296. struct ymf_dmabuf *dmabuf = &state->wpcm.dmabuf;
  1297. struct ymf_unit *unit = state->unit;
  1298. DECLARE_WAITQUEUE(waita, current);
  1299. ssize_t ret;
  1300. unsigned long flags;
  1301. unsigned int swptr;
  1302. int cnt; /* This many to go in this revolution */
  1303. int redzone;
  1304. int delay;
  1306. YMFDBGW("ymf_write: count %dn", count);
  1308. if (ppos != &file->f_pos)
  1309. return -ESPIPE;
  1310. if (dmabuf->mapped)
  1311. return -ENXIO;
  1312. if (!dmabuf->ready && (ret = prog_dmabuf(state, 0)))
  1313. return ret;
  1314. ret = 0;
  1316. /*
  1317.  * Alan's cs46xx works without a red zone - marvel of ingenuity.
  1318.  * We are not so brilliant... Red zone does two things:
  1319.  *  1. allows for safe start after a pause as we have no way
  1320.  *     to know what the actual, relentlessly advancing, hwptr is.
  1321.  *  2. makes computations in ymf_pcm_interrupt simpler.
  1322.  */
  1323. redzone = ymf_calc_lend(state->format.rate) << state->format.shift;
  1324. redzone *= 3; /* 2 redzone + 1 possible uncertainty reserve. */
  1326. add_wait_queue(&dmabuf->wait, &waita);
  1327. set_current_state(TASK_INTERRUPTIBLE);
  1328. while (count > 0) {
  1329. spin_lock_irqsave(&unit->reg_lock, flags);
  1330. if (unit->suspended) {
  1331. spin_unlock_irqrestore(&unit->reg_lock, flags);
  1332. schedule();
  1333. set_current_state(TASK_INTERRUPTIBLE);
  1334. if (signal_pending(current)) {
  1335. if (!ret) ret = -EAGAIN;
  1336. break;
  1337. }
  1338. continue;
  1339. }
  1340. if (dmabuf->count < 0) {
  1341. printk(KERN_ERR
  1342.    "ymf_write: count %d, was legal in cs46xxn",
  1343.     dmabuf->count);
  1344. dmabuf->count = 0;
  1345. }
  1346. if (dmabuf->count == 0) {
  1347. swptr = dmabuf->hwptr;
  1348. if (state->wpcm.running) {
  1349. /*
  1350.  * Add uncertainty reserve.
  1351.  */
  1352. cnt = ymf_calc_lend(state->format.rate);
  1353. cnt <<= state->format.shift;
  1354. if ((swptr += cnt) >= dmabuf->dmasize) {
  1355. swptr -= dmabuf->dmasize;
  1356. }
  1357. }
  1358. dmabuf->swptr = swptr;
  1359. } else {
  1360. /*
  1361.  * XXX This is not right if dmabuf->count is small -
  1362.  * about 2*x frame size or less. We cannot count on
  1363.  * on appending and not causing an artefact.
  1364.  * Should use a variation of the count==0 case above.
  1365.  */
  1366. swptr = dmabuf->swptr;
  1367. }
  1368. cnt = dmabuf->dmasize - swptr;
  1369. if (dmabuf->count + cnt > dmabuf->dmasize - redzone)
  1370. cnt = (dmabuf->dmasize - redzone) - dmabuf->count;
  1371. spin_unlock_irqrestore(&unit->reg_lock, flags);
  1373. if (cnt > count)
  1374. cnt = count;
  1375. if (cnt <= 0) {
  1376. YMFDBGW("ymf_write: full, count %d swptr %dn",
  1377.    dmabuf->count, dmabuf->swptr);
  1378. /*
  1379.  * buffer is full, start the dma machine and
  1380.  * wait for data to be played
  1381.  */
  1382. spin_lock_irqsave(&unit->reg_lock, flags);
  1383. if (!state->wpcm.running) {
  1384. ymf_playback_trigger(unit, &state->wpcm, 1);
  1385. }
  1386. spin_unlock_irqrestore(&unit->reg_lock, flags);
  1387. if (file->f_flags & O_NONBLOCK) {
  1388. if (!ret) ret = -EAGAIN;
  1389. break;
  1390. }
  1391. schedule();
  1392. set_current_state(TASK_INTERRUPTIBLE);
  1393. if (signal_pending(current)) {
  1394. if (!ret) ret = -ERESTARTSYS;
  1395. break;
  1396. }
  1397. continue;
  1398. }
  1399. if (copy_from_user(dmabuf->rawbuf + swptr, buffer, cnt)) {
  1400. if (!ret) ret = -EFAULT;
  1401. break;
  1402. }
  1404. if ((swptr += cnt) >= dmabuf->dmasize) {
  1405. swptr -= dmabuf->dmasize;
  1406. }
  1408. spin_lock_irqsave(&unit->reg_lock, flags);
  1409. if (unit->suspended) {
  1410. spin_unlock_irqrestore(&unit->reg_lock, flags);
  1411. continue;
  1412. }
  1413. dmabuf->swptr = swptr;
  1414. dmabuf->count += cnt;
  1416. /*
  1417.  * Start here is a bad idea - may cause startup click
  1418.  * in /bin/play when dmabuf is not full yet.
  1419.  * However, some broken applications do not make
  1420.  * any use of SNDCTL_DSP_SYNC (Doom is the worst).
  1421.  * One frame is about 5.3ms, Doom write size is 46ms.
  1422.  */
  1423. delay = state->format.rate / 20; /* 50ms */
  1424. delay <<= state->format.shift;
  1425. if (dmabuf->count >= delay && !state->wpcm.running) {
  1426. ymf_playback_trigger(unit, &state->wpcm, 1);
  1427. }
  1429. spin_unlock_irqrestore(&unit->reg_lock, flags);
  1431. count -= cnt;
  1432. buffer += cnt;
  1433. ret += cnt;
  1434. }
  1436. set_current_state(TASK_RUNNING);
  1437. remove_wait_queue(&dmabuf->wait, &waita);
  1439. YMFDBGW("ymf_write: ret %d dmabuf.count %dn", ret, dmabuf->count);
  1440. return ret;
  1441. }
  1443. static unsigned int ymf_poll(struct file *file, struct poll_table_struct *wait)
  1444. {
  1445. struct ymf_state *state = (struct ymf_state *)file->private_data;
  1446. struct ymf_dmabuf *dmabuf;
  1447. int redzone;
  1448. unsigned long flags;
  1449. unsigned int mask = 0;
  1451. if (file->f_mode & FMODE_WRITE)
  1452. poll_wait(file, &state->wpcm.dmabuf.wait, wait);
  1453. if (file->f_mode & FMODE_READ)
  1454. poll_wait(file, &state->rpcm.dmabuf.wait, wait);
  1456. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1457. if (file->f_mode & FMODE_READ) {
  1458. dmabuf = &state->rpcm.dmabuf;
  1459. if (dmabuf->count >= (signed)dmabuf->fragsize)
  1460. mask |= POLLIN | POLLRDNORM;
  1461. }
  1462. if (file->f_mode & FMODE_WRITE) {
  1463. redzone = ymf_calc_lend(state->format.rate);
  1464. redzone <<= state->format.shift;
  1465. redzone *= 3;
  1467. dmabuf = &state->wpcm.dmabuf;
  1468. if (dmabuf->mapped) {
  1469. if (dmabuf->count >= (signed)dmabuf->fragsize)
  1470. mask |= POLLOUT | POLLWRNORM;
  1471. } else {
  1472. /*
  1473.  * Don't select unless a full fragment is available.
  1474.  * Otherwise artsd does GETOSPACE, sees 0, and loops.
  1475.  */
  1476. if (dmabuf->count + redzone + dmabuf->fragsize
  1477.      <= dmabuf->dmasize)
  1478. mask |= POLLOUT | POLLWRNORM;
  1479. }
  1480. }
  1481. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1483. return mask;
  1484. }
  1486. static int ymf_mmap(struct file *file, struct vm_area_struct *vma)
  1487. {
  1488. struct ymf_state *state = (struct ymf_state *)file->private_data;
  1489. struct ymf_dmabuf *dmabuf = &state->wpcm.dmabuf;
  1490. int ret;
  1491. unsigned long size;
  1493. if (vma->vm_flags & VM_WRITE) {
  1494. if ((ret = prog_dmabuf(state, 0)) != 0)
  1495. return ret;
  1496. } else if (vma->vm_flags & VM_READ) {
  1497. if ((ret = prog_dmabuf(state, 1)) != 0)
  1498. return ret;
  1499. } else 
  1500. return -EINVAL;
  1502. if (vma->vm_pgoff != 0)
  1503. return -EINVAL;
  1504. size = vma->vm_end - vma->vm_start;
  1505. if (size > (PAGE_SIZE << dmabuf->buforder))
  1506. return -EINVAL;
  1507. if (remap_page_range(vma->vm_start, virt_to_phys(dmabuf->rawbuf),
  1508.      size, vma->vm_page_prot))
  1509. return -EAGAIN;
  1510. dmabuf->mapped = 1;
  1512. /* P3 */ printk(KERN_INFO "ymfpci: using memory mapped sound, untested!n");
  1513. return 0;
  1514. }
  1516. static int ymf_ioctl(struct inode *inode, struct file *file,
  1517.     unsigned int cmd, unsigned long arg)
  1518. {
  1519. struct ymf_state *state = (struct ymf_state *)file->private_data;
  1520. struct ymf_dmabuf *dmabuf;
  1521. unsigned long flags;
  1522. audio_buf_info abinfo;
  1523. count_info cinfo;
  1524. int redzone;
  1525. int val;
  1527. switch (cmd) {
  1528. case OSS_GETVERSION:
  1529. YMFDBGX("ymf_ioctl: cmd 0x%x(GETVER) arg 0x%lxn", cmd, arg);
  1530. return put_user(SOUND_VERSION, (int *)arg);
  1532. case SNDCTL_DSP_RESET:
  1533. YMFDBGX("ymf_ioctl: cmd 0x%x(RESET)n", cmd);
  1534. if (file->f_mode & FMODE_WRITE) {
  1535. ymf_wait_dac(state);
  1536. dmabuf = &state->wpcm.dmabuf;
  1537. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1538. dmabuf->ready = 0;
  1539. dmabuf->swptr = dmabuf->hwptr;
  1540. dmabuf->count = dmabuf->total_bytes = 0;
  1541. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1542. }
  1543. if (file->f_mode & FMODE_READ) {
  1544. ymf_stop_adc(state);
  1545. dmabuf = &state->rpcm.dmabuf;
  1546. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1547. dmabuf->ready = 0;
  1548. dmabuf->swptr = dmabuf->hwptr;
  1549. dmabuf->count = dmabuf->total_bytes = 0;
  1550. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1551. }
  1552. return 0;
  1554. case SNDCTL_DSP_SYNC:
  1555. YMFDBGX("ymf_ioctl: cmd 0x%x(SYNC)n", cmd);
  1556. if (file->f_mode & FMODE_WRITE) {
  1557. dmabuf = &state->wpcm.dmabuf;
  1558. if (file->f_flags & O_NONBLOCK) {
  1559. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1560. if (dmabuf->count != 0 && !state->wpcm.running) {
  1561. ymf_start_dac(state);
  1562. }
  1563. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1564. } else {
  1565. ymf_wait_dac(state);
  1566. }
  1567. }
  1568. /* XXX What does this do for reading? dmabuf->count=0; ? */
  1569. return 0;
  1571. case SNDCTL_DSP_SPEED: /* set smaple rate */
  1572. if (get_user(val, (int *)arg))
  1573. return -EFAULT;
  1574. YMFDBGX("ymf_ioctl: cmd 0x%x(SPEED) sp %dn", cmd, val);
  1575. if (val >= 8000 && val <= 48000) {
  1576. if (file->f_mode & FMODE_WRITE) {
  1577. ymf_wait_dac(state);
  1578. dmabuf = &state->wpcm.dmabuf;
  1579. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1580. dmabuf->ready = 0;
  1581. state->format.rate = val;
  1582. ymf_pcm_update_shift(&state->format);
  1583. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1584. }
  1585. if (file->f_mode & FMODE_READ) {
  1586. ymf_stop_adc(state);
  1587. dmabuf = &state->rpcm.dmabuf;
  1588. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1589. dmabuf->ready = 0;
  1590. state->format.rate = val;
  1591. ymf_pcm_update_shift(&state->format);
  1592. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1593. }
  1594. }
  1595. return put_user(state->format.rate, (int *)arg);
  1597. /*
  1598.  * OSS manual does not mention SNDCTL_DSP_STEREO at all.
  1599.  * All channels are mono and if you want stereo, you
  1600.  * play into two channels with SNDCTL_DSP_CHANNELS.
  1601.  * However, mpg123 calls it. I wonder, why Michael Hipp used it.
  1602.  */
  1603. case SNDCTL_DSP_STEREO: /* set stereo or mono channel */
  1604. if (get_user(val, (int *)arg))
  1605. return -EFAULT;
  1606. YMFDBGX("ymf_ioctl: cmd 0x%x(STEREO) st %dn", cmd, val);
  1607. if (file->f_mode & FMODE_WRITE) {
  1608. ymf_wait_dac(state); 
  1609. dmabuf = &state->wpcm.dmabuf;
  1610. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1611. dmabuf->ready = 0;
  1612. state->format.voices = val ? 2 : 1;
  1613. ymf_pcm_update_shift(&state->format);
  1614. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1615. }
  1616. if (file->f_mode & FMODE_READ) {
  1617. ymf_stop_adc(state);
  1618. dmabuf = &state->rpcm.dmabuf;
  1619. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1620. dmabuf->ready = 0;
  1621. state->format.voices = val ? 2 : 1;
  1622. ymf_pcm_update_shift(&state->format);
  1623. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1624. }
  1625. return 0;
  1627. case SNDCTL_DSP_GETBLKSIZE:
  1628. YMFDBGX("ymf_ioctl: cmd 0x%x(GETBLK)n", cmd);
  1629. if (file->f_mode & FMODE_WRITE) {
  1630. if ((val = prog_dmabuf(state, 0)))
  1631. return val;
  1632. val = state->wpcm.dmabuf.fragsize;
  1633. YMFDBGX("ymf_ioctl: GETBLK w %dn", val);
  1634. return put_user(val, (int *)arg);
  1635. }
  1636. if (file->f_mode & FMODE_READ) {
  1637. if ((val = prog_dmabuf(state, 1)))
  1638. return val;
  1639. val = state->rpcm.dmabuf.fragsize;
  1640. YMFDBGX("ymf_ioctl: GETBLK r %dn", val);
  1641. return put_user(val, (int *)arg);
  1642. }
  1643. return -EINVAL;
  1645. case SNDCTL_DSP_GETFMTS: /* Returns a mask of supported sample format*/
  1646. YMFDBGX("ymf_ioctl: cmd 0x%x(GETFMTS)n", cmd);
  1647. return put_user(AFMT_S16_LE|AFMT_U8, (int *)arg);
  1649. case SNDCTL_DSP_SETFMT: /* Select sample format */
  1650. if (get_user(val, (int *)arg))
  1651. return -EFAULT;
  1652. YMFDBGX("ymf_ioctl: cmd 0x%x(SETFMT) fmt %dn", cmd, val);
  1653. if (val == AFMT_S16_LE || val == AFMT_U8) {
  1654. if (file->f_mode & FMODE_WRITE) {
  1655. ymf_wait_dac(state);
  1656. dmabuf = &state->wpcm.dmabuf;
  1657. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1658. dmabuf->ready = 0;
  1659. state->format.format = val;
  1660. ymf_pcm_update_shift(&state->format);
  1661. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1662. }
  1663. if (file->f_mode & FMODE_READ) {
  1664. ymf_stop_adc(state);
  1665. dmabuf = &state->rpcm.dmabuf;
  1666. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1667. dmabuf->ready = 0;
  1668. state->format.format = val;
  1669. ymf_pcm_update_shift(&state->format);
  1670. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1671. }
  1672. }
  1673. return put_user(state->format.format, (int *)arg);
  1675. case SNDCTL_DSP_CHANNELS:
  1676. if (get_user(val, (int *)arg))
  1677. return -EFAULT;
  1678. YMFDBGX("ymf_ioctl: cmd 0x%x(CHAN) ch %dn", cmd, val);
  1679. if (val != 0) {
  1680. if (file->f_mode & FMODE_WRITE) {
  1681. ymf_wait_dac(state);
  1682. if (val == 1 || val == 2) {
  1683. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1684. dmabuf = &state->wpcm.dmabuf;
  1685. dmabuf->ready = 0;
  1686. state->format.voices = val;
  1687. ymf_pcm_update_shift(&state->format);
  1688. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1689. }
  1690. }
  1691. if (file->f_mode & FMODE_READ) {
  1692. ymf_stop_adc(state);
  1693. if (val == 1 || val == 2) {
  1694. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1695. dmabuf = &state->rpcm.dmabuf;
  1696. dmabuf->ready = 0;
  1697. state->format.voices = val;
  1698. ymf_pcm_update_shift(&state->format);
  1699. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1700. }
  1701. }
  1702. }
  1703. return put_user(state->format.voices, (int *)arg);
  1705. case SNDCTL_DSP_POST:
  1706. YMFDBGX("ymf_ioctl: cmd 0x%x(POST)n", cmd);
  1707. /*
  1708.  * Quoting OSS PG:
  1709.  *    The ioctl SNDCTL_DSP_POST is a lightweight version of
  1710.  *    SNDCTL_DSP_SYNC. It just tells to the driver that there
  1711.  *    is likely to be a pause in the output. This makes it
  1712.  *    possible for the device to handle the pause more
  1713.  *    intelligently. This ioctl doesn't block the application.
  1714.  *
  1715.  * The paragraph above is a clumsy way to say "flush ioctl".
  1716.  * This ioctl is used by mpg123.
  1717.  */
  1718. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1719. if (state->wpcm.dmabuf.count != 0 && !state->wpcm.running) {
  1720. ymf_start_dac(state);
  1721. }
  1722. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1723. return 0;
  1725. case SNDCTL_DSP_SETFRAGMENT:
  1726. if (get_user(val, (int *)arg))
  1727. return -EFAULT;
  1728. YMFDBGX("ymf_ioctl: cmd 0x%x(SETFRAG) fr 0x%04x:%04x(%d:%d)n",
  1729.     cmd,
  1730.     (val >> 16) & 0xFFFF, val & 0xFFFF,
  1731.     (val >> 16) & 0xFFFF, val & 0xFFFF);
  1732. dmabuf = &state->wpcm.dmabuf;
  1733. dmabuf->ossfragshift = val & 0xffff;
  1734. dmabuf->ossmaxfrags = (val >> 16) & 0xffff;
  1735. if (dmabuf->ossfragshift < 4)
  1736. dmabuf->ossfragshift = 4;
  1737. if (dmabuf->ossfragshift > 15)
  1738. dmabuf->ossfragshift = 15;
  1739. return 0;
  1741. case SNDCTL_DSP_GETOSPACE:
  1742. YMFDBGX("ymf_ioctl: cmd 0x%x(GETOSPACE)n", cmd);
  1743. if (!(file->f_mode & FMODE_WRITE))
  1744. return -EINVAL;
  1745. dmabuf = &state->wpcm.dmabuf;
  1746. if (!dmabuf->ready && (val = prog_dmabuf(state, 0)) != 0)
  1747. return val;
  1748. redzone = ymf_calc_lend(state->format.rate);
  1749. redzone <<= state->format.shift;
  1750. redzone *= 3;
  1751. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1752. abinfo.fragsize = dmabuf->fragsize;
  1753. abinfo.bytes = dmabuf->dmasize - dmabuf->count - redzone;
  1754. abinfo.fragstotal = dmabuf->numfrag;
  1755. abinfo.fragments = abinfo.bytes >> dmabuf->fragshift;
  1756. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1757. return copy_to_user((void *)arg, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  1759. case SNDCTL_DSP_GETISPACE:
  1760. YMFDBGX("ymf_ioctl: cmd 0x%x(GETISPACE)n", cmd);
  1761. if (!(file->f_mode & FMODE_READ))
  1762. return -EINVAL;
  1763. dmabuf = &state->rpcm.dmabuf;
  1764. if (!dmabuf->ready && (val = prog_dmabuf(state, 1)) != 0)
  1765. return val;
  1766. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1767. abinfo.fragsize = dmabuf->fragsize;
  1768. abinfo.bytes = dmabuf->count;
  1769. abinfo.fragstotal = dmabuf->numfrag;
  1770. abinfo.fragments = abinfo.bytes >> dmabuf->fragshift;
  1771. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1772. return copy_to_user((void *)arg, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  1774. case SNDCTL_DSP_NONBLOCK:
  1775. YMFDBGX("ymf_ioctl: cmd 0x%x(NONBLOCK)n", cmd);
  1776. file->f_flags |= O_NONBLOCK;
  1777. return 0;
  1779. case SNDCTL_DSP_GETCAPS:
  1780. YMFDBGX("ymf_ioctl: cmd 0x%x(GETCAPS)n", cmd);
  1781. /* return put_user(DSP_CAP_REALTIME|DSP_CAP_TRIGGER|DSP_CAP_MMAP,
  1782.     (int *)arg); */
  1783. return put_user(0, (int *)arg);
  1785. case SNDCTL_DSP_GETIPTR:
  1786. YMFDBGX("ymf_ioctl: cmd 0x%x(GETIPTR)n", cmd);
  1787. if (!(file->f_mode & FMODE_READ))
  1788. return -EINVAL;
  1789. dmabuf = &state->rpcm.dmabuf;
  1790. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1791. cinfo.bytes = dmabuf->total_bytes;
  1792. cinfo.blocks = dmabuf->count >> dmabuf->fragshift;
  1793. cinfo.ptr = dmabuf->hwptr;
  1794. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1795. YMFDBGX("ymf_ioctl: GETIPTR ptr %d bytes %dn",
  1796.     cinfo.ptr, cinfo.bytes);
  1797. return copy_to_user((void *)arg, &cinfo, sizeof(cinfo)) ? -EFAULT : 0;
  1799. case SNDCTL_DSP_GETOPTR:
  1800. YMFDBGX("ymf_ioctl: cmd 0x%x(GETOPTR)n", cmd);
  1801. if (!(file->f_mode & FMODE_WRITE))
  1802. return -EINVAL;
  1803. dmabuf = &state->wpcm.dmabuf;
  1804. spin_lock_irqsave(&state->unit->reg_lock, flags);
  1805. cinfo.bytes = dmabuf->total_bytes;
  1806. cinfo.blocks = dmabuf->count >> dmabuf->fragshift;
  1807. cinfo.ptr = dmabuf->hwptr;
  1808. spin_unlock_irqrestore(&state->unit->reg_lock, flags);
  1809. YMFDBGX("ymf_ioctl: GETOPTR ptr %d bytes %dn",
  1810.     cinfo.ptr, cinfo.bytes);
  1811. return copy_to_user((void *)arg, &cinfo, sizeof(cinfo)) ? -EFAULT : 0;
  1813. case SNDCTL_DSP_SETDUPLEX: /* XXX TODO */
  1814. YMFDBGX("ymf_ioctl: cmd 0x%x(SETDUPLEX)n", cmd);
  1815. return -EINVAL;
  1817. case SOUND_PCM_READ_RATE:
  1818. YMFDBGX("ymf_ioctl: cmd 0x%x(READ_RATE)n", cmd);
  1819. return put_user(state->format.rate, (int *)arg);
  1821. case SOUND_PCM_READ_CHANNELS:
  1822. YMFDBGX("ymf_ioctl: cmd 0x%x(READ_CH)n", cmd);
  1823. return put_user(state->format.voices, (int *)arg);
  1825. case SOUND_PCM_READ_BITS:
  1826. YMFDBGX("ymf_ioctl: cmd 0x%x(READ_BITS)n", cmd);
  1827. return put_user(AFMT_S16_LE, (int *)arg);
  1829. case SNDCTL_DSP_MAPINBUF:
  1830. case SNDCTL_DSP_MAPOUTBUF:
  1831. case SNDCTL_DSP_SETSYNCRO:
  1832. case SOUND_PCM_WRITE_FILTER:
  1833. case SOUND_PCM_READ_FILTER:
  1834. YMFDBGX("ymf_ioctl: cmd 0x%x unsupportedn", cmd);
  1835. return -ENOTTY;
  1837. default:
  1838. /*
  1839.  * Some programs mix up audio devices and ioctls
  1840.  * or perhaps they expect "universal" ioctls,
  1841.  * for instance we get SNDCTL_TMR_CONTINUE here.
  1842.  */
  1843. YMFDBGX("ymf_ioctl: cmd 0x%x unknownn", cmd);
  1844. break;
  1845. }
  1846. return -ENOTTY;
  1847. }
  1849. /*
  1850.  * open(2)
  1851.  * We use upper part of the minor to distinguish between soundcards.
  1852.  * Channels are opened with a clone open.
  1853.  */
  1854. static int ymf_open(struct inode *inode, struct file *file)
  1855. {
  1856. struct list_head *list;
  1857. ymfpci_t *unit = NULL;
  1858. int minor;
  1859. struct ymf_state *state;
  1860. int err;
  1862. minor = MINOR(inode->i_rdev);
  1863. if ((minor & 0x0F) == 3) { /* /dev/dspN */
  1864. ;
  1865. } else {
  1866. return -ENXIO;
  1867. }
  1869. unit = NULL; /* gcc warns */
  1870. list_for_each(list, &ymf_devs) {
  1871. unit = list_entry(list, ymfpci_t, ymf_devs);
  1872. if (((unit->dev_audio ^ minor) & ~0x0F) == 0)
  1873. break;
  1874. }
  1875. if (list == &ymf_devs)
  1876. return -ENODEV;
  1878. down(&unit->open_sem);
  1880. if ((state = ymf_state_alloc(unit)) == NULL) {
  1881. up(&unit->open_sem);
  1882. return -ENOMEM;
  1883. }
  1884. list_add_tail(&state->chain, &unit->states);
  1886. file->private_data = state;
  1888. /*
  1889.  * ymf_read and ymf_write that we borrowed from cs46xx
  1890.  * allocate buffers with prog_dmabuf(). We call prog_dmabuf
  1891.  * here so that in case of DMA memory exhaustion open
  1892.  * fails rather than write.
  1893.  *
  1894.  * XXX prog_dmabuf allocates voice. Should allocate explicitly, above.
  1895.  */
  1896. if (file->f_mode & FMODE_WRITE) {
  1897. if (!state->wpcm.dmabuf.ready) {
  1898. if ((err = prog_dmabuf(state, 0)) != 0) {
  1899. goto out_nodma;
  1900. }
  1901. }
  1902. }
  1903. if (file->f_mode & FMODE_READ) {
  1904. if (!state->rpcm.dmabuf.ready) {
  1905. if ((err = prog_dmabuf(state, 1)) != 0) {
  1906. goto out_nodma;
  1907. }
  1908. }
  1909. }
  1911. #if 0 /* test if interrupts work */
  1912. ymfpci_writew(unit, YDSXGR_TIMERCOUNT, 0xfffe); /* ~ 680ms */
  1913. ymfpci_writeb(unit, YDSXGR_TIMERCTRL,
  1914.     (YDSXGR_TIMERCTRL_TEN|YDSXGR_TIMERCTRL_TIEN));
  1915. #endif
  1916. up(&unit->open_sem);
  1918. return 0;
  1920. out_nodma:
  1921. /*
  1922.  * XXX Broken custom: "goto out_xxx" in other place is
  1923.  * a nestable exception, but here it is not nestable due to semaphore.
  1924.  * XXX Doubtful technique of self-describing objects....
  1925.  */
  1926. dealloc_dmabuf(&state->wpcm.dmabuf);
  1927. dealloc_dmabuf(&state->rpcm.dmabuf);
  1928. ymf_pcm_free_substream(&state->wpcm);
  1929. ymf_pcm_free_substream(&state->rpcm);
  1931. list_del(&state->chain);
  1932. kfree(state);
  1934. up(&unit->open_sem);
  1935. return err;
  1936. }
  1938. static int ymf_release(struct inode *inode, struct file *file)
  1939. {
  1940. struct ymf_state *state = (struct ymf_state *)file->private_data;
  1941. ymfpci_t *unit = state->unit;
  1943. #if 0 /* test if interrupts work */
  1944. ymfpci_writeb(unit, YDSXGR_TIMERCTRL, 0);
  1945. #endif
  1947. down(&unit->open_sem);
  1949. /*
  1950.  * XXX Solve the case of O_NONBLOCK close - don't deallocate here.
  1951.  * Deallocate when unloading the driver and we can wait.
  1952.  */
  1953. ymf_wait_dac(state);
  1954. ymf_stop_adc(state); /* fortunately, it's immediate */
  1955. dealloc_dmabuf(&state->wpcm.dmabuf);
  1956. dealloc_dmabuf(&state->rpcm.dmabuf);
  1957. ymf_pcm_free_substream(&state->wpcm);
  1958. ymf_pcm_free_substream(&state->rpcm);
  1960. list_del(&state->chain);
  1961. file->private_data = NULL; /* Can you tell I programmed Solaris */
  1962. kfree(state);
  1964. up(&unit->open_sem);
  1966. return 0;
  1967. }
  1969. /*
  1970.  * Mixer operations are based on cs46xx.
  1971.  */
  1972. static int ymf_open_mixdev(struct inode *inode, struct file *file)
  1973. {
  1974. int minor = MINOR(inode->i_rdev);
  1975. struct list_head *list;
  1976. ymfpci_t *unit;
  1977. int i;
  1979. list_for_each(list, &ymf_devs) {
  1980. unit = list_entry(list, ymfpci_t, ymf_devs);
  1981. for (i = 0; i < NR_AC97; i++) {
  1982. if (unit->ac97_codec[i] != NULL &&
  1983.     unit->ac97_codec[i]->dev_mixer == minor) {
  1984. goto match;
  1985. }
  1986. }
  1987. }
  1988. return -ENODEV;
  1990.  match:
  1991. file->private_data = unit->ac97_codec[i];
  1993. return 0;
  1994. }
  1996. static int ymf_ioctl_mixdev(struct inode *inode, struct file *file,
  1997.     unsigned int cmd, unsigned long arg)
  1998. {
  1999. struct ac97_codec *codec = (struct ac97_codec *)file->private_data;
  2001. return codec->mixer_ioctl(codec, cmd, arg);
  2002. }
  2004. static int ymf_release_mixdev(struct inode *inode, struct file *file)
  2005. {
  2006. return 0;
  2007. }
  2009. static /*const*/ struct file_operations ymf_fops = {
  2010. owner: THIS_MODULE,
  2011. llseek: no_llseek,
  2012. read: ymf_read,
  2013. write: ymf_write,
  2014. poll: ymf_poll,
  2015. ioctl: ymf_ioctl,
  2016. mmap: ymf_mmap,
  2017. open: ymf_open,
  2018. release: ymf_release,
  2019. };
  2021. static /*const*/ struct file_operations ymf_mixer_fops = {
  2022. owner: THIS_MODULE,
  2023. llseek: no_llseek,
  2024. ioctl: ymf_ioctl_mixdev,
  2025. open: ymf_open_mixdev,
  2026. release: ymf_release_mixdev,
  2027. };
  2029. /*
  2030.  */
  2032. static int ymf_suspend(struct pci_dev *pcidev, u32 unused)
  2033. {
  2034. struct ymf_unit *unit = pci_get_drvdata(pcidev);
  2035. unsigned long flags;
  2036. struct ymf_dmabuf *dmabuf;
  2037. struct list_head *p;
  2038. struct ymf_state *state;
  2039. struct ac97_codec *codec;
  2040. int i;
  2042. spin_lock_irqsave(&unit->reg_lock, flags);
  2044. unit->suspended = 1;
  2046. /*
  2047.  * XXX Talk to Kai to remove ac97_save_state before it's too late!
  2048.  * Other drivers call ac97_reset, which does not have
  2049.  * a save counterpart. Current ac97_save_state is empty.
  2050.  */
  2051. for (i = 0; i < NR_AC97; i++) {
  2052. if ((codec = unit->ac97_codec[i]) != NULL)
  2053. ac97_save_state(codec);
  2054. }
  2056. list_for_each(p, &unit->states) {
  2057. state = list_entry(p, struct ymf_state, chain);
  2059. dmabuf = &state->wpcm.dmabuf;
  2060. dmabuf->hwptr = dmabuf->swptr = 0;
  2061. dmabuf->total_bytes = 0;
  2062. dmabuf->count = 0;
  2064. dmabuf = &state->rpcm.dmabuf;
  2065. dmabuf->hwptr = dmabuf->swptr = 0;
  2066. dmabuf->total_bytes = 0;
  2067. dmabuf->count = 0;
  2068. }
  2070. ymfpci_writel(unit, YDSXGR_NATIVEDACOUTVOL, 0);
  2071. ymfpci_disable_dsp(unit);
  2073. spin_unlock_irqrestore(&unit->reg_lock, flags);
  2075. return 0;
  2076. }
  2078. static int ymf_resume(struct pci_dev *pcidev)
  2079. {
  2080. struct ymf_unit *unit = pci_get_drvdata(pcidev);
  2081. unsigned long flags;
  2082. struct list_head *p;
  2083. struct ymf_state *state;
  2084. struct ac97_codec *codec;
  2085. int i;
  2087. ymfpci_aclink_reset(unit->pci);
  2088. ymfpci_codec_ready(unit, 0, 1); /* prints diag if not ready. */
  2090. #ifdef CONFIG_SOUND_YMFPCI_LEGACY
  2091. /* XXX At this time the legacy registers are probably deprogrammed. */
  2092. #endif
  2094. ymfpci_download_image(unit);
  2096. ymf_memload(unit);
  2098. spin_lock_irqsave(&unit->reg_lock, flags);
  2100. if (unit->start_count) {
  2101. ymfpci_writel(unit, YDSXGR_MODE, 3);
  2102. unit->active_bank = ymfpci_readl(unit, YDSXGR_CTRLSELECT) & 1;
  2103. }
  2105. for (i = 0; i < NR_AC97; i++) {
  2106. if ((codec = unit->ac97_codec[i]) != NULL)
  2107. ac97_restore_state(codec);
  2108. }
  2110. unit->suspended = 0;
  2111. list_for_each(p, &unit->states) {
  2112. state = list_entry(p, struct ymf_state, chain);
  2113. wake_up(&state->wpcm.dmabuf.wait);
  2114. wake_up(&state->rpcm.dmabuf.wait);
  2115. }
  2117. spin_unlock_irqrestore(&unit->reg_lock, flags);
  2118. return 0;
  2119. }
  2121. /*
  2122.  *  initialization routines
  2123.  */
  2125. #ifdef CONFIG_SOUND_YMFPCI_LEGACY
  2127. static int ymfpci_setup_legacy(ymfpci_t *unit, struct pci_dev *pcidev)
  2128. {
  2129. int v;
  2130. int mpuio = -1, oplio = -1;
  2132. switch (unit->iomidi) {
  2133. case 0x330:
  2134. mpuio = 0;
  2135. break;
  2136. case 0x300:
  2137. mpuio = 1;
  2138. break;
  2139. case 0x332:
  2140. mpuio = 2;
  2141. break;
  2142. case 0x334:
  2143. mpuio = 3;
  2144. break;
  2145. default: ;
  2146. }
  2148. switch (unit->iosynth) {
  2149. case 0x388:
  2150. oplio = 0;
  2151. break;
  2152. case 0x398:
  2153. oplio = 1;
  2154. break;
  2155. case 0x3a0:
  2156. oplio = 2;
  2157. break;
  2158. case 0x3a8:
  2159. oplio = 3;
  2160. break;
  2161. default: ;
  2162. }
  2164. if (mpuio >= 0 || oplio >= 0) {
  2165. /* 0x0020: 1 - 10 bits of I/O address decoded, 0 - 16 bits. */
  2166. v = 0x001e;
  2167. pci_write_config_word(pcidev, PCIR_LEGCTRL, v);
  2169. switch (pcidev->device) {
  2170. case PCI_DEVICE_ID_YAMAHA_724:
  2171. case PCI_DEVICE_ID_YAMAHA_740:
  2172. case PCI_DEVICE_ID_YAMAHA_724F:
  2173. case PCI_DEVICE_ID_YAMAHA_740C:
  2174. v = 0x8800;
  2175. if (mpuio >= 0) { v |= mpuio<<4; }
  2176. if (oplio >= 0) { v |= oplio; }
  2177. pci_write_config_word(pcidev, PCIR_ELEGCTRL, v);
  2178. break;
  2180. case PCI_DEVICE_ID_YAMAHA_744:
  2181. case PCI_DEVICE_ID_YAMAHA_754:
  2182. v = 0x8800;
  2183. pci_write_config_word(pcidev, PCIR_ELEGCTRL, v);
  2184. if (oplio >= 0) {
  2185. pci_write_config_word(pcidev, PCIR_OPLADR, unit->iosynth);
  2186. }
  2187. if (mpuio >= 0) {
  2188. pci_write_config_word(pcidev, PCIR_MPUADR, unit->iomidi);
  2189. }
  2190. break;
  2192. default:
  2193. printk(KERN_ERR "ymfpci: Unknown device ID: 0x%xn",
  2194.     pcidev->device);
  2195. return -EINVAL;
  2196. }
  2197. }
  2199. return 0;
  2200. }
  2201. #endif /* CONFIG_SOUND_YMFPCI_LEGACY */
  2203. static void ymfpci_aclink_reset(struct pci_dev * pci)
  2204. {
  2205. u8 cmd;
  2207. /*
  2208.  * In the 744, 754 only 0x01 exists, 0x02 is undefined.
  2209.  * It does not seem to hurt to trip both regardless of revision.
  2210.  */
  2211. pci_read_config_byte(pci, PCIR_DSXGCTRL, &cmd);
  2212. pci_write_config_byte(pci, PCIR_DSXGCTRL, cmd & 0xfc);
  2213. pci_write_config_byte(pci, PCIR_DSXGCTRL, cmd | 0x03);
  2214. pci_write_config_byte(pci, PCIR_DSXGCTRL, cmd & 0xfc);
  2216. pci_write_config_word(pci, PCIR_DSXPWRCTRL1, 0);
  2217. pci_write_config_word(pci, PCIR_DSXPWRCTRL2, 0);
  2218. }
  2220. static void ymfpci_enable_dsp(ymfpci_t *codec)
  2221. {
  2222. ymfpci_writel(codec, YDSXGR_CONFIG, 0x00000001);
  2223. }
  2225. static void ymfpci_disable_dsp(ymfpci_t *codec)
  2226. {
  2227. u32 val;
  2228. int timeout = 1000;
  2230. val = ymfpci_readl(codec, YDSXGR_CONFIG);
  2231. if (val)
  2232. ymfpci_writel(codec, YDSXGR_CONFIG, 0x00000000);
  2233. while (timeout-- > 0) {
  2234. val = ymfpci_readl(codec, YDSXGR_STATUS);
  2235. if ((val & 0x00000002) == 0)
  2236. break;
  2237. }
  2238. }
  2240. #include "ymfpci_image.h"
  2242. static void ymfpci_download_image(ymfpci_t *codec)
  2243. {
  2244. int i, ver_1e;
  2245. u16 ctrl;
  2247. ymfpci_writel(codec, YDSXGR_NATIVEDACOUTVOL, 0x00000000);
  2248. ymfpci_disable_dsp(codec);
  2249. ymfpci_writel(codec, YDSXGR_MODE, 0x00010000);
  2250. ymfpci_writel(codec, YDSXGR_MODE, 0x00000000);
  2251. ymfpci_writel(codec, YDSXGR_MAPOFREC, 0x00000000);
  2252. ymfpci_writel(codec, YDSXGR_MAPOFEFFECT, 0x00000000);
  2253. ymfpci_writel(codec, YDSXGR_PLAYCTRLBASE, 0x00000000);
  2254. ymfpci_writel(codec, YDSXGR_RECCTRLBASE, 0x00000000);
  2255. ymfpci_writel(codec, YDSXGR_EFFCTRLBASE, 0x00000000);
  2256. ctrl = ymfpci_readw(codec, YDSXGR_GLOBALCTRL);
  2257. ymfpci_writew(codec, YDSXGR_GLOBALCTRL, ctrl & ~0x0007);
  2259. /* setup DSP instruction code */
  2260. for (i = 0; i < YDSXG_DSPLENGTH / 4; i++)
  2261. ymfpci_writel(codec, YDSXGR_DSPINSTRAM + (i << 2), DspInst[i]);
  2263. switch (codec->pci->device) {
  2264. case PCI_DEVICE_ID_YAMAHA_724F:
  2265. case PCI_DEVICE_ID_YAMAHA_740C:
  2266. case PCI_DEVICE_ID_YAMAHA_744:
  2267. case PCI_DEVICE_ID_YAMAHA_754:
  2268. ver_1e = 1;
  2269. break;
  2270. default:
  2271. ver_1e = 0;
  2272. }
  2274. if (ver_1e) {
  2275. /* setup control instruction code */
  2276. for (i = 0; i < YDSXG_CTRLLENGTH / 4; i++)
  2277. ymfpci_writel(codec, YDSXGR_CTRLINSTRAM + (i << 2), CntrlInst1E[i]);
  2278. } else {
  2279. for (i = 0; i < YDSXG_CTRLLENGTH / 4; i++)
  2280. ymfpci_writel(codec, YDSXGR_CTRLINSTRAM + (i << 2), CntrlInst[i]);
  2281. }
  2283. ymfpci_enable_dsp(codec);
  2285. /* 0.02s sounds not too bad, we may do schedule_timeout() later. */
  2286. mdelay(20); /* seems we need some delay after downloading image.. */
  2287. }
  2289. static int ymfpci_memalloc(ymfpci_t *codec)
  2290. {
  2291. long size, playback_ctrl_size;
  2292. int voice, bank;
  2293. u8 *ptr;
  2295. playback_ctrl_size = 4 + 4 * YDSXG_PLAYBACK_VOICES;
  2296. codec->bank_size_playback = ymfpci_readl(codec, YDSXGR_PLAYCTRLSIZE) << 2;
  2297. codec->bank_size_capture = ymfpci_readl(codec, YDSXGR_RECCTRLSIZE) << 2;
  2298. codec->bank_size_effect = ymfpci_readl(codec, YDSXGR_EFFCTRLSIZE) << 2;
  2299. codec->work_size = YDSXG_DEFAULT_WORK_SIZE;
  2301. size = ((playback_ctrl_size + 0x00ff) & ~0x00ff) +
  2302.     ((codec->bank_size_playback * 2 * YDSXG_PLAYBACK_VOICES + 0xff) & ~0xff) +
  2303.     ((codec->bank_size_capture * 2 * YDSXG_CAPTURE_VOICES + 0xff) & ~0xff) +
  2304.     ((codec->bank_size_effect * 2 * YDSXG_EFFECT_VOICES + 0xff) & ~0xff) +
  2305.     codec->work_size;
  2307. ptr = (u8 *)kmalloc(size + 0x00ff, GFP_KERNEL);
  2308. if (ptr == NULL)
  2309. return -ENOMEM;
  2311. codec->work_ptr = ptr;
  2312. ptr += 0x00ff;
  2313. (long)ptr &= ~0x00ff;
  2315. /*
  2316.  * Hardware requires only ptr[playback_ctrl_size] zeroed,
  2317.  * but in our judgement it is a wrong kind of savings, so clear it all.
  2318.  */
  2319. memset(ptr, 0, size);
  2321. codec->bank_base_playback = ptr;
  2322. codec->ctrl_playback = (u32 *)ptr;
  2323. codec->ctrl_playback[0] = YDSXG_PLAYBACK_VOICES;
  2324. ptr += (playback_ctrl_size + 0x00ff) & ~0x00ff;
  2325. for (voice = 0; voice < YDSXG_PLAYBACK_VOICES; voice++) {
  2326. for (bank = 0; bank < 2; bank++) {
  2327. codec->bank_playback[voice][bank] = (ymfpci_playback_bank_t *)ptr;
  2328. ptr += codec->bank_size_playback;
  2329. }
  2330. codec->voices[voice].number = voice;
  2331. codec->voices[voice].bank = codec->bank_playback[voice][0];
  2332. }
  2333. ptr += (codec->bank_size_playback + 0x00ff) & ~0x00ff;
  2334. codec->bank_base_capture = ptr;
  2335. for (voice = 0; voice < YDSXG_CAPTURE_VOICES; voice++)
  2336. for (bank = 0; bank < 2; bank++) {
  2337. codec->bank_capture[voice][bank] = (ymfpci_capture_bank_t *)ptr;
  2338. ptr += codec->bank_size_capture;
  2339. }
  2340. ptr += (codec->bank_size_capture + 0x00ff) & ~0x00ff;
  2341. codec->bank_base_effect = ptr;
  2342. for (voice = 0; voice < YDSXG_EFFECT_VOICES; voice++)
  2343. for (bank = 0; bank < 2; bank++) {
  2344. codec->bank_effect[voice][bank] = (ymfpci_effect_bank_t *)ptr;
  2345. ptr += codec->bank_size_effect;
  2346. }
  2347. ptr += (codec->bank_size_effect + 0x00ff) & ~0x00ff;
  2348. codec->work_base = ptr;
  2350. return 0;
  2351. }
  2353. static void ymfpci_memfree(ymfpci_t *codec)
  2354. {
  2355. ymfpci_writel(codec, YDSXGR_PLAYCTRLBASE, 0);
  2356. ymfpci_writel(codec, YDSXGR_RECCTRLBASE, 0);
  2357. ymfpci_writel(codec, YDSXGR_EFFCTRLBASE, 0);
  2358. ymfpci_writel(codec, YDSXGR_WORKBASE, 0);
  2359. ymfpci_writel(codec, YDSXGR_WORKSIZE, 0);
  2360. kfree(codec->work_ptr);
  2361. }
  2363. static void ymf_memload(ymfpci_t *unit)
  2364. {
  2366. ymfpci_writel(unit, YDSXGR_PLAYCTRLBASE, virt_to_bus(unit->bank_base_playback));
  2367. ymfpci_writel(unit, YDSXGR_RECCTRLBASE, virt_to_bus(unit->bank_base_capture));
  2368. ymfpci_writel(unit, YDSXGR_EFFCTRLBASE, virt_to_bus(unit->bank_base_effect));
  2369. ymfpci_writel(unit, YDSXGR_WORKBASE, virt_to_bus(unit->work_base));
  2370. ymfpci_writel(unit, YDSXGR_WORKSIZE, unit->work_size >> 2);
  2372. /* S/PDIF output initialization */
  2373. ymfpci_writew(unit, YDSXGR_SPDIFOUTCTRL, 0);
  2374. ymfpci_writew(unit, YDSXGR_SPDIFOUTSTATUS,
  2375. SND_PCM_AES0_CON_EMPHASIS_NONE |
  2376. (SND_PCM_AES1_CON_ORIGINAL << 8) |
  2377. (SND_PCM_AES1_CON_PCM_CODER << 8));
  2379. /* S/PDIF input initialization */
  2380. ymfpci_writew(unit, YDSXGR_SPDIFINCTRL, 0);
  2382. /* move this volume setup to mixer */
  2383. ymfpci_writel(unit, YDSXGR_NATIVEDACOUTVOL, 0x3fff3fff);
  2384. ymfpci_writel(unit, YDSXGR_BUF441OUTVOL, 0);
  2385. ymfpci_writel(unit, YDSXGR_NATIVEADCINVOL, 0x3fff3fff);
  2386. ymfpci_writel(unit, YDSXGR_NATIVEDACINVOL, 0x3fff3fff);
  2387. }
  2389. static int ymf_ac97_init(ymfpci_t *unit, int num_ac97)
  2390. {
  2391. struct ac97_codec *codec;
  2392. u16 eid;
  2394. if ((codec = kmalloc(sizeof(struct ac97_codec), GFP_KERNEL)) == NULL)
  2395. return -ENOMEM;
  2396. memset(codec, 0, sizeof(struct ac97_codec));
  2398. /* initialize some basic codec information, other fields will be filled
  2399.    in ac97_probe_codec */
  2400. codec->private_data = unit;
  2401. codec->id = num_ac97;
  2403. codec->codec_read = ymfpci_codec_read;
  2404. codec->codec_write = ymfpci_codec_write;
  2406. if (ac97_probe_codec(codec) == 0) {
  2407. printk(KERN_ERR "ymfpci: ac97_probe_codec failedn");
  2408. goto out_kfree;
  2409. }
  2411. eid = ymfpci_codec_read(codec, AC97_EXTENDED_ID);
  2412. if (eid==0xFFFFFF) {
  2413. printk(KERN_WARNING "ymfpci: no codec attached ?n");
  2414. goto out_kfree;
  2415. }
  2417. unit->ac97_features = eid;
  2419. if ((codec->dev_mixer = register_sound_mixer(&ymf_mixer_fops, -1)) < 0) {
  2420. printk(KERN_ERR "ymfpci: couldn't register mixer!n");
  2421. goto out_kfree;
  2422. }
  2424. unit->ac97_codec[num_ac97] = codec;
  2426. return 0;
  2427.  out_kfree:
  2428. kfree(codec);
  2429. return -ENODEV;
  2430. }
  2432. #ifdef CONFIG_SOUND_YMFPCI_LEGACY
  2433. # ifdef MODULE
  2434. static int mpu_io     = 0;
  2435. static int synth_io   = 0;
  2436. MODULE_PARM(mpu_io, "i");
  2437. MODULE_PARM(synth_io, "i");
  2438. # else
  2439. static int mpu_io     = 0x330;
  2440. static int synth_io   = 0x388;
  2441. # endif
  2442. static int assigned;
  2443. #endif /* CONFIG_SOUND_YMFPCI_LEGACY */
  2445. static int __devinit ymf_probe_one(struct pci_dev *pcidev, const struct pci_device_id *ent)
  2446. {
  2447. u16 ctrl;
  2448. unsigned long base;
  2449. ymfpci_t *codec;
  2451. int err;
  2453. if ((err = pci_enable_device(pcidev)) != 0) {
  2454. printk(KERN_ERR "ymfpci: pci_enable_device failedn");
  2455. return err;
  2456. }
  2457. base = pci_resource_start(pcidev, 0);
  2459. if ((codec = kmalloc(sizeof(ymfpci_t), GFP_KERNEL)) == NULL) {
  2460. printk(KERN_ERR "ymfpci: no coren");
  2461. return -ENOMEM;
  2462. }
  2463. memset(codec, 0, sizeof(*codec));
  2465. spin_lock_init(&codec->reg_lock);
  2466. spin_lock_init(&codec->voice_lock);
  2467. init_MUTEX(&codec->open_sem);
  2468. INIT_LIST_HEAD(&codec->states);
  2469. codec->pci = pcidev;
  2471. pci_read_config_byte(pcidev, PCI_REVISION_ID, &codec->rev);
  2473. if (request_mem_region(base, 0x8000, "ymfpci") == NULL) {
  2474. printk(KERN_ERR "ymfpci: unable to request mem regionn");
  2475. goto out_free;
  2476. }
  2478. if ((codec->reg_area_virt = ioremap(base, 0x8000)) == NULL) {
  2479. printk(KERN_ERR "ymfpci: unable to map registersn");
  2480. goto out_release_region;
  2481. }
  2483. pci_set_master(pcidev);
  2485. printk(KERN_INFO "ymfpci: %s at 0x%lx IRQ %dn",
  2486.     (char *)ent->driver_data, base, pcidev->irq);
  2488. ymfpci_aclink_reset(pcidev);
  2489. if (ymfpci_codec_ready(codec, 0, 1) < 0)
  2490. goto out_unmap;
  2492. #ifdef CONFIG_SOUND_YMFPCI_LEGACY
  2493. if (assigned == 0) {
  2494. codec->iomidi = mpu_io;
  2495. codec->iosynth = synth_io;
  2496. if (ymfpci_setup_legacy(codec, pcidev) < 0)
  2497. goto out_unmap;
  2498. assigned = 1;
  2499. }
  2500. #endif
  2502. ymfpci_download_image(codec);
  2504. if (ymfpci_memalloc(codec) < 0)
  2505. goto out_disable_dsp;
  2506. ymf_memload(codec);
  2508. if (request_irq(pcidev->irq, ymf_interrupt, SA_SHIRQ, "ymfpci", codec) != 0) {
  2509. printk(KERN_ERR "ymfpci: unable to request IRQ %dn",
  2510.     pcidev->irq);
  2511. goto out_memfree;
  2512. }
  2514. /* register /dev/dsp */
  2515. if ((codec->dev_audio = register_sound_dsp(&ymf_fops, -1)) < 0) {
  2516. printk(KERN_ERR "ymfpci: unable to register dspn");
  2517. goto out_free_irq;
  2518. }
  2520. /*
  2521.  * Poke just the primary for the moment.
  2522.  */
  2523. if ((err = ymf_ac97_init(codec, 0)) != 0)
  2524. goto out_unregister_sound_dsp;
  2526. #ifdef CONFIG_SOUND_YMFPCI_LEGACY
  2527. codec->opl3_data.name = "ymfpci";
  2528. codec->mpu_data.name  = "ymfpci";
  2530. codec->opl3_data.io_base = codec->iosynth;
  2531. codec->opl3_data.irq     = -1;
  2533. codec->mpu_data.io_base  = codec->iomidi;
  2534. codec->mpu_data.irq      = -1; /* XXX Make it ours. */
  2536. if (codec->iomidi) {
  2537. if (!probe_uart401(&codec->mpu_data, THIS_MODULE)) {
  2538. codec->iomidi = 0; /* XXX kludge */
  2539. }
  2540. }
  2541. #endif /* CONFIG_SOUND_YMFPCI_LEGACY */
  2543. /* put it into driver list */
  2544. list_add_tail(&codec->ymf_devs, &ymf_devs);
  2545. pci_set_drvdata(pcidev, codec);
  2547. return 0;
  2549.  out_unregister_sound_dsp:
  2550. unregister_sound_dsp(codec->dev_audio);
  2551.  out_free_irq:
  2552. free_irq(pcidev->irq, codec);
  2553.  out_memfree:
  2554. ymfpci_memfree(codec);
  2555.  out_disable_dsp:
  2556. ymfpci_disable_dsp(codec);
  2557. ctrl = ymfpci_readw(codec, YDSXGR_GLOBALCTRL);
  2558. ymfpci_writew(codec, YDSXGR_GLOBALCTRL, ctrl & ~0x0007);
  2559. ymfpci_writel(codec, YDSXGR_STATUS, ~0);
  2560.  out_unmap:
  2561. iounmap(codec->reg_area_virt);
  2562.  out_release_region:
  2563. release_mem_region(pci_resource_start(pcidev, 0), 0x8000);
  2564.  out_free:
  2565. kfree(codec);
  2566. return -ENODEV;
  2567. }
  2569. static void __devexit ymf_remove_one(struct pci_dev *pcidev)
  2570. {
  2571. __u16 ctrl;
  2572. ymfpci_t *codec = pci_get_drvdata(pcidev);
  2574. /* remove from list of devices */
  2575. list_del(&codec->ymf_devs);
  2577. unregister_sound_mixer(codec->ac97_codec[0]->dev_mixer);
  2578. kfree(codec->ac97_codec[0]);
  2579. unregister_sound_dsp(codec->dev_audio);
  2580. free_irq(pcidev->irq, codec);
  2581. ymfpci_memfree(codec);
  2582. ymfpci_writel(codec, YDSXGR_STATUS, ~0);
  2583. ymfpci_disable_dsp(codec);
  2584. ctrl = ymfpci_readw(codec, YDSXGR_GLOBALCTRL);
  2585. ymfpci_writew(codec, YDSXGR_GLOBALCTRL, ctrl & ~0x0007);
  2586. iounmap(codec->reg_area_virt);
  2587. release_mem_region(pci_resource_start(pcidev, 0), 0x8000);
  2588. #ifdef CONFIG_SOUND_YMFPCI_LEGACY
  2589. if (codec->iomidi) {
  2590. unload_uart401(&codec->mpu_data);
  2591. }
  2592. #endif /* CONFIG_SOUND_YMFPCI_LEGACY */
  2593. kfree(codec);
  2594. }
  2596. MODULE_AUTHOR("Jaroslav Kysela");
  2597. MODULE_DESCRIPTION("Yamaha YMF7xx PCI Audio");
  2598. MODULE_LICENSE("GPL");
  2600. static struct pci_driver ymfpci_driver = {
  2601. name: "ymfpci",
  2602. id_table: ymf_id_tbl,
  2603. probe: ymf_probe_one,
  2604. remove:         __devexit_p(ymf_remove_one),
  2605. suspend: ymf_suspend,
  2606. resume: ymf_resume
  2607. };
  2609. static int __init ymf_init_module(void)
  2610. {
  2611. return pci_module_init(&ymfpci_driver);
  2612. }
  2614. static void __exit ymf_cleanup_module (void)
  2615. {
  2616. pci_unregister_driver(&ymfpci_driver);
  2617. }
  2619. module_init(ymf_init_module);
  2620. module_exit(ymf_cleanup_module);