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

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*********************************************************************
  2.  *
  3.  * Turtle Beach MultiSound Sound Card Driver for Linux
  4.  * Linux 2.0/2.2 Version
  5.  *
  6.  * msnd_pinnacle.c / msnd_classic.c
  7.  *
  8.  * -- If MSND_CLASSIC is defined:
  9.  *
  10.  *     -> driver for Turtle Beach Classic/Monterey/Tahiti
  11.  *
  12.  * -- Else
  13.  *
  14.  *     -> driver for Turtle Beach Pinnacle/Fiji
  15.  *
  16.  * Copyright (C) 1998 Andrew Veliath
  17.  *
  18.  * This program is free software; you can redistribute it and/or modify
  19.  * it under the terms of the GNU General Public License as published by
  20.  * the Free Software Foundation; either version 2 of the License, or
  21.  * (at your option) any later version.
  22.  *
  23.  * This program is distributed in the hope that it will be useful,
  24.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  25.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  26.  * GNU General Public License for more details.
  27.  *
  28.  * You should have received a copy of the GNU General Public License
  29.  * along with this program; if not, write to the Free Software
  30.  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  31.  *
  32.  * $Id: msnd_pinnacle.c,v 1.8 2000/12/30 00:33:21 sycamore Exp $
  33.  *
  34.  * 12-3-2000  Modified IO port validation  Steve Sycamore
  35.  *
  36.  *
  37.  * $$$: msnd_pinnacle.c,v 1.75 1999/03/21 16:50:09 andrewtv $$$ $
  38.  *
  39.  ********************************************************************/
  40. #include <linux/kernel.h>
  41. #include <linux/config.h>
  42. #include <linux/version.h>
  43. #include <linux/module.h>
  44. #include <linux/slab.h>
  45. #include <linux/types.h>
  46. #include <linux/delay.h>
  47. #include <linux/init.h>
  48. #include <linux/smp_lock.h>
  49. #include <asm/irq.h>
  50. #include <asm/io.h>
  51. #include "sound_config.h"
  52. #include "sound_firmware.h"
  53. #ifdef MSND_CLASSIC
  54. # ifndef __alpha__
  55. #  define SLOWIO
  56. # endif
  57. #endif
  58. #include "msnd.h"
  59. #ifdef MSND_CLASSIC
  60. #  ifdef CONFIG_MSNDCLAS_HAVE_BOOT
  61. #    define HAVE_DSPCODEH
  62. #  endif
  63. #  include "msnd_classic.h"
  64. #  define LOGNAME "msnd_classic"
  65. #else
  66. #  ifdef CONFIG_MSNDPIN_HAVE_BOOT
  67. #    define HAVE_DSPCODEH
  68. #  endif
  69. #  include "msnd_pinnacle.h"
  70. #  define LOGNAME "msnd_pinnacle"
  71. #endif
  72. #ifndef CONFIG_MSND_WRITE_NDELAY
  73. #  define CONFIG_MSND_WRITE_NDELAY 1
  74. #endif
  75. #define get_play_delay_jiffies(size) ((size) * HZ *
  76.  dev.play_sample_size / 8 /
  77.  dev.play_sample_rate /
  78.  dev.play_channels)
  79. #define get_rec_delay_jiffies(size) ((size) * HZ *
  80.  dev.rec_sample_size / 8 /
  81.  dev.rec_sample_rate /
  82.  dev.rec_channels)
  83. static multisound_dev_t dev;
  84. #ifndef HAVE_DSPCODEH
  85. static char *dspini, *permini;
  86. static int sizeof_dspini, sizeof_permini;
  87. #endif
  88. static int dsp_full_reset(void);
  89. static void dsp_write_flush(void);
  90. static __inline__ int chk_send_dsp_cmd(multisound_dev_t *dev, register BYTE cmd)
  91. {
  92. if (msnd_send_dsp_cmd(dev, cmd) == 0)
  93. return 0;
  94. dsp_full_reset();
  95. return msnd_send_dsp_cmd(dev, cmd);
  96. }
  97. static void reset_play_queue(void)
  98. {
  99. int n;
  100. LPDAQD lpDAQ;
  101. dev.last_playbank = -1;
  102. isa_writew(PCTODSP_OFFSET(0 * DAQDS__size), dev.DAPQ + JQS_wHead);
  103. isa_writew(PCTODSP_OFFSET(0 * DAQDS__size), dev.DAPQ + JQS_wTail);
  104. for (n = 0, lpDAQ = dev.base + DAPQ_DATA_BUFF; n < 3; ++n, lpDAQ += DAQDS__size) {
  105. isa_writew(PCTODSP_BASED((DWORD)(DAP_BUFF_SIZE * n)), lpDAQ + DAQDS_wStart);
  106. isa_writew(0, lpDAQ + DAQDS_wSize);
  107. isa_writew(1, lpDAQ + DAQDS_wFormat);
  108. isa_writew(dev.play_sample_size, lpDAQ + DAQDS_wSampleSize);
  109. isa_writew(dev.play_channels, lpDAQ + DAQDS_wChannels);
  110. isa_writew(dev.play_sample_rate, lpDAQ + DAQDS_wSampleRate);
  111. isa_writew(HIMT_PLAY_DONE * 0x100 + n, lpDAQ + DAQDS_wIntMsg);
  112. isa_writew(n, lpDAQ + DAQDS_wFlags);
  113. }
  114. }
  115. static void reset_record_queue(void)
  116. {
  117. int n;
  118. LPDAQD lpDAQ;
  119. unsigned long flags;
  120. dev.last_recbank = 2;
  121. isa_writew(PCTODSP_OFFSET(0 * DAQDS__size), dev.DARQ + JQS_wHead);
  122. isa_writew(PCTODSP_OFFSET(dev.last_recbank * DAQDS__size), dev.DARQ + JQS_wTail);
  123. /* Critical section: bank 1 access */
  124. spin_lock_irqsave(&dev.lock, flags);
  125. outb(HPBLKSEL_1, dev.io + HP_BLKS);
  126. isa_memset_io(dev.base, 0, DAR_BUFF_SIZE * 3);
  127. outb(HPBLKSEL_0, dev.io + HP_BLKS);
  128. spin_unlock_irqrestore(&dev.lock, flags);
  129. for (n = 0, lpDAQ = dev.base + DARQ_DATA_BUFF; n < 3; ++n, lpDAQ += DAQDS__size) {
  130. isa_writew(PCTODSP_BASED((DWORD)(DAR_BUFF_SIZE * n)) + 0x4000, lpDAQ + DAQDS_wStart);
  131. isa_writew(DAR_BUFF_SIZE, lpDAQ + DAQDS_wSize);
  132. isa_writew(1, lpDAQ + DAQDS_wFormat);
  133. isa_writew(dev.rec_sample_size, lpDAQ + DAQDS_wSampleSize);
  134. isa_writew(dev.rec_channels, lpDAQ + DAQDS_wChannels);
  135. isa_writew(dev.rec_sample_rate, lpDAQ + DAQDS_wSampleRate);
  136. isa_writew(HIMT_RECORD_DONE * 0x100 + n, lpDAQ + DAQDS_wIntMsg);
  137. isa_writew(n, lpDAQ + DAQDS_wFlags);
  138. }
  139. }
  140. static void reset_queues(void)
  141. {
  142. if (dev.mode & FMODE_WRITE) {
  143. msnd_fifo_make_empty(&dev.DAPF);
  144. reset_play_queue();
  145. }
  146. if (dev.mode & FMODE_READ) {
  147. msnd_fifo_make_empty(&dev.DARF);
  148. reset_record_queue();
  149. }
  150. }
  151. static int dsp_set_format(struct file *file, int val)
  152. {
  153. int data, i;
  154. LPDAQD lpDAQ, lpDARQ;
  155. lpDAQ = dev.base + DAPQ_DATA_BUFF;
  156. lpDARQ = dev.base + DARQ_DATA_BUFF;
  157. switch (val) {
  158. case AFMT_U8:
  159. case AFMT_S16_LE:
  160. data = val;
  161. break;
  162. default:
  163. data = DEFSAMPLESIZE;
  164. break;
  165. }
  166. for (i = 0; i < 3; ++i, lpDAQ += DAQDS__size, lpDARQ += DAQDS__size) {
  167. if (file->f_mode & FMODE_WRITE)
  168. isa_writew(data, lpDAQ + DAQDS_wSampleSize);
  169. if (file->f_mode & FMODE_READ)
  170. isa_writew(data, lpDARQ + DAQDS_wSampleSize);
  171. }
  172. if (file->f_mode & FMODE_WRITE)
  173. dev.play_sample_size = data;
  174. if (file->f_mode & FMODE_READ)
  175. dev.rec_sample_size = data;
  176. return data;
  177. }
  178. static int dsp_get_frag_size(void)
  179. {
  180. int size;
  181. size = dev.fifosize / 4;
  182. if (size > 32 * 1024)
  183. size = 32 * 1024;
  184. return size;
  185. }
  186. static int dsp_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
  187. {
  188. int val, i, data, tmp;
  189. LPDAQD lpDAQ, lpDARQ;
  190.         audio_buf_info abinfo;
  191. unsigned long flags;
  192. lpDAQ = dev.base + DAPQ_DATA_BUFF;
  193. lpDARQ = dev.base + DARQ_DATA_BUFF;
  194. switch (cmd) {
  195. case SNDCTL_DSP_SUBDIVIDE:
  196. case SNDCTL_DSP_SETFRAGMENT:
  197. case SNDCTL_DSP_SETDUPLEX:
  198. case SNDCTL_DSP_POST:
  199. return 0;
  200. case SNDCTL_DSP_GETIPTR:
  201. case SNDCTL_DSP_GETOPTR:
  202. case SNDCTL_DSP_MAPINBUF:
  203. case SNDCTL_DSP_MAPOUTBUF:
  204. return -EINVAL;
  205. case SNDCTL_DSP_GETOSPACE:
  206. if (!(file->f_mode & FMODE_WRITE))
  207. return -EINVAL;
  208. spin_lock_irqsave(&dev.lock, flags);
  209. abinfo.fragsize = dsp_get_frag_size();
  210.                 abinfo.bytes = dev.DAPF.n - dev.DAPF.len;
  211.                 abinfo.fragstotal = dev.DAPF.n / abinfo.fragsize;
  212.                 abinfo.fragments = abinfo.bytes / abinfo.fragsize;
  213. spin_unlock_irqrestore(&dev.lock, flags);
  214. return copy_to_user((void *)arg, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  215. case SNDCTL_DSP_GETISPACE:
  216. if (!(file->f_mode & FMODE_READ))
  217. return -EINVAL;
  218. spin_lock_irqsave(&dev.lock, flags);
  219. abinfo.fragsize = dsp_get_frag_size();
  220.                 abinfo.bytes = dev.DARF.n - dev.DARF.len;
  221.                 abinfo.fragstotal = dev.DARF.n / abinfo.fragsize;
  222.                 abinfo.fragments = abinfo.bytes / abinfo.fragsize;
  223. spin_unlock_irqrestore(&dev.lock, flags);
  224. return copy_to_user((void *)arg, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  225. case SNDCTL_DSP_RESET:
  226. dev.nresets = 0;
  227. reset_queues();
  228. return 0;
  229. case SNDCTL_DSP_SYNC:
  230. dsp_write_flush();
  231. return 0;
  232. case SNDCTL_DSP_GETBLKSIZE:
  233. tmp = dsp_get_frag_size();
  234. if (put_user(tmp, (int *)arg))
  235.                         return -EFAULT;
  236. return 0;
  237. case SNDCTL_DSP_GETFMTS:
  238. val = AFMT_S16_LE | AFMT_U8;
  239. if (put_user(val, (int *)arg))
  240. return -EFAULT;
  241. return 0;
  242. case SNDCTL_DSP_SETFMT:
  243. if (get_user(val, (int *)arg))
  244. return -EFAULT;
  245. if (file->f_mode & FMODE_WRITE)
  246. data = val == AFMT_QUERY
  247. ? dev.play_sample_size
  248. : dsp_set_format(file, val);
  249. else
  250. data = val == AFMT_QUERY
  251. ? dev.rec_sample_size
  252. : dsp_set_format(file, val);
  253. if (put_user(data, (int *)arg))
  254. return -EFAULT;
  255. return 0;
  256. case SNDCTL_DSP_NONBLOCK:
  257. if (!test_bit(F_DISABLE_WRITE_NDELAY, &dev.flags) &&
  258.     file->f_mode & FMODE_WRITE)
  259. dev.play_ndelay = 1;
  260. if (file->f_mode & FMODE_READ)
  261. dev.rec_ndelay = 1;
  262. return 0;
  263. case SNDCTL_DSP_GETCAPS:
  264. val = DSP_CAP_DUPLEX | DSP_CAP_BATCH;
  265. if (put_user(val, (int *)arg))
  266. return -EFAULT;
  267. return 0;
  268. case SNDCTL_DSP_SPEED:
  269. if (get_user(val, (int *)arg))
  270. return -EFAULT;
  271. if (val < 8000)
  272. val = 8000;
  273. if (val > 48000)
  274. val = 48000;
  275. data = val;
  276. for (i = 0; i < 3; ++i, lpDAQ += DAQDS__size, lpDARQ += DAQDS__size) {
  277. if (file->f_mode & FMODE_WRITE)
  278. isa_writew(data, lpDAQ + DAQDS_wSampleRate);
  279. if (file->f_mode & FMODE_READ)
  280. isa_writew(data, lpDARQ + DAQDS_wSampleRate);
  281. }
  282. if (file->f_mode & FMODE_WRITE)
  283. dev.play_sample_rate = data;
  284. if (file->f_mode & FMODE_READ)
  285. dev.rec_sample_rate = data;
  286. if (put_user(data, (int *)arg))
  287. return -EFAULT;
  288. return 0;
  289. case SNDCTL_DSP_CHANNELS:
  290. case SNDCTL_DSP_STEREO:
  291. if (get_user(val, (int *)arg))
  292. return -EFAULT;
  293. if (cmd == SNDCTL_DSP_CHANNELS) {
  294. switch (val) {
  295. case 1:
  296. case 2:
  297. data = val;
  298. break;
  299. default:
  300. val = data = 2;
  301. break;
  302. }
  303. } else {
  304. switch (val) {
  305. case 0:
  306. data = 1;
  307. break;
  308. default:
  309. val = 1;
  310. case 1:
  311. data = 2;
  312. break;
  313. }
  314. }
  315. for (i = 0; i < 3; ++i, lpDAQ += DAQDS__size, lpDARQ += DAQDS__size) {
  316. if (file->f_mode & FMODE_WRITE)
  317. isa_writew(data, lpDAQ + DAQDS_wChannels);
  318. if (file->f_mode & FMODE_READ)
  319. isa_writew(data, lpDARQ + DAQDS_wChannels);
  320. }
  321. if (file->f_mode & FMODE_WRITE)
  322. dev.play_channels = data;
  323. if (file->f_mode & FMODE_READ)
  324. dev.rec_channels = data;
  325. if (put_user(val, (int *)arg))
  326. return -EFAULT;
  327. return 0;
  328. }
  329. return -EINVAL;
  330. }
  331. static int mixer_get(int d)
  332. {
  333. if (d > 31)
  334. return -EINVAL;
  335. switch (d) {
  336. case SOUND_MIXER_VOLUME:
  337. case SOUND_MIXER_PCM:
  338. case SOUND_MIXER_LINE:
  339. case SOUND_MIXER_IMIX:
  340. case SOUND_MIXER_LINE1:
  341. #ifndef MSND_CLASSIC
  342. case SOUND_MIXER_MIC:
  343. case SOUND_MIXER_SYNTH:
  344. #endif
  345. return (dev.left_levels[d] >> 8) * 100 / 0xff | 
  346. (((dev.right_levels[d] >> 8) * 100 / 0xff) << 8);
  347. default:
  348. return 0;
  349. }
  350. }
  351. #define update_volm(a,b)
  352. isa_writew((dev.left_levels[a] >> 1) *
  353.        isa_readw(dev.SMA + SMA_wCurrMastVolLeft) / 0xffff,
  354.        dev.SMA + SMA_##b##Left);
  355. isa_writew((dev.right_levels[a] >> 1)  *
  356.        isa_readw(dev.SMA + SMA_wCurrMastVolRight) / 0xffff,
  357.        dev.SMA + SMA_##b##Right);
  358. #define update_potm(d,s,ar)
  359. isa_writeb((dev.left_levels[d] >> 8) *
  360.        isa_readw(dev.SMA + SMA_wCurrMastVolLeft) / 0xffff,
  361.        dev.SMA + SMA_##s##Left);
  362. isa_writeb((dev.right_levels[d] >> 8) *
  363.        isa_readw(dev.SMA + SMA_wCurrMastVolRight) / 0xffff,
  364.        dev.SMA + SMA_##s##Right);
  365. if (msnd_send_word(&dev, 0, 0, ar) == 0)
  366. chk_send_dsp_cmd(&dev, HDEX_AUX_REQ);
  367. #define update_pot(d,s,ar)
  368. isa_writeb(dev.left_levels[d] >> 8,
  369.        dev.SMA + SMA_##s##Left);
  370. isa_writeb(dev.right_levels[d] >> 8,
  371.        dev.SMA + SMA_##s##Right);
  372. if (msnd_send_word(&dev, 0, 0, ar) == 0)
  373. chk_send_dsp_cmd(&dev, HDEX_AUX_REQ);
  374. static int mixer_set(int d, int value)
  375. {
  376. int left = value & 0x000000ff;
  377. int right = (value & 0x0000ff00) >> 8;
  378. int bLeft, bRight;
  379. int wLeft, wRight;
  380. int updatemaster = 0;
  381. if (d > 31)
  382. return -EINVAL;
  383. bLeft = left * 0xff / 100;
  384. wLeft = left * 0xffff / 100;
  385. bRight = right * 0xff / 100;
  386. wRight = right * 0xffff / 100;
  387. dev.left_levels[d] = wLeft;
  388. dev.right_levels[d] = wRight;
  389. switch (d) {
  390. /* master volume unscaled controls */
  391. case SOUND_MIXER_LINE: /* line pot control */
  392. /* scaled by IMIX in digital mix */
  393. isa_writeb(bLeft, dev.SMA + SMA_bInPotPosLeft);
  394. isa_writeb(bRight, dev.SMA + SMA_bInPotPosRight);
  395. if (msnd_send_word(&dev, 0, 0, HDEXAR_IN_SET_POTS) == 0)
  396. chk_send_dsp_cmd(&dev, HDEX_AUX_REQ);
  397. break;
  398. #ifndef MSND_CLASSIC
  399. case SOUND_MIXER_MIC: /* mic pot control */
  400. /* scaled by IMIX in digital mix */
  401. isa_writeb(bLeft, dev.SMA + SMA_bMicPotPosLeft);
  402. isa_writeb(bRight, dev.SMA + SMA_bMicPotPosRight);
  403. if (msnd_send_word(&dev, 0, 0, HDEXAR_MIC_SET_POTS) == 0)
  404. chk_send_dsp_cmd(&dev, HDEX_AUX_REQ);
  405. break;
  406. #endif
  407. case SOUND_MIXER_VOLUME: /* master volume */
  408. isa_writew(wLeft, dev.SMA + SMA_wCurrMastVolLeft);
  409. isa_writew(wRight, dev.SMA + SMA_wCurrMastVolRight);
  410. /* fall through */
  411. case SOUND_MIXER_LINE1: /* aux pot control */
  412. /* scaled by master volume */
  413. /* fall through */
  414. /* digital controls */
  415. case SOUND_MIXER_SYNTH: /* synth vol (dsp mix) */
  416. case SOUND_MIXER_PCM: /* pcm vol (dsp mix) */
  417. case SOUND_MIXER_IMIX: /* input monitor (dsp mix) */
  418. /* scaled by master volume */
  419. updatemaster = 1;
  420. break;
  421. default:
  422. return 0;
  423. }
  424. if (updatemaster) {
  425. /* update master volume scaled controls */
  426. update_volm(SOUND_MIXER_PCM, wCurrPlayVol);
  427. update_volm(SOUND_MIXER_IMIX, wCurrInVol);
  428. #ifndef MSND_CLASSIC
  429. update_volm(SOUND_MIXER_SYNTH, wCurrMHdrVol);
  430. #endif
  431. update_potm(SOUND_MIXER_LINE1, bAuxPotPos, HDEXAR_AUX_SET_POTS);
  432. }
  433. return mixer_get(d);
  434. }
  435. static void mixer_setup(void)
  436. {
  437. update_pot(SOUND_MIXER_LINE, bInPotPos, HDEXAR_IN_SET_POTS);
  438. update_potm(SOUND_MIXER_LINE1, bAuxPotPos, HDEXAR_AUX_SET_POTS);
  439. update_volm(SOUND_MIXER_PCM, wCurrPlayVol);
  440. update_volm(SOUND_MIXER_IMIX, wCurrInVol);
  441. #ifndef MSND_CLASSIC
  442. update_pot(SOUND_MIXER_MIC, bMicPotPos, HDEXAR_MIC_SET_POTS);
  443. update_volm(SOUND_MIXER_SYNTH, wCurrMHdrVol);
  444. #endif
  445. }
  446. static unsigned long set_recsrc(unsigned long recsrc)
  447. {
  448. if (dev.recsrc == recsrc)
  449. return dev.recsrc;
  450. #ifdef HAVE_NORECSRC
  451. else if (recsrc == 0)
  452. dev.recsrc = 0;
  453. #endif
  454. else
  455. dev.recsrc ^= recsrc;
  456. #ifndef MSND_CLASSIC
  457. if (dev.recsrc & SOUND_MASK_IMIX) {
  458. if (msnd_send_word(&dev, 0, 0, HDEXAR_SET_ANA_IN) == 0)
  459. chk_send_dsp_cmd(&dev, HDEX_AUX_REQ);
  460. }
  461. else if (dev.recsrc & SOUND_MASK_SYNTH) {
  462. if (msnd_send_word(&dev, 0, 0, HDEXAR_SET_SYNTH_IN) == 0)
  463. chk_send_dsp_cmd(&dev, HDEX_AUX_REQ);
  464. }
  465. else if ((dev.recsrc & SOUND_MASK_DIGITAL1) && test_bit(F_HAVEDIGITAL, &dev.flags)) {
  466. if (msnd_send_word(&dev, 0, 0, HDEXAR_SET_DAT_IN) == 0)
  467.        chk_send_dsp_cmd(&dev, HDEX_AUX_REQ);
  468. }
  469. else {
  470. #ifdef HAVE_NORECSRC
  471. /* Select no input (?) */
  472. dev.recsrc = 0;
  473. #else
  474. dev.recsrc = SOUND_MASK_IMIX;
  475. if (msnd_send_word(&dev, 0, 0, HDEXAR_SET_ANA_IN) == 0)
  476. chk_send_dsp_cmd(&dev, HDEX_AUX_REQ);
  477. #endif
  478. }
  479. #endif /* MSND_CLASSIC */
  480. return dev.recsrc;
  481. }
  482. static unsigned long force_recsrc(unsigned long recsrc)
  483. {
  484. dev.recsrc = 0;
  485. return set_recsrc(recsrc);
  486. }
  487. #define set_mixer_info()
  488. strncpy(info.id, "MSNDMIXER", sizeof(info.id));
  489. strncpy(info.name, "MultiSound Mixer", sizeof(info.name));
  490. static int mixer_ioctl(unsigned int cmd, unsigned long arg)
  491. {
  492. if (cmd == SOUND_MIXER_INFO) {
  493. mixer_info info;
  494. set_mixer_info();
  495. info.modify_counter = dev.mixer_mod_count;
  496. return copy_to_user((void *)arg, &info, sizeof(info))?-EFAULT:0;
  497. } else if (cmd == SOUND_OLD_MIXER_INFO) {
  498. _old_mixer_info info;
  499. set_mixer_info();
  500. return copy_to_user((void *)arg, &info, sizeof(info))?-EFAULT:0;
  501. } else if (cmd == SOUND_MIXER_PRIVATE1) {
  502. dev.nresets = 0;
  503. dsp_full_reset();
  504. return 0;
  505. } else if (((cmd >> 8) & 0xff) == 'M') {
  506. int val = 0;
  507. if (_SIOC_DIR(cmd) & _SIOC_WRITE) {
  508. switch (cmd & 0xff) {
  509. case SOUND_MIXER_RECSRC:
  510. if (get_user(val, (int *)arg))
  511. return -EFAULT;
  512. val = set_recsrc(val);
  513. break;
  514. default:
  515. if (get_user(val, (int *)arg))
  516. return -EFAULT;
  517. val = mixer_set(cmd & 0xff, val);
  518. break;
  519. }
  520. ++dev.mixer_mod_count;
  521. return put_user(val, (int *)arg);
  522. } else {
  523. switch (cmd & 0xff) {
  524. case SOUND_MIXER_RECSRC:
  525. val = dev.recsrc;
  526. break;
  527. case SOUND_MIXER_DEVMASK:
  528. case SOUND_MIXER_STEREODEVS:
  529. val =   SOUND_MASK_PCM |
  530. SOUND_MASK_LINE |
  531. SOUND_MASK_IMIX |
  532. SOUND_MASK_LINE1 |
  533. #ifndef MSND_CLASSIC
  534. SOUND_MASK_MIC |
  535. SOUND_MASK_SYNTH |
  536. #endif
  537. SOUND_MASK_VOLUME;
  538. break;
  539.   
  540. case SOUND_MIXER_RECMASK:
  541. #ifdef MSND_CLASSIC
  542. val =   0;
  543. #else
  544. val =   SOUND_MASK_IMIX |
  545. SOUND_MASK_SYNTH;
  546. if (test_bit(F_HAVEDIGITAL, &dev.flags))
  547. val |= SOUND_MASK_DIGITAL1;
  548. #endif
  549. break;
  550.   
  551. case SOUND_MIXER_CAPS:
  552. val =   SOUND_CAP_EXCL_INPUT;
  553. break;
  554. default:
  555. if ((val = mixer_get(cmd & 0xff)) < 0)
  556. return -EINVAL;
  557. break;
  558. }
  559. }
  560. return put_user(val, (int *)arg); 
  561. }
  562. return -EINVAL;
  563. }
  564. static int dev_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
  565. {
  566. int minor = MINOR(inode->i_rdev);
  567. if (cmd == OSS_GETVERSION) {
  568. int sound_version = SOUND_VERSION;
  569. return put_user(sound_version, (int *)arg);
  570. }
  571. if (minor == dev.dsp_minor)
  572. return dsp_ioctl(file, cmd, arg);
  573. else if (minor == dev.mixer_minor)
  574. return mixer_ioctl(cmd, arg);
  575. return -EINVAL;
  576. }
  577. static void dsp_write_flush(void)
  578. {
  579. if (!(dev.mode & FMODE_WRITE) || !test_bit(F_WRITING, &dev.flags))
  580. return;
  581. set_bit(F_WRITEFLUSH, &dev.flags);
  582. interruptible_sleep_on_timeout(
  583. &dev.writeflush,
  584. get_play_delay_jiffies(dev.DAPF.len));
  585. clear_bit(F_WRITEFLUSH, &dev.flags);
  586. if (!signal_pending(current)) {
  587. current->state = TASK_INTERRUPTIBLE;
  588. schedule_timeout(get_play_delay_jiffies(DAP_BUFF_SIZE));
  589. }
  590. clear_bit(F_WRITING, &dev.flags);
  591. }
  592. static void dsp_halt(struct file *file)
  593. {
  594. if ((file ? file->f_mode : dev.mode) & FMODE_READ) {
  595. clear_bit(F_READING, &dev.flags);
  596. chk_send_dsp_cmd(&dev, HDEX_RECORD_STOP);
  597. msnd_disable_irq(&dev);
  598. if (file) {
  599. printk(KERN_DEBUG LOGNAME ": Stopping read for %pn", file);
  600. dev.mode &= ~FMODE_READ;
  601. }
  602. clear_bit(F_AUDIO_READ_INUSE, &dev.flags);
  603. }
  604. if ((file ? file->f_mode : dev.mode) & FMODE_WRITE) {
  605. if (test_bit(F_WRITING, &dev.flags)) {
  606. dsp_write_flush();
  607. chk_send_dsp_cmd(&dev, HDEX_PLAY_STOP);
  608. }
  609. msnd_disable_irq(&dev);
  610. if (file) {
  611. printk(KERN_DEBUG LOGNAME ": Stopping write for %pn", file);
  612. dev.mode &= ~FMODE_WRITE;
  613. }
  614. clear_bit(F_AUDIO_WRITE_INUSE, &dev.flags);
  615. }
  616. }
  617. static int dsp_release(struct file *file)
  618. {
  619. dsp_halt(file);
  620. return 0;
  621. }
  622. static int dsp_open(struct file *file)
  623. {
  624. if ((file ? file->f_mode : dev.mode) & FMODE_WRITE) {
  625. set_bit(F_AUDIO_WRITE_INUSE, &dev.flags);
  626. clear_bit(F_WRITING, &dev.flags);
  627. msnd_fifo_make_empty(&dev.DAPF);
  628. reset_play_queue();
  629. if (file) {
  630. printk(KERN_DEBUG LOGNAME ": Starting write for %pn", file);
  631. dev.mode |= FMODE_WRITE;
  632. }
  633. msnd_enable_irq(&dev);
  634. }
  635. if ((file ? file->f_mode : dev.mode) & FMODE_READ) {
  636. set_bit(F_AUDIO_READ_INUSE, &dev.flags);
  637. clear_bit(F_READING, &dev.flags);
  638. msnd_fifo_make_empty(&dev.DARF);
  639. reset_record_queue();
  640. if (file) {
  641. printk(KERN_DEBUG LOGNAME ": Starting read for %pn", file);
  642. dev.mode |= FMODE_READ;
  643. }
  644. msnd_enable_irq(&dev);
  645. }
  646. return 0;
  647. }
  648. static void set_default_play_audio_parameters(void)
  649. {
  650. dev.play_sample_size = DEFSAMPLESIZE;
  651. dev.play_sample_rate = DEFSAMPLERATE;
  652. dev.play_channels = DEFCHANNELS;
  653. }
  654. static void set_default_rec_audio_parameters(void)
  655. {
  656. dev.rec_sample_size = DEFSAMPLESIZE;
  657. dev.rec_sample_rate = DEFSAMPLERATE;
  658. dev.rec_channels = DEFCHANNELS;
  659. }
  660. static void set_default_audio_parameters(void)
  661. {
  662. set_default_play_audio_parameters();
  663. set_default_rec_audio_parameters();
  664. }
  665. static int dev_open(struct inode *inode, struct file *file)
  666. {
  667. int minor = MINOR(inode->i_rdev);
  668. int err = 0;
  669. if (minor == dev.dsp_minor) {
  670. if ((file->f_mode & FMODE_WRITE &&
  671.      test_bit(F_AUDIO_WRITE_INUSE, &dev.flags)) ||
  672.     (file->f_mode & FMODE_READ &&
  673.      test_bit(F_AUDIO_READ_INUSE, &dev.flags)))
  674. return -EBUSY;
  675. if ((err = dsp_open(file)) >= 0) {
  676. dev.nresets = 0;
  677. if (file->f_mode & FMODE_WRITE) {
  678. set_default_play_audio_parameters();
  679. if (!test_bit(F_DISABLE_WRITE_NDELAY, &dev.flags))
  680. dev.play_ndelay = (file->f_flags & O_NDELAY) ? 1 : 0;
  681. else
  682. dev.play_ndelay = 0;
  683. }
  684. if (file->f_mode & FMODE_READ) {
  685. set_default_rec_audio_parameters();
  686. dev.rec_ndelay = (file->f_flags & O_NDELAY) ? 1 : 0;
  687. }
  688. }
  689. }
  690. else if (minor == dev.mixer_minor) {
  691. /* nothing */
  692. } else
  693. err = -EINVAL;
  694. return err;
  695. }
  696. static int dev_release(struct inode *inode, struct file *file)
  697. {
  698. int minor = MINOR(inode->i_rdev);
  699. int err = 0;
  700. lock_kernel();
  701. if (minor == dev.dsp_minor)
  702. err = dsp_release(file);
  703. else if (minor == dev.mixer_minor) {
  704. /* nothing */
  705. } else
  706. err = -EINVAL;
  707. unlock_kernel();
  708. return err;
  709. }
  710. static __inline__ int pack_DARQ_to_DARF(register int bank)
  711. {
  712. register int size, n, timeout = 3;
  713. register WORD wTmp;
  714. LPDAQD DAQD;
  715. /* Increment the tail and check for queue wrap */
  716. wTmp = isa_readw(dev.DARQ + JQS_wTail) + PCTODSP_OFFSET(DAQDS__size);
  717. if (wTmp > isa_readw(dev.DARQ + JQS_wSize))
  718. wTmp = 0;
  719. while (wTmp == isa_readw(dev.DARQ + JQS_wHead) && timeout--)
  720. udelay(1);
  721. isa_writew(wTmp, dev.DARQ + JQS_wTail);
  722. /* Get our digital audio queue struct */
  723. DAQD = bank * DAQDS__size + dev.base + DARQ_DATA_BUFF;
  724. /* Get length of data */
  725. size = isa_readw(DAQD + DAQDS_wSize);
  726. /* Read data from the head (unprotected bank 1 access okay
  727.            since this is only called inside an interrupt) */
  728. outb(HPBLKSEL_1, dev.io + HP_BLKS);
  729. if ((n = msnd_fifo_write(
  730. &dev.DARF,
  731. (char *)(dev.base + bank * DAR_BUFF_SIZE),
  732. size, 0)) <= 0) {
  733. outb(HPBLKSEL_0, dev.io + HP_BLKS);
  734. return n;
  735. }
  736. outb(HPBLKSEL_0, dev.io + HP_BLKS);
  737. return 1;
  738. }
  739. static __inline__ int pack_DAPF_to_DAPQ(register int start)
  740. {
  741. register WORD DAPQ_tail;
  742. register int protect = start, nbanks = 0;
  743. LPDAQD DAQD;
  744. DAPQ_tail = isa_readw(dev.DAPQ + JQS_wTail);
  745. while (DAPQ_tail != isa_readw(dev.DAPQ + JQS_wHead) || start) {
  746. register int bank_num = DAPQ_tail / PCTODSP_OFFSET(DAQDS__size);
  747. register int n;
  748. unsigned long flags;
  749. /* Write the data to the new tail */
  750. if (protect) {
  751. /* Critical section: protect fifo in non-interrupt */
  752. spin_lock_irqsave(&dev.lock, flags);
  753. if ((n = msnd_fifo_read(
  754. &dev.DAPF,
  755. (char *)(dev.base + bank_num * DAP_BUFF_SIZE),
  756. DAP_BUFF_SIZE, 0)) < 0) {
  757. spin_unlock_irqrestore(&dev.lock, flags);
  758. return n;
  759. }
  760. spin_unlock_irqrestore(&dev.lock, flags);
  761. } else {
  762. if ((n = msnd_fifo_read(
  763. &dev.DAPF,
  764. (char *)(dev.base + bank_num * DAP_BUFF_SIZE),
  765. DAP_BUFF_SIZE, 0)) < 0) {
  766. return n;
  767. }
  768. }
  769. if (!n)
  770. break;
  771. if (start)
  772. start = 0;
  773. /* Get our digital audio queue struct */
  774. DAQD = bank_num * DAQDS__size + dev.base + DAPQ_DATA_BUFF;
  775. /* Write size of this bank */
  776. isa_writew(n, DAQD + DAQDS_wSize);
  777. ++nbanks;
  778. /* Then advance the tail */
  779. DAPQ_tail = (++bank_num % 3) * PCTODSP_OFFSET(DAQDS__size);
  780. isa_writew(DAPQ_tail, dev.DAPQ + JQS_wTail);
  781. /* Tell the DSP to play the bank */
  782. msnd_send_dsp_cmd(&dev, HDEX_PLAY_START);
  783. }
  784. return nbanks;
  785. }
  786. static int dsp_read(char *buf, size_t len)
  787. {
  788. int count = len;
  789. while (count > 0) {
  790. int n;
  791. unsigned long flags;
  792. /* Critical section: protect fifo in non-interrupt */
  793. spin_lock_irqsave(&dev.lock, flags);
  794. if ((n = msnd_fifo_read(&dev.DARF, buf, count, 1)) < 0) {
  795. printk(KERN_WARNING LOGNAME ": FIFO read errorn");
  796. spin_unlock_irqrestore(&dev.lock, flags);
  797. return n;
  798. }
  799. spin_unlock_irqrestore(&dev.lock, flags);
  800. buf += n;
  801. count -= n;
  802. if (!test_bit(F_READING, &dev.flags) && dev.mode & FMODE_READ) {
  803. dev.last_recbank = -1;
  804. if (chk_send_dsp_cmd(&dev, HDEX_RECORD_START) == 0)
  805. set_bit(F_READING, &dev.flags);
  806. }
  807. if (dev.rec_ndelay)
  808. return count == len ? -EAGAIN : len - count;
  809. if (count > 0) {
  810. set_bit(F_READBLOCK, &dev.flags);
  811. if (!interruptible_sleep_on_timeout(
  812. &dev.readblock,
  813. get_rec_delay_jiffies(DAR_BUFF_SIZE)))
  814. clear_bit(F_READING, &dev.flags);
  815. clear_bit(F_READBLOCK, &dev.flags);
  816. if (signal_pending(current))
  817. return -EINTR;
  818. }
  819. }
  820. return len - count;
  821. }
  822. static int dsp_write(const char *buf, size_t len)
  823. {
  824. int count = len;
  825. while (count > 0) {
  826. int n;
  827. unsigned long flags;
  828. /* Critical section: protect fifo in non-interrupt */
  829. spin_lock_irqsave(&dev.lock, flags);
  830. if ((n = msnd_fifo_write(&dev.DAPF, buf, count, 1)) < 0) {
  831. printk(KERN_WARNING LOGNAME ": FIFO write errorn");
  832. spin_unlock_irqrestore(&dev.lock, flags);
  833. return n;
  834. }
  835. spin_unlock_irqrestore(&dev.lock, flags);
  836. buf += n;
  837. count -= n;
  838. if (!test_bit(F_WRITING, &dev.flags) && (dev.mode & FMODE_WRITE)) {
  839. dev.last_playbank = -1;
  840. if (pack_DAPF_to_DAPQ(1) > 0)
  841. set_bit(F_WRITING, &dev.flags);
  842. }
  843. if (dev.play_ndelay)
  844. return count == len ? -EAGAIN : len - count;
  845. if (count > 0) {
  846. set_bit(F_WRITEBLOCK, &dev.flags);
  847. interruptible_sleep_on_timeout(
  848. &dev.writeblock,
  849. get_play_delay_jiffies(DAP_BUFF_SIZE));
  850. clear_bit(F_WRITEBLOCK, &dev.flags);
  851. if (signal_pending(current))
  852. return -EINTR;
  853. }
  854. }
  855. return len - count;
  856. }
  857. static ssize_t dev_read(struct file *file, char *buf, size_t count, loff_t *off)
  858. {
  859. int minor = MINOR(file->f_dentry->d_inode->i_rdev);
  860. if (minor == dev.dsp_minor)
  861. return dsp_read(buf, count);
  862. else
  863. return -EINVAL;
  864. }
  865. static ssize_t dev_write(struct file *file, const char *buf, size_t count, loff_t *off)
  866. {
  867. int minor = MINOR(file->f_dentry->d_inode->i_rdev);
  868. if (minor == dev.dsp_minor)
  869. return dsp_write(buf, count);
  870. else
  871. return -EINVAL;
  872. }
  873. static __inline__ void eval_dsp_msg(register WORD wMessage)
  874. {
  875. switch (HIBYTE(wMessage)) {
  876. case HIMT_PLAY_DONE:
  877. if (dev.last_playbank == LOBYTE(wMessage) || !test_bit(F_WRITING, &dev.flags))
  878. break;
  879. dev.last_playbank = LOBYTE(wMessage);
  880. if (pack_DAPF_to_DAPQ(0) <= 0) {
  881. if (!test_bit(F_WRITEBLOCK, &dev.flags)) {
  882. if (test_and_clear_bit(F_WRITEFLUSH, &dev.flags))
  883. wake_up_interruptible(&dev.writeflush);
  884. }
  885. clear_bit(F_WRITING, &dev.flags);
  886. }
  887. if (test_bit(F_WRITEBLOCK, &dev.flags))
  888. wake_up_interruptible(&dev.writeblock);
  889. break;
  890. case HIMT_RECORD_DONE:
  891. if (dev.last_recbank == LOBYTE(wMessage))
  892. break;
  893. dev.last_recbank = LOBYTE(wMessage);
  894. pack_DARQ_to_DARF(dev.last_recbank);
  895. if (test_bit(F_READBLOCK, &dev.flags))
  896. wake_up_interruptible(&dev.readblock);
  897. break;
  898. case HIMT_DSP:
  899. switch (LOBYTE(wMessage)) {
  900. #ifndef MSND_CLASSIC
  901. case HIDSP_PLAY_UNDER:
  902. #endif
  903. case HIDSP_INT_PLAY_UNDER:
  904. /* printk(KERN_DEBUG LOGNAME ": Play underflown"); */
  905. clear_bit(F_WRITING, &dev.flags);
  906. break;
  907. case HIDSP_INT_RECORD_OVER:
  908. /* printk(KERN_DEBUG LOGNAME ": Record overflown"); */
  909. clear_bit(F_READING, &dev.flags);
  910. break;
  911. default:
  912. /* printk(KERN_DEBUG LOGNAME ": DSP message %d 0x%02xn",
  913. LOBYTE(wMessage), LOBYTE(wMessage)); */
  914. break;
  915. }
  916. break;
  917.         case HIMT_MIDI_IN_UCHAR:
  918. if (dev.midi_in_interrupt)
  919. (*dev.midi_in_interrupt)(&dev);
  920. break;
  921. default:
  922. /* printk(KERN_DEBUG LOGNAME ": HIMT message %d 0x%02xn", HIBYTE(wMessage), HIBYTE(wMessage)); */
  923. break;
  924. }
  925. }
  926. static void intr(int irq, void *dev_id, struct pt_regs *regs)
  927. {
  928. /* Send ack to DSP */
  929. inb(dev.io + HP_RXL);
  930. /* Evaluate queued DSP messages */
  931. while (isa_readw(dev.DSPQ + JQS_wTail) != isa_readw(dev.DSPQ + JQS_wHead)) {
  932. register WORD wTmp;
  933. eval_dsp_msg(isa_readw(dev.pwDSPQData + 2*isa_readw(dev.DSPQ + JQS_wHead)));
  934. if ((wTmp = isa_readw(dev.DSPQ + JQS_wHead) + 1) > isa_readw(dev.DSPQ + JQS_wSize))
  935. isa_writew(0, dev.DSPQ + JQS_wHead);
  936. else
  937. isa_writew(wTmp, dev.DSPQ + JQS_wHead);
  938. }
  939. }
  940. static struct file_operations dev_fileops = {
  941. owner: THIS_MODULE,
  942. read: dev_read,
  943. write: dev_write,
  944. ioctl: dev_ioctl,
  945. open: dev_open,
  946. release: dev_release,
  947. };
  948. static int reset_dsp(void)
  949. {
  950. int timeout = 100;
  951. outb(HPDSPRESET_ON, dev.io + HP_DSPR);
  952. mdelay(1);
  953. #ifndef MSND_CLASSIC
  954. dev.info = inb(dev.io + HP_INFO);
  955. #endif
  956. outb(HPDSPRESET_OFF, dev.io + HP_DSPR);
  957. mdelay(1);
  958. while (timeout-- > 0) {
  959. if (inb(dev.io + HP_CVR) == HP_CVR_DEF)
  960. return 0;
  961. mdelay(1);
  962. }
  963. printk(KERN_ERR LOGNAME ": Cannot reset DSPn");
  964. return -EIO;
  965. }
  966. static int __init probe_multisound(void)
  967. {
  968. #ifndef MSND_CLASSIC
  969. char *xv, *rev = NULL;
  970. char *pin = "Pinnacle", *fiji = "Fiji";
  971. char *pinfiji = "Pinnacle/Fiji";
  972. #endif
  973. if (check_region(dev.io, dev.numio)) {
  974. printk(KERN_ERR LOGNAME ": I/O port conflictn");
  975. return -ENODEV;
  976. }
  977. request_region(dev.io, dev.numio, "probing");
  978. if (reset_dsp() < 0) {
  979. release_region(dev.io, dev.numio);
  980. return -ENODEV;
  981. }
  982. #ifdef MSND_CLASSIC
  983. dev.name = "Classic/Tahiti/Monterey";
  984. printk(KERN_INFO LOGNAME ": %s, "
  985. #else
  986. switch (dev.info >> 4) {
  987. case 0xf: xv = "<= 1.15"; break;
  988. case 0x1: xv = "1.18/1.2"; break;
  989. case 0x2: xv = "1.3"; break;
  990. case 0x3: xv = "1.4"; break;
  991. default: xv = "unknown"; break;
  992. }
  993. switch (dev.info & 0x7) {
  994. case 0x0: rev = "I"; dev.name = pin; break;
  995. case 0x1: rev = "F"; dev.name = pin; break;
  996. case 0x2: rev = "G"; dev.name = pin; break;
  997. case 0x3: rev = "H"; dev.name = pin; break;
  998. case 0x4: rev = "E"; dev.name = fiji; break;
  999. case 0x5: rev = "C"; dev.name = fiji; break;
  1000. case 0x6: rev = "D"; dev.name = fiji; break;
  1001. case 0x7:
  1002. rev = "A-B (Fiji) or A-E (Pinnacle)";
  1003. dev.name = pinfiji;
  1004. break;
  1005. }
  1006. printk(KERN_INFO LOGNAME ": %s revision %s, Xilinx version %s, "
  1007. #endif /* MSND_CLASSIC */
  1008.        "I/O 0x%x-0x%x, IRQ %d, memory mapped to 0x%lX-0x%lXn",
  1009.        dev.name,
  1010. #ifndef MSND_CLASSIC
  1011.        rev, xv,
  1012. #endif
  1013.        dev.io, dev.io + dev.numio - 1,
  1014.        dev.irq,
  1015.        dev.base, dev.base + 0x7fff);
  1016. release_region(dev.io, dev.numio);
  1017. return 0;
  1018. }
  1019. static int init_sma(void)
  1020. {
  1021. static int initted;
  1022. WORD mastVolLeft, mastVolRight;
  1023. unsigned long flags;
  1024. #ifdef MSND_CLASSIC
  1025. outb(dev.memid, dev.io + HP_MEMM);
  1026. #endif
  1027. outb(HPBLKSEL_0, dev.io + HP_BLKS);
  1028. if (initted) {
  1029. mastVolLeft = isa_readw(dev.SMA + SMA_wCurrMastVolLeft);
  1030. mastVolRight = isa_readw(dev.SMA + SMA_wCurrMastVolRight);
  1031. } else
  1032. mastVolLeft = mastVolRight = 0;
  1033. isa_memset_io(dev.base, 0, 0x8000);
  1034. /* Critical section: bank 1 access */
  1035. spin_lock_irqsave(&dev.lock, flags);
  1036. outb(HPBLKSEL_1, dev.io + HP_BLKS);
  1037. isa_memset_io(dev.base, 0, 0x8000);
  1038. outb(HPBLKSEL_0, dev.io + HP_BLKS);
  1039. spin_unlock_irqrestore(&dev.lock, flags);
  1040. dev.pwDSPQData = (dev.base + DSPQ_DATA_BUFF);
  1041. dev.pwMODQData = (dev.base + MODQ_DATA_BUFF);
  1042. dev.pwMIDQData = (dev.base + MIDQ_DATA_BUFF);
  1043. /* Motorola 56k shared memory base */
  1044. dev.SMA = dev.base + SMA_STRUCT_START;
  1045. /* Digital audio play queue */
  1046. dev.DAPQ = dev.base + DAPQ_OFFSET;
  1047. msnd_init_queue(dev.DAPQ, DAPQ_DATA_BUFF, DAPQ_BUFF_SIZE);
  1048. /* Digital audio record queue */
  1049. dev.DARQ = dev.base + DARQ_OFFSET;
  1050. msnd_init_queue(dev.DARQ, DARQ_DATA_BUFF, DARQ_BUFF_SIZE);
  1051. /* MIDI out queue */
  1052. dev.MODQ = dev.base + MODQ_OFFSET;
  1053. msnd_init_queue(dev.MODQ, MODQ_DATA_BUFF, MODQ_BUFF_SIZE);
  1054. /* MIDI in queue */
  1055. dev.MIDQ = dev.base + MIDQ_OFFSET;
  1056. msnd_init_queue(dev.MIDQ, MIDQ_DATA_BUFF, MIDQ_BUFF_SIZE);
  1057. /* DSP -> host message queue */
  1058. dev.DSPQ = dev.base + DSPQ_OFFSET;
  1059. msnd_init_queue(dev.DSPQ, DSPQ_DATA_BUFF, DSPQ_BUFF_SIZE);
  1060. /* Setup some DSP values */
  1061. #ifndef MSND_CLASSIC
  1062. isa_writew(1, dev.SMA + SMA_wCurrPlayFormat);
  1063. isa_writew(dev.play_sample_size, dev.SMA + SMA_wCurrPlaySampleSize);
  1064. isa_writew(dev.play_channels, dev.SMA + SMA_wCurrPlayChannels);
  1065. isa_writew(dev.play_sample_rate, dev.SMA + SMA_wCurrPlaySampleRate);
  1066. #endif
  1067. isa_writew(dev.play_sample_rate, dev.SMA + SMA_wCalFreqAtoD);
  1068. isa_writew(mastVolLeft, dev.SMA + SMA_wCurrMastVolLeft);
  1069. isa_writew(mastVolRight, dev.SMA + SMA_wCurrMastVolRight);
  1070. #ifndef MSND_CLASSIC
  1071. isa_writel(0x00010000, dev.SMA + SMA_dwCurrPlayPitch);
  1072. isa_writel(0x00000001, dev.SMA + SMA_dwCurrPlayRate);
  1073. #endif
  1074. isa_writew(0x303, dev.SMA + SMA_wCurrInputTagBits);
  1075. initted = 1;
  1076. return 0;
  1077. }
  1078. static int __init calibrate_adc(WORD srate)
  1079. {
  1080. isa_writew(srate, dev.SMA + SMA_wCalFreqAtoD);
  1081. if (dev.calibrate_signal == 0)
  1082. isa_writew(isa_readw(dev.SMA + SMA_wCurrHostStatusFlags)
  1083.        | 0x0001, dev.SMA + SMA_wCurrHostStatusFlags);
  1084. else
  1085. isa_writew(isa_readw(dev.SMA + SMA_wCurrHostStatusFlags)
  1086.        & ~0x0001, dev.SMA + SMA_wCurrHostStatusFlags);
  1087. if (msnd_send_word(&dev, 0, 0, HDEXAR_CAL_A_TO_D) == 0 &&
  1088.     chk_send_dsp_cmd(&dev, HDEX_AUX_REQ) == 0) {
  1089. current->state = TASK_INTERRUPTIBLE;
  1090. schedule_timeout(HZ / 3);
  1091. return 0;
  1092. }
  1093. printk(KERN_WARNING LOGNAME ": ADC calibration failedn");
  1094. return -EIO;
  1095. }
  1096. static int upload_dsp_code(void)
  1097. {
  1098. outb(HPBLKSEL_0, dev.io + HP_BLKS);
  1099. #ifndef HAVE_DSPCODEH
  1100. INITCODESIZE = mod_firmware_load(INITCODEFILE, &INITCODE);
  1101. if (!INITCODE) {
  1102. printk(KERN_ERR LOGNAME ": Error loading " INITCODEFILE);
  1103. return -EBUSY;
  1104. }
  1105. PERMCODESIZE = mod_firmware_load(PERMCODEFILE, &PERMCODE);
  1106. if (!PERMCODE) {
  1107. printk(KERN_ERR LOGNAME ": Error loading " PERMCODEFILE);
  1108. vfree(INITCODE);
  1109. return -EBUSY;
  1110. }
  1111. #endif
  1112. isa_memcpy_toio(dev.base, PERMCODE, PERMCODESIZE);
  1113. if (msnd_upload_host(&dev, INITCODE, INITCODESIZE) < 0) {
  1114. printk(KERN_WARNING LOGNAME ": Error uploading to DSPn");
  1115. return -ENODEV;
  1116. }
  1117. #ifdef HAVE_DSPCODEH
  1118. printk(KERN_INFO LOGNAME ": DSP firmware uploaded (resident)n");
  1119. #else
  1120. printk(KERN_INFO LOGNAME ": DSP firmware uploadedn");
  1121. #endif
  1122. #ifndef HAVE_DSPCODEH
  1123. vfree(INITCODE);
  1124. vfree(PERMCODE);
  1125. #endif
  1126. return 0;
  1127. }
  1128. #ifdef MSND_CLASSIC
  1129. static void reset_proteus(void)
  1130. {
  1131. outb(HPPRORESET_ON, dev.io + HP_PROR);
  1132. mdelay(TIME_PRO_RESET);
  1133. outb(HPPRORESET_OFF, dev.io + HP_PROR);
  1134. mdelay(TIME_PRO_RESET_DONE);
  1135. }
  1136. #endif
  1137. static int initialize(void)
  1138. {
  1139. int err, timeout;
  1140. #ifdef MSND_CLASSIC
  1141. outb(HPWAITSTATE_0, dev.io + HP_WAIT);
  1142. outb(HPBITMODE_16, dev.io + HP_BITM);
  1143. reset_proteus();
  1144. #endif
  1145. if ((err = init_sma()) < 0) {
  1146. printk(KERN_WARNING LOGNAME ": Cannot initialize SMAn");
  1147. return err;
  1148. }
  1149. if ((err = reset_dsp()) < 0)
  1150. return err;
  1151. if ((err = upload_dsp_code()) < 0) {
  1152. printk(KERN_WARNING LOGNAME ": Cannot upload DSP coden");
  1153. return err;
  1154. }
  1155. timeout = 200;
  1156. while (isa_readw(dev.base)) {
  1157. mdelay(1);
  1158. if (!timeout--) {
  1159. printk(KERN_DEBUG LOGNAME ": DSP reset timeoutn");
  1160. return -EIO;
  1161. }
  1162. }
  1163. mixer_setup();
  1164. return 0;
  1165. }
  1166. static int dsp_full_reset(void)
  1167. {
  1168. int rv;
  1169. if (test_bit(F_RESETTING, &dev.flags) || ++dev.nresets > 10)
  1170. return 0;
  1171. set_bit(F_RESETTING, &dev.flags);
  1172. printk(KERN_INFO LOGNAME ": DSP resetn");
  1173. dsp_halt(NULL); /* Unconditionally halt */
  1174. if ((rv = initialize()))
  1175. printk(KERN_WARNING LOGNAME ": DSP reset failedn");
  1176. force_recsrc(dev.recsrc);
  1177. dsp_open(NULL);
  1178. clear_bit(F_RESETTING, &dev.flags);
  1179. return rv;
  1180. }
  1181. static int __init attach_multisound(void)
  1182. {
  1183. int err;
  1184. if ((err = request_irq(dev.irq, intr, 0, dev.name, &dev)) < 0) {
  1185. printk(KERN_ERR LOGNAME ": Couldn't grab IRQ %dn", dev.irq);
  1186. return err;
  1187. }
  1188. request_region(dev.io, dev.numio, dev.name);
  1189.         if ((err = dsp_full_reset()) < 0) {
  1190. release_region(dev.io, dev.numio);
  1191. free_irq(dev.irq, &dev);
  1192. return err;
  1193. }
  1194. if ((err = msnd_register(&dev)) < 0) {
  1195. printk(KERN_ERR LOGNAME ": Unable to register MultiSoundn");
  1196. release_region(dev.io, dev.numio);
  1197. free_irq(dev.irq, &dev);
  1198. return err;
  1199. }
  1200. if ((dev.dsp_minor = register_sound_dsp(&dev_fileops, -1)) < 0) {
  1201. printk(KERN_ERR LOGNAME ": Unable to register DSP operationsn");
  1202. msnd_unregister(&dev);
  1203. release_region(dev.io, dev.numio);
  1204. free_irq(dev.irq, &dev);
  1205. return dev.dsp_minor;
  1206. }
  1207. if ((dev.mixer_minor = register_sound_mixer(&dev_fileops, -1)) < 0) {
  1208. printk(KERN_ERR LOGNAME ": Unable to register mixer operationsn");
  1209. unregister_sound_mixer(dev.mixer_minor);
  1210. msnd_unregister(&dev);
  1211. release_region(dev.io, dev.numio);
  1212. free_irq(dev.irq, &dev);
  1213. return dev.mixer_minor;
  1214. }
  1215. dev.ext_midi_dev = dev.hdr_midi_dev = -1;
  1216. disable_irq(dev.irq);
  1217. calibrate_adc(dev.play_sample_rate);
  1218. #ifndef MSND_CLASSIC
  1219. force_recsrc(SOUND_MASK_IMIX);
  1220. #endif
  1221. return 0;
  1222. }
  1223. static void __exit unload_multisound(void)
  1224. {
  1225. release_region(dev.io, dev.numio);
  1226. free_irq(dev.irq, &dev);
  1227. unregister_sound_mixer(dev.mixer_minor);
  1228. unregister_sound_dsp(dev.dsp_minor);
  1229. msnd_unregister(&dev);
  1230. }
  1231. #ifndef MSND_CLASSIC
  1232. /* Pinnacle/Fiji Logical Device Configuration */
  1233. static int __init msnd_write_cfg(int cfg, int reg, int value)
  1234. {
  1235. outb(reg, cfg);
  1236. outb(value, cfg + 1);
  1237. if (value != inb(cfg + 1)) {
  1238. printk(KERN_ERR LOGNAME ": msnd_write_cfg: I/O errorn");
  1239. return -EIO;
  1240. }
  1241. return 0;
  1242. }
  1243. static int __init msnd_write_cfg_io0(int cfg, int num, WORD io)
  1244. {
  1245. if (msnd_write_cfg(cfg, IREG_LOGDEVICE, num))
  1246. return -EIO;
  1247. if (msnd_write_cfg(cfg, IREG_IO0_BASEHI, HIBYTE(io)))
  1248. return -EIO;
  1249. if (msnd_write_cfg(cfg, IREG_IO0_BASELO, LOBYTE(io)))
  1250. return -EIO;
  1251. return 0;
  1252. }
  1253. static int __init msnd_write_cfg_io1(int cfg, int num, WORD io)
  1254. {
  1255. if (msnd_write_cfg(cfg, IREG_LOGDEVICE, num))
  1256. return -EIO;
  1257. if (msnd_write_cfg(cfg, IREG_IO1_BASEHI, HIBYTE(io)))
  1258. return -EIO;
  1259. if (msnd_write_cfg(cfg, IREG_IO1_BASELO, LOBYTE(io)))
  1260. return -EIO;
  1261. return 0;
  1262. }
  1263. static int __init msnd_write_cfg_irq(int cfg, int num, WORD irq)
  1264. {
  1265. if (msnd_write_cfg(cfg, IREG_LOGDEVICE, num))
  1266. return -EIO;
  1267. if (msnd_write_cfg(cfg, IREG_IRQ_NUMBER, LOBYTE(irq)))
  1268. return -EIO;
  1269. if (msnd_write_cfg(cfg, IREG_IRQ_TYPE, IRQTYPE_EDGE))
  1270. return -EIO;
  1271. return 0;
  1272. }
  1273. static int __init msnd_write_cfg_mem(int cfg, int num, int mem)
  1274. {
  1275. WORD wmem;
  1276. mem >>= 8;
  1277. mem &= 0xfff;
  1278. wmem = (WORD)mem;
  1279. if (msnd_write_cfg(cfg, IREG_LOGDEVICE, num))
  1280. return -EIO;
  1281. if (msnd_write_cfg(cfg, IREG_MEMBASEHI, HIBYTE(wmem)))
  1282. return -EIO;
  1283. if (msnd_write_cfg(cfg, IREG_MEMBASELO, LOBYTE(wmem)))
  1284. return -EIO;
  1285. if (wmem && msnd_write_cfg(cfg, IREG_MEMCONTROL, (MEMTYPE_HIADDR | MEMTYPE_16BIT)))
  1286. return -EIO;
  1287. return 0;
  1288. }
  1289. static int __init msnd_activate_logical(int cfg, int num)
  1290. {
  1291. if (msnd_write_cfg(cfg, IREG_LOGDEVICE, num))
  1292. return -EIO;
  1293. if (msnd_write_cfg(cfg, IREG_ACTIVATE, LD_ACTIVATE))
  1294. return -EIO;
  1295. return 0;
  1296. }
  1297. static int __init msnd_write_cfg_logical(int cfg, int num, WORD io0, WORD io1, WORD irq, int mem)
  1298. {
  1299. if (msnd_write_cfg(cfg, IREG_LOGDEVICE, num))
  1300. return -EIO;
  1301. if (msnd_write_cfg_io0(cfg, num, io0))
  1302. return -EIO;
  1303. if (msnd_write_cfg_io1(cfg, num, io1))
  1304. return -EIO;
  1305. if (msnd_write_cfg_irq(cfg, num, irq))
  1306. return -EIO;
  1307. if (msnd_write_cfg_mem(cfg, num, mem))
  1308. return -EIO;
  1309. if (msnd_activate_logical(cfg, num))
  1310. return -EIO;
  1311. return 0;
  1312. }
  1313. typedef struct msnd_pinnacle_cfg_device {
  1314. WORD io0, io1, irq;
  1315. int mem;
  1316. } msnd_pinnacle_cfg_t[4];
  1317. static int __init msnd_pinnacle_cfg_devices(int cfg, int reset, msnd_pinnacle_cfg_t device)
  1318. {
  1319. int i;
  1320. /* Reset devices if told to */
  1321. if (reset) {
  1322. printk(KERN_INFO LOGNAME ": Resetting all devicesn");
  1323. for (i = 0; i < 4; ++i)
  1324. if (msnd_write_cfg_logical(cfg, i, 0, 0, 0, 0))
  1325. return -EIO;
  1326. }
  1327. /* Configure specified devices */
  1328. for (i = 0; i < 4; ++i) {
  1329. switch (i) {
  1330. case 0: /* DSP */
  1331. if (!(device[i].io0 && device[i].irq && device[i].mem))
  1332. continue;
  1333. break;
  1334. case 1: /* MPU */
  1335. if (!(device[i].io0 && device[i].irq))
  1336. continue;
  1337. printk(KERN_INFO LOGNAME
  1338.        ": Configuring MPU to I/O 0x%x IRQ %dn",
  1339.        device[i].io0, device[i].irq);
  1340. break;
  1341. case 2: /* IDE */
  1342. if (!(device[i].io0 && device[i].io1 && device[i].irq))
  1343. continue;
  1344. printk(KERN_INFO LOGNAME
  1345.        ": Configuring IDE to I/O 0x%x, 0x%x IRQ %dn",
  1346.        device[i].io0, device[i].io1, device[i].irq);
  1347. break;
  1348. case 3: /* Joystick */
  1349. if (!(device[i].io0))
  1350. continue;
  1351. printk(KERN_INFO LOGNAME
  1352.        ": Configuring joystick to I/O 0x%xn",
  1353.        device[i].io0);
  1354. break;
  1355. }
  1356. /* Configure the device */
  1357. if (msnd_write_cfg_logical(cfg, i, device[i].io0, device[i].io1, device[i].irq, device[i].mem))
  1358. return -EIO;
  1359. }
  1360. return 0;
  1361. }
  1362. #endif
  1363. #ifdef MODULE
  1364. MODULE_AUTHOR ("Andrew Veliath <andrewtv@usa.net>");
  1365. MODULE_DESCRIPTION ("Turtle Beach " LONGNAME " Linux Driver");
  1366. MODULE_LICENSE("GPL");
  1367. MODULE_PARM (io, "i");
  1368. MODULE_PARM (irq, "i");
  1369. MODULE_PARM (mem, "i");
  1370. MODULE_PARM (write_ndelay, "i");
  1371. MODULE_PARM (fifosize, "i");
  1372. MODULE_PARM (calibrate_signal, "i");
  1373. #ifndef MSND_CLASSIC
  1374. MODULE_PARM (digital, "i");
  1375. MODULE_PARM (cfg, "i");
  1376. MODULE_PARM (reset, "i");
  1377. MODULE_PARM (mpu_io, "i");
  1378. MODULE_PARM (mpu_irq, "i");
  1379. MODULE_PARM (ide_io0, "i");
  1380. MODULE_PARM (ide_io1, "i");
  1381. MODULE_PARM (ide_irq, "i");
  1382. MODULE_PARM (joystick_io, "i");
  1383. #endif
  1384. static int io __initdata = -1;
  1385. static int irq __initdata = -1;
  1386. static int mem __initdata = -1;
  1387. static int write_ndelay __initdata = -1;
  1388. #ifndef MSND_CLASSIC
  1389. /* Pinnacle/Fiji non-PnP Config Port */
  1390. static int cfg __initdata = -1;
  1391. /* Extra Peripheral Configuration */
  1392. static int reset __initdata = 0;
  1393. static int mpu_io __initdata = 0;
  1394. static int mpu_irq __initdata = 0;
  1395. static int ide_io0 __initdata = 0;
  1396. static int ide_io1 __initdata = 0;
  1397. static int ide_irq __initdata = 0;
  1398. static int joystick_io __initdata = 0;
  1399. /* If we have the digital daugherboard... */
  1400. static int digital __initdata = 0;
  1401. #endif
  1402. static int fifosize __initdata = DEFFIFOSIZE;
  1403. static int calibrate_signal __initdata = 0;
  1404. #else /* not a module */
  1405. static int write_ndelay __initdata = -1;
  1406. #ifdef MSND_CLASSIC
  1407. static int io __initdata = CONFIG_MSNDCLAS_IO;
  1408. static int irq __initdata = CONFIG_MSNDCLAS_IRQ;
  1409. static int mem __initdata = CONFIG_MSNDCLAS_MEM;
  1410. #else /* Pinnacle/Fiji */
  1411. static int io __initdata = CONFIG_MSNDPIN_IO;
  1412. static int irq __initdata = CONFIG_MSNDPIN_IRQ;
  1413. static int mem __initdata = CONFIG_MSNDPIN_MEM;
  1414. /* Pinnacle/Fiji non-PnP Config Port */
  1415. #ifdef CONFIG_MSNDPIN_NONPNP
  1416. #  ifndef CONFIG_MSNDPIN_CFG
  1417. #    define CONFIG_MSNDPIN_CFG 0x250
  1418. #  endif
  1419. #else
  1420. #  ifdef CONFIG_MSNDPIN_CFG
  1421. #    undef CONFIG_MSNDPIN_CFG
  1422. #  endif
  1423. #  define CONFIG_MSNDPIN_CFG -1
  1424. #endif
  1425. static int cfg __initdata = CONFIG_MSNDPIN_CFG;
  1426. /* If not a module, we don't need to bother with reset=1 */
  1427. static int reset;
  1428. /* Extra Peripheral Configuration (Default: Disable) */
  1429. #ifndef CONFIG_MSNDPIN_MPU_IO
  1430. #  define CONFIG_MSNDPIN_MPU_IO 0
  1431. #endif
  1432. static int mpu_io __initdata = CONFIG_MSNDPIN_MPU_IO;
  1433. #ifndef CONFIG_MSNDPIN_MPU_IRQ
  1434. #  define CONFIG_MSNDPIN_MPU_IRQ 0
  1435. #endif
  1436. static int mpu_irq __initdata = CONFIG_MSNDPIN_MPU_IRQ;
  1437. #ifndef CONFIG_MSNDPIN_IDE_IO0
  1438. #  define CONFIG_MSNDPIN_IDE_IO0 0
  1439. #endif
  1440. static int ide_io0 __initdata = CONFIG_MSNDPIN_IDE_IO0;
  1441. #ifndef CONFIG_MSNDPIN_IDE_IO1
  1442. #  define CONFIG_MSNDPIN_IDE_IO1 0
  1443. #endif
  1444. static int ide_io1 __initdata = CONFIG_MSNDPIN_IDE_IO1;
  1445. #ifndef CONFIG_MSNDPIN_IDE_IRQ
  1446. #  define CONFIG_MSNDPIN_IDE_IRQ 0
  1447. #endif
  1448. static int ide_irq __initdata = CONFIG_MSNDPIN_IDE_IRQ;
  1449. #ifndef CONFIG_MSNDPIN_JOYSTICK_IO
  1450. #  define CONFIG_MSNDPIN_JOYSTICK_IO 0
  1451. #endif
  1452. static int joystick_io __initdata = CONFIG_MSNDPIN_JOYSTICK_IO;
  1453. /* Have SPDIF (Digital) Daughterboard */
  1454. #ifndef CONFIG_MSNDPIN_DIGITAL
  1455. #  define CONFIG_MSNDPIN_DIGITAL 0
  1456. #endif
  1457. static int digital __initdata = CONFIG_MSNDPIN_DIGITAL;
  1458. #endif /* MSND_CLASSIC */
  1459. #ifndef CONFIG_MSND_FIFOSIZE
  1460. #  define CONFIG_MSND_FIFOSIZE DEFFIFOSIZE
  1461. #endif
  1462. static int fifosize __initdata = CONFIG_MSND_FIFOSIZE;
  1463. #ifndef CONFIG_MSND_CALSIGNAL
  1464. #  define CONFIG_MSND_CALSIGNAL 0
  1465. #endif
  1466. static int
  1467. calibrate_signal __initdata = CONFIG_MSND_CALSIGNAL;
  1468. #endif /* MODULE */
  1469. static int __init msnd_init(void)
  1470. {
  1471. int err;
  1472. #ifndef MSND_CLASSIC
  1473. static msnd_pinnacle_cfg_t pinnacle_devs;
  1474. #endif /* MSND_CLASSIC */
  1475. printk(KERN_INFO LOGNAME ": Turtle Beach " LONGNAME " Linux Driver Version "
  1476.        VERSION ", Copyright (C) 1998 Andrew Veliathn");
  1477. if (io == -1 || irq == -1 || mem == -1)
  1478. printk(KERN_WARNING LOGNAME ": io, irq and mem must be setn");
  1479. #ifdef MSND_CLASSIC
  1480. if (io == -1 ||
  1481.     !(io == 0x290 ||
  1482.       io == 0x260 ||
  1483.       io == 0x250 ||
  1484.       io == 0x240 ||
  1485.       io == 0x230 ||
  1486.       io == 0x220 ||
  1487.       io == 0x210 ||
  1488.       io == 0x3e0)) {
  1489. printk(KERN_ERR LOGNAME ": "io" - DSP I/O base must be set to 0x210, 0x220, 0x230, 0x240, 0x250, 0x260, 0x290, or 0x3E0n");
  1490. return -EINVAL;
  1491. }
  1492. #else
  1493. if (io == -1 ||
  1494. io < 0x100 ||
  1495. io > 0x3e0 ||
  1496. (io % 0x10) != 0) {
  1497. printk(KERN_ERR LOGNAME ": "io" - DSP I/O base must within the range 0x100 to 0x3E0 and must be evenly divisible by 0x10n");
  1498. return -EINVAL;
  1499. }
  1500. #endif /* MSND_CLASSIC */
  1501. if (irq == -1 ||
  1502.     !(irq == 5 ||
  1503.       irq == 7 ||
  1504.       irq == 9 ||
  1505.       irq == 10 ||
  1506.       irq == 11 ||
  1507.       irq == 12)) {
  1508. printk(KERN_ERR LOGNAME ": "irq" - must be set to 5, 7, 9, 10, 11 or 12n");
  1509. return -EINVAL;
  1510. }
  1511. if (mem == -1 ||
  1512.     !(mem == 0xb0000 ||
  1513.       mem == 0xc8000 ||
  1514.       mem == 0xd0000 ||
  1515.       mem == 0xd8000 ||
  1516.       mem == 0xe0000 ||
  1517.       mem == 0xe8000)) {
  1518. printk(KERN_ERR LOGNAME ": "mem" - must be set to "
  1519.        "0xb0000, 0xc8000, 0xd0000, 0xd8000, 0xe0000 or 0xe8000n");
  1520. return -EINVAL;
  1521. }
  1522. #ifdef MSND_CLASSIC
  1523. switch (irq) {
  1524. case 5: dev.irqid = HPIRQ_5; break;
  1525. case 7: dev.irqid = HPIRQ_7; break;
  1526. case 9: dev.irqid = HPIRQ_9; break;
  1527. case 10: dev.irqid = HPIRQ_10; break;
  1528. case 11: dev.irqid = HPIRQ_11; break;
  1529. case 12: dev.irqid = HPIRQ_12; break;
  1530. }
  1531. switch (mem) {
  1532. case 0xb0000: dev.memid = HPMEM_B000; break;
  1533. case 0xc8000: dev.memid = HPMEM_C800; break;
  1534. case 0xd0000: dev.memid = HPMEM_D000; break;
  1535. case 0xd8000: dev.memid = HPMEM_D800; break;
  1536. case 0xe0000: dev.memid = HPMEM_E000; break;
  1537. case 0xe8000: dev.memid = HPMEM_E800; break;
  1538. }
  1539. #else
  1540. if (cfg == -1) {
  1541. printk(KERN_INFO LOGNAME ": Assuming PnP moden");
  1542. } else if (cfg != 0x250 && cfg != 0x260 && cfg != 0x270) {
  1543. printk(KERN_INFO LOGNAME ": Config port must be 0x250, 0x260 or 0x270 (or unspecified for PnP mode)n");
  1544. return -EINVAL;
  1545. } else {
  1546. printk(KERN_INFO LOGNAME ": Non-PnP mode: configuring at port 0x%xn", cfg);
  1547. /* DSP */
  1548. pinnacle_devs[0].io0 = io;
  1549. pinnacle_devs[0].irq = irq;
  1550. pinnacle_devs[0].mem = mem;
  1551. /* The following are Pinnacle specific */
  1552. /* MPU */
  1553. pinnacle_devs[1].io0 = mpu_io;
  1554. pinnacle_devs[1].irq = mpu_irq;
  1555. /* IDE */
  1556. pinnacle_devs[2].io0 = ide_io0;
  1557. pinnacle_devs[2].io1 = ide_io1;
  1558. pinnacle_devs[2].irq = ide_irq;
  1559. /* Joystick */
  1560. pinnacle_devs[3].io0 = joystick_io;
  1561. if (check_region(cfg, 2)) {
  1562. printk(KERN_ERR LOGNAME ": Config port 0x%x conflictn", cfg);
  1563. return -EIO;
  1564. }
  1565. request_region(cfg, 2, "Pinnacle/Fiji Config");
  1566. if (msnd_pinnacle_cfg_devices(cfg, reset, pinnacle_devs)) {
  1567. printk(KERN_ERR LOGNAME ": Device configuration errorn");
  1568. release_region(cfg, 2);
  1569. return -EIO;
  1570. }
  1571. release_region(cfg, 2);
  1572. }
  1573. #endif /* MSND_CLASSIC */
  1574. if (fifosize < 16)
  1575. fifosize = 16;
  1576. if (fifosize > 1024)
  1577. fifosize = 1024;
  1578. set_default_audio_parameters();
  1579. #ifdef MSND_CLASSIC
  1580. dev.type = msndClassic;
  1581. #else
  1582. dev.type = msndPinnacle;
  1583. #endif
  1584. dev.io = io;
  1585. dev.numio = DSP_NUMIO;
  1586. dev.irq = irq;
  1587. dev.base = mem;
  1588. dev.fifosize = fifosize * 1024;
  1589. dev.calibrate_signal = calibrate_signal ? 1 : 0;
  1590. dev.recsrc = 0;
  1591. dev.dspq_data_buff = DSPQ_DATA_BUFF;
  1592. dev.dspq_buff_size = DSPQ_BUFF_SIZE;
  1593. if (write_ndelay == -1)
  1594. write_ndelay = CONFIG_MSND_WRITE_NDELAY;
  1595. if (write_ndelay)
  1596. clear_bit(F_DISABLE_WRITE_NDELAY, &dev.flags);
  1597. else
  1598. set_bit(F_DISABLE_WRITE_NDELAY, &dev.flags);
  1599. #ifndef MSND_CLASSIC
  1600. if (digital)
  1601. set_bit(F_HAVEDIGITAL, &dev.flags);
  1602. #endif
  1603. init_waitqueue_head(&dev.writeblock);
  1604. init_waitqueue_head(&dev.readblock);
  1605. init_waitqueue_head(&dev.writeflush);
  1606. msnd_fifo_init(&dev.DAPF);
  1607. msnd_fifo_init(&dev.DARF);
  1608. spin_lock_init(&dev.lock);
  1609. printk(KERN_INFO LOGNAME ": %u byte audio FIFOs (x2)n", dev.fifosize);
  1610. if ((err = msnd_fifo_alloc(&dev.DAPF, dev.fifosize)) < 0) {
  1611. printk(KERN_ERR LOGNAME ": Couldn't allocate write FIFOn");
  1612. return err;
  1613. }
  1614. if ((err = msnd_fifo_alloc(&dev.DARF, dev.fifosize)) < 0) {
  1615. printk(KERN_ERR LOGNAME ": Couldn't allocate read FIFOn");
  1616. msnd_fifo_free(&dev.DAPF);
  1617. return err;
  1618. }
  1619. if ((err = probe_multisound()) < 0) {
  1620. printk(KERN_ERR LOGNAME ": Probe failedn");
  1621. msnd_fifo_free(&dev.DAPF);
  1622. msnd_fifo_free(&dev.DARF);
  1623. return err;
  1624. }
  1625. if ((err = attach_multisound()) < 0) {
  1626. printk(KERN_ERR LOGNAME ": Attach failedn");
  1627. msnd_fifo_free(&dev.DAPF);
  1628. msnd_fifo_free(&dev.DARF);
  1629. return err;
  1630. }
  1631. return 0;
  1632. }
  1633. static void __exit msdn_cleanup(void)
  1634. {
  1635. unload_multisound();
  1636. msnd_fifo_free(&dev.DAPF);
  1637. msnd_fifo_free(&dev.DARF);
  1638. }
  1639. module_init(msnd_init);
  1640. module_exit(msdn_cleanup);