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

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  **********************************************************************
  3.  *     cardwo.c - PCM output HAL for emu10k1 driver
  4.  *     Copyright 1999, 2000 Creative Labs, Inc.
  5.  *
  6.  **********************************************************************
  7.  *
  8.  *     Date                 Author          Summary of changes
  9.  *     ----                 ------          ------------------
  10.  *     October 20, 1999     Bertrand Lee    base code release
  11.  *
  12.  **********************************************************************
  13.  *
  14.  *     This program is free software; you can redistribute it and/or
  15.  *     modify it under the terms of the GNU General Public License as
  16.  *     published by the Free Software Foundation; either version 2 of
  17.  *     the License, or (at your option) any later version.
  18.  *
  19.  *     This program is distributed in the hope that it will be useful,
  20.  *     but WITHOUT ANY WARRANTY; without even the implied warranty of
  21.  *     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  22.  *     GNU General Public License for more details.
  23.  *
  24.  *     You should have received a copy of the GNU General Public
  25.  *     License along with this program; if not, write to the Free
  26.  *     Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139,
  27.  *     USA.
  28.  *
  29.  **********************************************************************
  30.  */
  31. #include <linux/poll.h>
  32. #include "hwaccess.h"
  33. #include "8010.h"
  34. #include "voicemgr.h"
  35. #include "cardwo.h"
  36. #include "audio.h"
  37. static u32 samplerate_to_linearpitch(u32 samplingrate)
  38. {
  39. samplingrate = (samplingrate << 8) / 375;
  40. return (samplingrate >> 1) + (samplingrate & 1);
  41. }
  42. static void query_format(struct emu10k1_wavedevice *wave_dev, struct wave_format *wave_fmt)
  43. {
  44. int i, j, do_passthrough = 0, is_ac3 = 0;
  45. struct emu10k1_card *card = wave_dev->card;
  46. struct woinst *woinst = wave_dev->woinst;
  47. if ((wave_fmt->channels > 2) && (wave_fmt->id != AFMT_S16_LE) && (wave_fmt->id != AFMT_U8))
  48. wave_fmt->channels = 2;
  49. if ((wave_fmt->channels < 1) || (wave_fmt->channels > WAVEOUT_MAXVOICES))
  50. wave_fmt->channels = 2;
  51. if (wave_fmt->channels == 2)
  52. woinst->num_voices = 1;
  53. else
  54. woinst->num_voices = wave_fmt->channels;
  55. if (wave_fmt->samplingrate >= 0x2ee00)
  56. wave_fmt->samplingrate = 0x2ee00;
  57. wave_fmt->passthrough = 0;
  58. do_passthrough = is_ac3 = 0;
  59. if (card->pt.selected)
  60. do_passthrough = 1;
  61. switch (wave_fmt->id) {
  62. case AFMT_S16_LE:
  63. wave_fmt->bitsperchannel = 16;
  64. break;
  65. case AFMT_U8:
  66. wave_fmt->bitsperchannel = 8;
  67. break;
  68. case AFMT_AC3:
  69. do_passthrough = 1;
  70. is_ac3 = 1;
  71. break;
  72. default:
  73. wave_fmt->id = AFMT_S16_LE;
  74. wave_fmt->bitsperchannel = 16;
  75. break;
  76. }
  77. if (do_passthrough) {
  78. i = emu10k1_find_control_gpr(&card->mgr, card->pt.patch_name, card->pt.intr_gpr_name);
  79. j = emu10k1_find_control_gpr(&card->mgr, card->pt.patch_name, card->pt.enable_gpr_name);
  80. /* currently only one waveout instance may use pass-through */
  81. if (i < 0 || j < 0 || woinst->state != WAVE_STATE_CLOSED || 
  82.     card->pt.state != PT_STATE_INACTIVE ||
  83.     (wave_fmt->samplingrate != 48000 && !is_ac3) ||
  84.     (wave_fmt->samplingrate != 48000 && !is_ac3)) {
  85. DPF(2, "unable to set pass-through moden");
  86. } else {
  87. wave_fmt->samplingrate = 48000;
  88. wave_fmt->channels = 2;
  89. wave_fmt->passthrough = 1;
  90. card->pt.intr_gpr = i;
  91. card->pt.enable_gpr = j;
  92. card->pt.state = PT_STATE_INACTIVE;
  93. card->pt.pos_gpr = emu10k1_find_control_gpr(&card->mgr, card->pt.patch_name, card->pt.pos_gpr_name);
  94. DPD(2, "is_ac3 is %dn", is_ac3);
  95. card->pt.ac3data = is_ac3;
  96.                 wave_fmt->bitsperchannel = 16;
  97. }
  98. }
  99. wave_fmt->bytesperchannel = wave_fmt->bitsperchannel >> 3;
  100. wave_fmt->bytespersample = wave_fmt->channels * wave_fmt->bytesperchannel;
  101. wave_fmt->bytespersec = wave_fmt->bytespersample * wave_fmt->samplingrate;
  102. if (wave_fmt->channels == 2)
  103. wave_fmt->bytespervoicesample = wave_fmt->channels * wave_fmt->bytesperchannel;
  104. else
  105. wave_fmt->bytespervoicesample = wave_fmt->bytesperchannel;
  106. }
  107. static int get_voice(struct emu10k1_card *card, struct woinst *woinst, unsigned int voicenum)
  108. {
  109. struct emu_voice *voice = &woinst->voice[voicenum];
  110. /* Allocate voices here, if no voices available, return error. */
  111. voice->usage = VOICE_USAGE_PLAYBACK;
  112. voice->flags = 0;
  113. if (woinst->format.channels == 2)
  114. voice->flags |= VOICE_FLAGS_STEREO;
  115. if (woinst->format.bitsperchannel == 16)
  116. voice->flags |= VOICE_FLAGS_16BIT;
  117. if (emu10k1_voice_alloc(card, voice) < 0) {
  118. voice->usage = VOICE_USAGE_FREE;
  119. return -1;
  120. }
  121. /* Calculate pitch */
  122. voice->initial_pitch = (u16) (srToPitch(woinst->format.samplingrate) >> 8);
  123. voice->pitch_target = samplerate_to_linearpitch(woinst->format.samplingrate);
  124. DPD(2, "Initial pitch --> %#xn", voice->initial_pitch);
  125. voice->startloop = (voice->mem.emupageindex << 12) /
  126.  woinst->format.bytespervoicesample;
  127. voice->endloop = voice->startloop + woinst->buffer.size / woinst->format.bytespervoicesample;
  128. voice->start = voice->startloop;
  129. if (voice->flags & VOICE_FLAGS_STEREO) {
  130. voice->params[0].send_a = card->waveout.send_a[1];
  131. voice->params[0].send_b = card->waveout.send_b[1];
  132. voice->params[0].send_c = card->waveout.send_c[1];
  133. voice->params[0].send_d = card->waveout.send_d[1];
  134. if (woinst->device)
  135. voice->params[0].send_routing = 0x7654;
  136. else
  137. voice->params[0].send_routing = card->waveout.send_routing[1];
  138. voice->params[0].volume_target = 0xffff;
  139. voice->params[0].initial_fc = 0xff;
  140. voice->params[0].initial_attn = 0x00;
  141. voice->params[0].byampl_env_sustain = 0x7f;
  142. voice->params[0].byampl_env_decay = 0x7f;
  143. voice->params[1].send_a = card->waveout.send_a[2];
  144. voice->params[1].send_b = card->waveout.send_b[2];
  145. voice->params[1].send_c = card->waveout.send_c[2];
  146. voice->params[1].send_d = card->waveout.send_d[2];
  147. if (woinst->device)
  148. voice->params[1].send_routing = 0x7654;
  149. else
  150. voice->params[1].send_routing = card->waveout.send_routing[2];
  151. voice->params[1].volume_target = 0xffff;
  152. voice->params[1].initial_fc = 0xff;
  153. voice->params[1].initial_attn = 0x00;
  154. voice->params[1].byampl_env_sustain = 0x7f;
  155. voice->params[1].byampl_env_decay = 0x7f;
  156. } else {
  157. if (woinst->num_voices > 1) {
  158. voice->params[0].send_a = 0xff;
  159. voice->params[0].send_b = 0;
  160. voice->params[0].send_c = 0;
  161. voice->params[0].send_d = 0;
  162. voice->params[0].send_routing =
  163.  0xfff0 + card->mchannel_fx + voicenum;
  164. } else {
  165. voice->params[0].send_a = card->waveout.send_a[0];
  166. voice->params[0].send_b = card->waveout.send_b[0];
  167. voice->params[0].send_c = card->waveout.send_c[0];
  168. voice->params[0].send_d = card->waveout.send_d[0];
  169. if (woinst->device)
  170. voice->params[0].send_routing = 0x7654;
  171. else
  172. voice->params[0].send_routing = card->waveout.send_routing[0];
  173. }
  174. voice->params[0].volume_target = 0xffff;
  175. voice->params[0].initial_fc = 0xff;
  176. voice->params[0].initial_attn = 0x00;
  177. voice->params[0].byampl_env_sustain = 0x7f;
  178. voice->params[0].byampl_env_decay = 0x7f;
  179. }
  180. DPD(2, "voice: startloop=%#x, endloop=%#xn", voice->startloop, voice->endloop);
  181. emu10k1_voice_playback_setup(voice);
  182. return 0;
  183. }
  184. int emu10k1_waveout_open(struct emu10k1_wavedevice *wave_dev)
  185. {
  186. struct emu10k1_card *card = wave_dev->card;
  187. struct woinst *woinst = wave_dev->woinst;
  188. struct waveout_buffer *buffer = &woinst->buffer;
  189. unsigned int voicenum;
  190. u16 delay;
  191. DPF(2, "emu10k1_waveout_open()n");
  192. for (voicenum = 0; voicenum < woinst->num_voices; voicenum++) {
  193. if (emu10k1_voice_alloc_buffer(card, &woinst->voice[voicenum].mem, woinst->buffer.pages) < 0) {
  194. ERROR();
  195. emu10k1_waveout_close(wave_dev);
  196. return -1;
  197. }
  198. if (get_voice(card, woinst, voicenum) < 0) {
  199. ERROR();
  200. emu10k1_waveout_close(wave_dev);
  201. return -1;
  202. }
  203. }
  204. buffer->fill_silence = 0;
  205. buffer->silence_bytes = 0;
  206. buffer->silence_pos = 0;
  207. buffer->hw_pos = 0;
  208. buffer->free_bytes = woinst->buffer.size;
  209. delay = (48000 * woinst->buffer.fragment_size) /
  210.  (woinst->format.samplingrate * woinst->format.bytespervoicesample);
  211. emu10k1_timer_install(card, &woinst->timer, delay);
  212. woinst->state = WAVE_STATE_OPEN;
  213. return 0;
  214. }
  215. void emu10k1_waveout_close(struct emu10k1_wavedevice *wave_dev)
  216. {
  217. struct emu10k1_card *card = wave_dev->card;
  218. struct woinst *woinst = wave_dev->woinst;
  219. unsigned int voicenum;
  220. DPF(2, "emu10k1_waveout_close()n");
  221. emu10k1_waveout_stop(wave_dev);
  222. emu10k1_timer_uninstall(card, &woinst->timer);
  223. for (voicenum = 0; voicenum < woinst->num_voices; voicenum++) {
  224. emu10k1_voice_free(&woinst->voice[voicenum]);
  225. emu10k1_voice_free_buffer(card, &woinst->voice[voicenum].mem);
  226. }
  227. woinst->state = WAVE_STATE_CLOSED;
  228. }
  229. void emu10k1_waveout_start(struct emu10k1_wavedevice *wave_dev)
  230. {
  231. struct emu10k1_card *card = wave_dev->card;
  232. struct woinst *woinst = wave_dev->woinst;
  233. DPF(2, "emu10k1_waveout_start()n");
  234. /* Actual start */
  235. emu10k1_voices_start(woinst->voice, woinst->num_voices, woinst->total_played);
  236. emu10k1_timer_enable(card, &woinst->timer);
  237. woinst->state |= WAVE_STATE_STARTED;
  238. }
  239. int emu10k1_waveout_setformat(struct emu10k1_wavedevice *wave_dev, struct wave_format *format)
  240. {
  241. struct emu10k1_card *card = wave_dev->card;
  242. struct woinst *woinst = wave_dev->woinst;
  243. unsigned int voicenum;
  244. u16 delay;
  245. DPF(2, "emu10k1_waveout_setformat()n");
  246. if (woinst->state & WAVE_STATE_STARTED)
  247. return -1;
  248. query_format(wave_dev, format);
  249. if (woinst->format.samplingrate != format->samplingrate ||
  250.     woinst->format.channels != format->channels ||
  251.     woinst->format.bitsperchannel != format->bitsperchannel) {
  252. woinst->format = *format;
  253. if (woinst->state == WAVE_STATE_CLOSED)
  254. return 0;
  255. emu10k1_timer_uninstall(card, &woinst->timer);
  256. for (voicenum = 0; voicenum < woinst->num_voices; voicenum++) {
  257. emu10k1_voice_free(&woinst->voice[voicenum]);
  258. if (get_voice(card, woinst, voicenum) < 0) {
  259. ERROR();
  260. emu10k1_waveout_close(wave_dev);
  261. return -1;
  262. }
  263. }
  264. delay = (48000 * woinst->buffer.fragment_size) /
  265.  (woinst->format.samplingrate * woinst->format.bytespervoicesample);
  266. emu10k1_timer_install(card, &woinst->timer, delay);
  267. }
  268. return 0;
  269. }
  270. void emu10k1_waveout_stop(struct emu10k1_wavedevice *wave_dev)
  271. {
  272. struct emu10k1_card *card = wave_dev->card;
  273. struct woinst *woinst = wave_dev->woinst;
  274. DPF(2, "emu10k1_waveout_stop()n");
  275. if (!(woinst->state & WAVE_STATE_STARTED))
  276. return;
  277. emu10k1_timer_disable(card, &woinst->timer);
  278. /* Stop actual voices */
  279. emu10k1_voices_stop(woinst->voice, woinst->num_voices);
  280. emu10k1_waveout_update(woinst);
  281. woinst->state &= ~WAVE_STATE_STARTED;
  282. }
  283. /**
  284.  * emu10k1_waveout_getxfersize -
  285.  *
  286.  * gives the total free bytes on the voice buffer, including silence bytes
  287.  * (basically: total_free_bytes = free_bytes + silence_bytes).
  288.  *
  289.  */
  290. void emu10k1_waveout_getxfersize(struct woinst *woinst, u32 *total_free_bytes)
  291. {
  292. struct waveout_buffer *buffer = &woinst->buffer;
  293. int pending_bytes;
  294. if (woinst->mmapped) {
  295. *total_free_bytes = buffer->free_bytes;
  296. return;
  297. }
  298. pending_bytes = buffer->size - buffer->free_bytes;
  299. buffer->fill_silence = (pending_bytes < (signed) buffer->fragment_size * 2) ? 1 : 0;
  300. if (pending_bytes > (signed) buffer->silence_bytes) {
  301. *total_free_bytes = (buffer->free_bytes + buffer->silence_bytes);
  302. } else {
  303. *total_free_bytes = buffer->size;
  304. buffer->silence_bytes = pending_bytes;
  305. if (pending_bytes < 0) {
  306. buffer->silence_pos = buffer->hw_pos;
  307. buffer->silence_bytes = 0;
  308. buffer->free_bytes = buffer->size;
  309. DPF(1, "buffer underrunn");
  310. }
  311. }
  312. }
  313. /**
  314.  * copy_block -
  315.  *
  316.  * copies a block of pcm data to a voice buffer.
  317.  * Notice that the voice buffer is actually a set of disjointed memory pages.
  318.  *
  319.  */
  320. static void copy_block(void **dst, u32 str, u8 *src, u32 len)
  321. {
  322. unsigned int pg;
  323. unsigned int pgoff;
  324. unsigned int k;
  325. pg = str / PAGE_SIZE;
  326. pgoff = str % PAGE_SIZE;
  327. if (len > PAGE_SIZE - pgoff) {
  328. k = PAGE_SIZE - pgoff;
  329. __copy_from_user((u8 *)dst[pg] + pgoff, src, k);
  330. len -= k;
  331. while (len > PAGE_SIZE) {
  332. __copy_from_user(dst[++pg], src + k, PAGE_SIZE);
  333. k += PAGE_SIZE;
  334. len -= PAGE_SIZE;
  335. }
  336. __copy_from_user(dst[++pg], src + k, len);
  337. } else
  338. __copy_from_user((u8 *)dst[pg] + pgoff, src, len);
  339. }
  340. /**
  341.  * copy_ilv_block -
  342.  *
  343.  * copies a block of pcm data containing n interleaved channels to n mono voice buffers.
  344.  * Notice that the voice buffer is actually a set of disjointed memory pages.
  345.  *
  346.  */
  347. static void copy_ilv_block(struct woinst *woinst, u32 str, u8 *src, u32 len) 
  348. {
  349.         unsigned int pg;
  350. unsigned int pgoff;
  351. unsigned int voice_num;
  352. struct emu_voice *voice = woinst->voice;
  353. pg = str / PAGE_SIZE;
  354. pgoff = str % PAGE_SIZE;
  355. while (len) { 
  356. for (voice_num = 0; voice_num < woinst->num_voices; voice_num++) {
  357. __copy_from_user((u8 *)(voice[voice_num].mem.addr[pg]) + pgoff, src, woinst->format.bytespervoicesample);
  358. src += woinst->format.bytespervoicesample;
  359. }
  360. len -= woinst->format.bytespervoicesample;
  361. pgoff += woinst->format.bytespervoicesample;
  362. if (pgoff >= PAGE_SIZE) {
  363. pgoff = 0;
  364. pg++;
  365. }
  366. }
  367. }
  368. /**
  369.  * fill_block -
  370.  *
  371.  * fills a set voice buffers with a block of a given sample.
  372.  *
  373.  */
  374. static void fill_block(struct woinst *woinst, u32 str, u8 data, u32 len)
  375. {
  376. unsigned int pg;
  377. unsigned int pgoff;
  378. unsigned int voice_num;
  379.         struct emu_voice *voice = woinst->voice;
  380. unsigned int  k;
  381. pg = str / PAGE_SIZE;
  382. pgoff = str % PAGE_SIZE;
  383. if (len > PAGE_SIZE - pgoff) {
  384. k = PAGE_SIZE - pgoff;
  385. for (voice_num = 0; voice_num < woinst->num_voices; voice_num++)
  386. memset((u8 *)voice[voice_num].mem.addr[pg] + pgoff, data, k);
  387. len -= k;
  388. while (len > PAGE_SIZE) {
  389. pg++;
  390. for (voice_num = 0; voice_num < woinst->num_voices; voice_num++)
  391. memset(voice[voice_num].mem.addr[pg], data, PAGE_SIZE);
  392. len -= PAGE_SIZE;
  393. }
  394. pg++;
  395. for (voice_num = 0; voice_num < woinst->num_voices; voice_num++)
  396. memset(voice[voice_num].mem.addr[pg], data, len);
  397. } else {
  398. for (voice_num = 0; voice_num < woinst->num_voices; voice_num++)
  399. memset((u8 *)voice[voice_num].mem.addr[pg] + pgoff, data, len);
  400. }
  401. }
  402. /**
  403.  * emu10k1_waveout_xferdata -
  404.  *
  405.  * copies pcm data to the voice buffer. Silence samples
  406.  * previously added to the buffer are overwritten.
  407.  *
  408.  */
  409. void emu10k1_waveout_xferdata(struct woinst *woinst, u8 *data, u32 *size)
  410. {
  411. struct waveout_buffer *buffer = &woinst->buffer;
  412. struct voice_mem *mem = &woinst->voice[0].mem;
  413. u32 sizetocopy, sizetocopy_now, start;
  414. unsigned long flags;
  415. sizetocopy = min_t(u32, buffer->size, *size);
  416. *size = sizetocopy;
  417. if (!sizetocopy)
  418. return;
  419. spin_lock_irqsave(&woinst->lock, flags);
  420. start = (buffer->size + buffer->silence_pos - buffer->silence_bytes) % buffer->size;
  421. if (sizetocopy > buffer->silence_bytes) {
  422. buffer->silence_pos += sizetocopy - buffer->silence_bytes;
  423. buffer->free_bytes -= sizetocopy - buffer->silence_bytes;
  424. buffer->silence_bytes = 0;
  425. } else
  426. buffer->silence_bytes -= sizetocopy;
  427. spin_unlock_irqrestore(&woinst->lock, flags);
  428. sizetocopy_now = buffer->size - start;
  429. if (sizetocopy > sizetocopy_now) {
  430. sizetocopy -= sizetocopy_now;
  431. if (woinst->num_voices > 1) {
  432. copy_ilv_block(woinst, start, data, sizetocopy_now);
  433. copy_ilv_block(woinst, 0, data + sizetocopy_now * woinst->num_voices, sizetocopy);
  434. } else {
  435. copy_block(mem->addr, start, data, sizetocopy_now);
  436. copy_block(mem->addr, 0, data + sizetocopy_now, sizetocopy);
  437. }
  438. } else {
  439. if (woinst->num_voices > 1)
  440. copy_ilv_block(woinst, start, data, sizetocopy);
  441. else
  442. copy_block(mem->addr, start, data, sizetocopy);
  443. }
  444. }
  445. /**
  446.  * emu10k1_waveout_fillsilence -
  447.  *
  448.  * adds samples of silence to the voice buffer so that we
  449.  * don't loop over stale pcm data.
  450.  *
  451.  */
  452. void emu10k1_waveout_fillsilence(struct woinst *woinst)
  453. {
  454. struct waveout_buffer *buffer = &woinst->buffer;
  455. u32 sizetocopy, sizetocopy_now, start;
  456. u8 filldata;
  457. unsigned long flags;
  458. sizetocopy = buffer->fragment_size;
  459. if (woinst->format.bitsperchannel == 16)
  460. filldata = 0x00;
  461. else
  462. filldata = 0x80;
  463. spin_lock_irqsave(&woinst->lock, flags);
  464. buffer->silence_bytes += sizetocopy;
  465. buffer->free_bytes -= sizetocopy;
  466. buffer->silence_pos %= buffer->size;
  467. start = buffer->silence_pos;
  468. buffer->silence_pos += sizetocopy;
  469. spin_unlock_irqrestore(&woinst->lock, flags);
  470. sizetocopy_now = buffer->size - start;
  471. if (sizetocopy > sizetocopy_now) {
  472. sizetocopy -= sizetocopy_now;
  473. fill_block(woinst, start, filldata, sizetocopy_now);
  474. fill_block(woinst, 0, filldata, sizetocopy);
  475. } else {
  476. fill_block(woinst, start, filldata, sizetocopy);
  477. }
  478. }
  479. /**
  480.  * emu10k1_waveout_update -
  481.  *
  482.  * updates the position of the voice buffer hardware pointer (hw_pos)
  483.  * and the number of free bytes on the buffer (free_bytes).
  484.  * The free bytes _don't_ include silence bytes that may have been
  485.  * added to the buffer.
  486.  *
  487.  */
  488. void emu10k1_waveout_update(struct woinst *woinst)
  489. {
  490. u32 hw_pos;
  491. u32 diff;
  492. /* There is no actual start yet */
  493. if (!(woinst->state & WAVE_STATE_STARTED)) {
  494. hw_pos = woinst->buffer.hw_pos;
  495. } else {
  496. /* hw_pos in sample units */
  497. hw_pos = sblive_readptr(woinst->voice[0].card, CCCA_CURRADDR, woinst->voice[0].num);
  498. if(hw_pos < woinst->voice[0].start)
  499. hw_pos += woinst->buffer.size / woinst->format.bytespervoicesample - woinst->voice[0].start;
  500. else
  501. hw_pos -= woinst->voice[0].start;
  502. hw_pos *= woinst->format.bytespervoicesample;
  503. }
  504. diff = (woinst->buffer.size + hw_pos - woinst->buffer.hw_pos) % woinst->buffer.size;
  505. woinst->total_played += diff;
  506. woinst->buffer.free_bytes += diff;
  507. woinst->buffer.hw_pos = hw_pos;
  508. }