qsa.c 31 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073
  1. /**
  2. * OpenAL cross platform audio library
  3. * Copyright (C) 2011-2013 by authors.
  4. * This library is free software; you can redistribute it and/or
  5. * modify it under the terms of the GNU Library General Public
  6. * License as published by the Free Software Foundation; either
  7. * version 2 of the License, or (at your option) any later version.
  8. *
  9. * This library is distributed in the hope that it will be useful,
  10. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  12. * Library General Public License for more details.
  13. *
  14. * You should have received a copy of the GNU Library General Public
  15. * License along with this library; if not, write to the
  16. * Free Software Foundation, Inc.,
  17. * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  18. * Or go to http://www.gnu.org/copyleft/lgpl.html
  19. */
  20. #include "config.h"
  21. #include <stdlib.h>
  22. #include <stdio.h>
  23. #include <sched.h>
  24. #include <errno.h>
  25. #include <memory.h>
  26. #include <sys/select.h>
  27. #include <sys/asoundlib.h>
  28. #include <sys/neutrino.h>
  29. #include "alMain.h"
  30. #include "alu.h"
  31. #include "threads.h"
  32. #include "backends/base.h"
  33. typedef struct {
  34. snd_pcm_t* pcmHandle;
  35. int audio_fd;
  36. snd_pcm_channel_setup_t csetup;
  37. snd_pcm_channel_params_t cparams;
  38. ALvoid* buffer;
  39. ALsizei size;
  40. ATOMIC(ALenum) killNow;
  41. althrd_t thread;
  42. } qsa_data;
  43. typedef struct {
  44. ALCchar* name;
  45. int card;
  46. int dev;
  47. } DevMap;
  48. TYPEDEF_VECTOR(DevMap, vector_DevMap)
  49. static vector_DevMap DeviceNameMap;
  50. static vector_DevMap CaptureNameMap;
  51. static const ALCchar qsaDevice[] = "QSA Default";
  52. static const struct {
  53. int32_t format;
  54. } formatlist[] = {
  55. {SND_PCM_SFMT_FLOAT_LE},
  56. {SND_PCM_SFMT_S32_LE},
  57. {SND_PCM_SFMT_U32_LE},
  58. {SND_PCM_SFMT_S16_LE},
  59. {SND_PCM_SFMT_U16_LE},
  60. {SND_PCM_SFMT_S8},
  61. {SND_PCM_SFMT_U8},
  62. {0},
  63. };
  64. static const struct {
  65. int32_t rate;
  66. } ratelist[] = {
  67. {192000},
  68. {176400},
  69. {96000},
  70. {88200},
  71. {48000},
  72. {44100},
  73. {32000},
  74. {24000},
  75. {22050},
  76. {16000},
  77. {12000},
  78. {11025},
  79. {8000},
  80. {0},
  81. };
  82. static const struct {
  83. int32_t channels;
  84. } channellist[] = {
  85. {8},
  86. {7},
  87. {6},
  88. {4},
  89. {2},
  90. {1},
  91. {0},
  92. };
  93. static void deviceList(int type, vector_DevMap *devmap)
  94. {
  95. snd_ctl_t* handle;
  96. snd_pcm_info_t pcminfo;
  97. int max_cards, card, err, dev;
  98. DevMap entry;
  99. char name[1024];
  100. struct snd_ctl_hw_info info;
  101. max_cards = snd_cards();
  102. if(max_cards < 0)
  103. return;
  104. VECTOR_RESIZE(*devmap, 0, max_cards+1);
  105. entry.name = strdup(qsaDevice);
  106. entry.card = 0;
  107. entry.dev = 0;
  108. VECTOR_PUSH_BACK(*devmap, entry);
  109. for(card = 0;card < max_cards;card++)
  110. {
  111. if((err=snd_ctl_open(&handle, card)) < 0)
  112. continue;
  113. if((err=snd_ctl_hw_info(handle, &info)) < 0)
  114. {
  115. snd_ctl_close(handle);
  116. continue;
  117. }
  118. for(dev = 0;dev < (int)info.pcmdevs;dev++)
  119. {
  120. if((err=snd_ctl_pcm_info(handle, dev, &pcminfo)) < 0)
  121. continue;
  122. if((type==SND_PCM_CHANNEL_PLAYBACK && (pcminfo.flags&SND_PCM_INFO_PLAYBACK)) ||
  123. (type==SND_PCM_CHANNEL_CAPTURE && (pcminfo.flags&SND_PCM_INFO_CAPTURE)))
  124. {
  125. snprintf(name, sizeof(name), "%s [%s] (hw:%d,%d)", info.name, pcminfo.name, card, dev);
  126. entry.name = strdup(name);
  127. entry.card = card;
  128. entry.dev = dev;
  129. VECTOR_PUSH_BACK(*devmap, entry);
  130. TRACE("Got device \"%s\", card %d, dev %d\n", name, card, dev);
  131. }
  132. }
  133. snd_ctl_close(handle);
  134. }
  135. }
  136. /* Wrappers to use an old-style backend with the new interface. */
  137. typedef struct PlaybackWrapper {
  138. DERIVE_FROM_TYPE(ALCbackend);
  139. qsa_data *ExtraData;
  140. } PlaybackWrapper;
  141. static void PlaybackWrapper_Construct(PlaybackWrapper *self, ALCdevice *device);
  142. static void PlaybackWrapper_Destruct(PlaybackWrapper *self);
  143. static ALCenum PlaybackWrapper_open(PlaybackWrapper *self, const ALCchar *name);
  144. static ALCboolean PlaybackWrapper_reset(PlaybackWrapper *self);
  145. static ALCboolean PlaybackWrapper_start(PlaybackWrapper *self);
  146. static void PlaybackWrapper_stop(PlaybackWrapper *self);
  147. static DECLARE_FORWARD2(PlaybackWrapper, ALCbackend, ALCenum, captureSamples, void*, ALCuint)
  148. static DECLARE_FORWARD(PlaybackWrapper, ALCbackend, ALCuint, availableSamples)
  149. static DECLARE_FORWARD(PlaybackWrapper, ALCbackend, ClockLatency, getClockLatency)
  150. static DECLARE_FORWARD(PlaybackWrapper, ALCbackend, void, lock)
  151. static DECLARE_FORWARD(PlaybackWrapper, ALCbackend, void, unlock)
  152. DECLARE_DEFAULT_ALLOCATORS(PlaybackWrapper)
  153. DEFINE_ALCBACKEND_VTABLE(PlaybackWrapper);
  154. FORCE_ALIGN static int qsa_proc_playback(void *ptr)
  155. {
  156. PlaybackWrapper *self = ptr;
  157. ALCdevice *device = STATIC_CAST(ALCbackend,self)->mDevice;
  158. qsa_data *data = self->ExtraData;
  159. snd_pcm_channel_status_t status;
  160. struct sched_param param;
  161. struct timeval timeout;
  162. char* write_ptr;
  163. fd_set wfds;
  164. ALint len;
  165. int sret;
  166. SetRTPriority();
  167. althrd_setname(althrd_current(), MIXER_THREAD_NAME);
  168. /* Increase default 10 priority to 11 to avoid jerky sound */
  169. SchedGet(0, 0, &param);
  170. param.sched_priority=param.sched_curpriority+1;
  171. SchedSet(0, 0, SCHED_NOCHANGE, &param);
  172. const ALint frame_size = FrameSizeFromDevFmt(
  173. device->FmtChans, device->FmtType, device->AmbiOrder
  174. );
  175. V0(device->Backend,lock)();
  176. while(!ATOMIC_LOAD(&data->killNow, almemory_order_acquire))
  177. {
  178. FD_ZERO(&wfds);
  179. FD_SET(data->audio_fd, &wfds);
  180. timeout.tv_sec=2;
  181. timeout.tv_usec=0;
  182. /* Select also works like time slice to OS */
  183. V0(device->Backend,unlock)();
  184. sret = select(data->audio_fd+1, NULL, &wfds, NULL, &timeout);
  185. V0(device->Backend,lock)();
  186. if(sret == -1)
  187. {
  188. ERR("select error: %s\n", strerror(errno));
  189. aluHandleDisconnect(device, "Failed waiting for playback buffer: %s", strerror(errno));
  190. break;
  191. }
  192. if(sret == 0)
  193. {
  194. ERR("select timeout\n");
  195. continue;
  196. }
  197. len = data->size;
  198. write_ptr = data->buffer;
  199. aluMixData(device, write_ptr, len/frame_size);
  200. while(len>0 && !ATOMIC_LOAD(&data->killNow, almemory_order_acquire))
  201. {
  202. int wrote = snd_pcm_plugin_write(data->pcmHandle, write_ptr, len);
  203. if(wrote <= 0)
  204. {
  205. if(errno==EAGAIN || errno==EWOULDBLOCK)
  206. continue;
  207. memset(&status, 0, sizeof(status));
  208. status.channel = SND_PCM_CHANNEL_PLAYBACK;
  209. snd_pcm_plugin_status(data->pcmHandle, &status);
  210. /* we need to reinitialize the sound channel if we've underrun the buffer */
  211. if(status.status == SND_PCM_STATUS_UNDERRUN ||
  212. status.status == SND_PCM_STATUS_READY)
  213. {
  214. if(snd_pcm_plugin_prepare(data->pcmHandle, SND_PCM_CHANNEL_PLAYBACK) < 0)
  215. {
  216. aluHandleDisconnect(device, "Playback recovery failed");
  217. break;
  218. }
  219. }
  220. }
  221. else
  222. {
  223. write_ptr += wrote;
  224. len -= wrote;
  225. }
  226. }
  227. }
  228. V0(device->Backend,unlock)();
  229. return 0;
  230. }
  231. /************/
  232. /* Playback */
  233. /************/
  234. static ALCenum qsa_open_playback(PlaybackWrapper *self, const ALCchar* deviceName)
  235. {
  236. ALCdevice *device = STATIC_CAST(ALCbackend,self)->mDevice;
  237. qsa_data *data;
  238. int card, dev;
  239. int status;
  240. data = (qsa_data*)calloc(1, sizeof(qsa_data));
  241. if(data == NULL)
  242. return ALC_OUT_OF_MEMORY;
  243. ATOMIC_INIT(&data->killNow, AL_TRUE);
  244. if(!deviceName)
  245. deviceName = qsaDevice;
  246. if(strcmp(deviceName, qsaDevice) == 0)
  247. status = snd_pcm_open_preferred(&data->pcmHandle, &card, &dev, SND_PCM_OPEN_PLAYBACK);
  248. else
  249. {
  250. const DevMap *iter;
  251. if(VECTOR_SIZE(DeviceNameMap) == 0)
  252. deviceList(SND_PCM_CHANNEL_PLAYBACK, &DeviceNameMap);
  253. #define MATCH_DEVNAME(iter) ((iter)->name && strcmp(deviceName, (iter)->name)==0)
  254. VECTOR_FIND_IF(iter, const DevMap, DeviceNameMap, MATCH_DEVNAME);
  255. #undef MATCH_DEVNAME
  256. if(iter == VECTOR_END(DeviceNameMap))
  257. {
  258. free(data);
  259. return ALC_INVALID_DEVICE;
  260. }
  261. status = snd_pcm_open(&data->pcmHandle, iter->card, iter->dev, SND_PCM_OPEN_PLAYBACK);
  262. }
  263. if(status < 0)
  264. {
  265. free(data);
  266. return ALC_INVALID_DEVICE;
  267. }
  268. data->audio_fd = snd_pcm_file_descriptor(data->pcmHandle, SND_PCM_CHANNEL_PLAYBACK);
  269. if(data->audio_fd < 0)
  270. {
  271. snd_pcm_close(data->pcmHandle);
  272. free(data);
  273. return ALC_INVALID_DEVICE;
  274. }
  275. alstr_copy_cstr(&device->DeviceName, deviceName);
  276. self->ExtraData = data;
  277. return ALC_NO_ERROR;
  278. }
  279. static void qsa_close_playback(PlaybackWrapper *self)
  280. {
  281. qsa_data *data = self->ExtraData;
  282. if (data->buffer!=NULL)
  283. {
  284. free(data->buffer);
  285. data->buffer=NULL;
  286. }
  287. snd_pcm_close(data->pcmHandle);
  288. free(data);
  289. self->ExtraData = NULL;
  290. }
  291. static ALCboolean qsa_reset_playback(PlaybackWrapper *self)
  292. {
  293. ALCdevice *device = STATIC_CAST(ALCbackend,self)->mDevice;
  294. qsa_data *data = self->ExtraData;
  295. int32_t format=-1;
  296. switch(device->FmtType)
  297. {
  298. case DevFmtByte:
  299. format=SND_PCM_SFMT_S8;
  300. break;
  301. case DevFmtUByte:
  302. format=SND_PCM_SFMT_U8;
  303. break;
  304. case DevFmtShort:
  305. format=SND_PCM_SFMT_S16_LE;
  306. break;
  307. case DevFmtUShort:
  308. format=SND_PCM_SFMT_U16_LE;
  309. break;
  310. case DevFmtInt:
  311. format=SND_PCM_SFMT_S32_LE;
  312. break;
  313. case DevFmtUInt:
  314. format=SND_PCM_SFMT_U32_LE;
  315. break;
  316. case DevFmtFloat:
  317. format=SND_PCM_SFMT_FLOAT_LE;
  318. break;
  319. }
  320. /* we actually don't want to block on writes */
  321. snd_pcm_nonblock_mode(data->pcmHandle, 1);
  322. /* Disable mmap to control data transfer to the audio device */
  323. snd_pcm_plugin_set_disable(data->pcmHandle, PLUGIN_DISABLE_MMAP);
  324. snd_pcm_plugin_set_disable(data->pcmHandle, PLUGIN_DISABLE_BUFFER_PARTIAL_BLOCKS);
  325. // configure a sound channel
  326. memset(&data->cparams, 0, sizeof(data->cparams));
  327. data->cparams.channel=SND_PCM_CHANNEL_PLAYBACK;
  328. data->cparams.mode=SND_PCM_MODE_BLOCK;
  329. data->cparams.start_mode=SND_PCM_START_FULL;
  330. data->cparams.stop_mode=SND_PCM_STOP_STOP;
  331. data->cparams.buf.block.frag_size=device->UpdateSize *
  332. FrameSizeFromDevFmt(device->FmtChans, device->FmtType, device->AmbiOrder);
  333. data->cparams.buf.block.frags_max=device->NumUpdates;
  334. data->cparams.buf.block.frags_min=device->NumUpdates;
  335. data->cparams.format.interleave=1;
  336. data->cparams.format.rate=device->Frequency;
  337. data->cparams.format.voices=ChannelsFromDevFmt(device->FmtChans, device->AmbiOrder);
  338. data->cparams.format.format=format;
  339. if ((snd_pcm_plugin_params(data->pcmHandle, &data->cparams))<0)
  340. {
  341. int original_rate=data->cparams.format.rate;
  342. int original_voices=data->cparams.format.voices;
  343. int original_format=data->cparams.format.format;
  344. int it;
  345. int jt;
  346. for (it=0; it<1; it++)
  347. {
  348. /* Check for second pass */
  349. if (it==1)
  350. {
  351. original_rate=ratelist[0].rate;
  352. original_voices=channellist[0].channels;
  353. original_format=formatlist[0].format;
  354. }
  355. do {
  356. /* At first downgrade sample format */
  357. jt=0;
  358. do {
  359. if (formatlist[jt].format==data->cparams.format.format)
  360. {
  361. data->cparams.format.format=formatlist[jt+1].format;
  362. break;
  363. }
  364. if (formatlist[jt].format==0)
  365. {
  366. data->cparams.format.format=0;
  367. break;
  368. }
  369. jt++;
  370. } while(1);
  371. if (data->cparams.format.format==0)
  372. {
  373. data->cparams.format.format=original_format;
  374. /* At secod downgrade sample rate */
  375. jt=0;
  376. do {
  377. if (ratelist[jt].rate==data->cparams.format.rate)
  378. {
  379. data->cparams.format.rate=ratelist[jt+1].rate;
  380. break;
  381. }
  382. if (ratelist[jt].rate==0)
  383. {
  384. data->cparams.format.rate=0;
  385. break;
  386. }
  387. jt++;
  388. } while(1);
  389. if (data->cparams.format.rate==0)
  390. {
  391. data->cparams.format.rate=original_rate;
  392. data->cparams.format.format=original_format;
  393. /* At third downgrade channels number */
  394. jt=0;
  395. do {
  396. if(channellist[jt].channels==data->cparams.format.voices)
  397. {
  398. data->cparams.format.voices=channellist[jt+1].channels;
  399. break;
  400. }
  401. if (channellist[jt].channels==0)
  402. {
  403. data->cparams.format.voices=0;
  404. break;
  405. }
  406. jt++;
  407. } while(1);
  408. }
  409. if (data->cparams.format.voices==0)
  410. {
  411. break;
  412. }
  413. }
  414. data->cparams.buf.block.frag_size=device->UpdateSize*
  415. data->cparams.format.voices*
  416. snd_pcm_format_width(data->cparams.format.format)/8;
  417. data->cparams.buf.block.frags_max=device->NumUpdates;
  418. data->cparams.buf.block.frags_min=device->NumUpdates;
  419. if ((snd_pcm_plugin_params(data->pcmHandle, &data->cparams))<0)
  420. {
  421. continue;
  422. }
  423. else
  424. {
  425. break;
  426. }
  427. } while(1);
  428. if (data->cparams.format.voices!=0)
  429. {
  430. break;
  431. }
  432. }
  433. if (data->cparams.format.voices==0)
  434. {
  435. return ALC_FALSE;
  436. }
  437. }
  438. if ((snd_pcm_plugin_prepare(data->pcmHandle, SND_PCM_CHANNEL_PLAYBACK))<0)
  439. {
  440. return ALC_FALSE;
  441. }
  442. memset(&data->csetup, 0, sizeof(data->csetup));
  443. data->csetup.channel=SND_PCM_CHANNEL_PLAYBACK;
  444. if (snd_pcm_plugin_setup(data->pcmHandle, &data->csetup)<0)
  445. {
  446. return ALC_FALSE;
  447. }
  448. /* now fill back to the our AL device */
  449. device->Frequency=data->cparams.format.rate;
  450. switch (data->cparams.format.voices)
  451. {
  452. case 1:
  453. device->FmtChans=DevFmtMono;
  454. break;
  455. case 2:
  456. device->FmtChans=DevFmtStereo;
  457. break;
  458. case 4:
  459. device->FmtChans=DevFmtQuad;
  460. break;
  461. case 6:
  462. device->FmtChans=DevFmtX51;
  463. break;
  464. case 7:
  465. device->FmtChans=DevFmtX61;
  466. break;
  467. case 8:
  468. device->FmtChans=DevFmtX71;
  469. break;
  470. default:
  471. device->FmtChans=DevFmtMono;
  472. break;
  473. }
  474. switch (data->cparams.format.format)
  475. {
  476. case SND_PCM_SFMT_S8:
  477. device->FmtType=DevFmtByte;
  478. break;
  479. case SND_PCM_SFMT_U8:
  480. device->FmtType=DevFmtUByte;
  481. break;
  482. case SND_PCM_SFMT_S16_LE:
  483. device->FmtType=DevFmtShort;
  484. break;
  485. case SND_PCM_SFMT_U16_LE:
  486. device->FmtType=DevFmtUShort;
  487. break;
  488. case SND_PCM_SFMT_S32_LE:
  489. device->FmtType=DevFmtInt;
  490. break;
  491. case SND_PCM_SFMT_U32_LE:
  492. device->FmtType=DevFmtUInt;
  493. break;
  494. case SND_PCM_SFMT_FLOAT_LE:
  495. device->FmtType=DevFmtFloat;
  496. break;
  497. default:
  498. device->FmtType=DevFmtShort;
  499. break;
  500. }
  501. SetDefaultChannelOrder(device);
  502. device->UpdateSize=data->csetup.buf.block.frag_size/
  503. FrameSizeFromDevFmt(device->FmtChans, device->FmtType, device->AmbiOrder);
  504. device->NumUpdates=data->csetup.buf.block.frags;
  505. data->size=data->csetup.buf.block.frag_size;
  506. data->buffer=malloc(data->size);
  507. if (!data->buffer)
  508. {
  509. return ALC_FALSE;
  510. }
  511. return ALC_TRUE;
  512. }
  513. static ALCboolean qsa_start_playback(PlaybackWrapper *self)
  514. {
  515. qsa_data *data = self->ExtraData;
  516. ATOMIC_STORE(&data->killNow, AL_FALSE, almemory_order_release);
  517. if(althrd_create(&data->thread, qsa_proc_playback, self) != althrd_success)
  518. return ALC_FALSE;
  519. return ALC_TRUE;
  520. }
  521. static void qsa_stop_playback(PlaybackWrapper *self)
  522. {
  523. qsa_data *data = self->ExtraData;
  524. int res;
  525. if(ATOMIC_EXCHANGE(&data->killNow, AL_TRUE, almemory_order_acq_rel))
  526. return;
  527. althrd_join(data->thread, &res);
  528. }
  529. static void PlaybackWrapper_Construct(PlaybackWrapper *self, ALCdevice *device)
  530. {
  531. ALCbackend_Construct(STATIC_CAST(ALCbackend, self), device);
  532. SET_VTABLE2(PlaybackWrapper, ALCbackend, self);
  533. self->ExtraData = NULL;
  534. }
  535. static void PlaybackWrapper_Destruct(PlaybackWrapper *self)
  536. {
  537. if(self->ExtraData)
  538. qsa_close_playback(self);
  539. ALCbackend_Destruct(STATIC_CAST(ALCbackend, self));
  540. }
  541. static ALCenum PlaybackWrapper_open(PlaybackWrapper *self, const ALCchar *name)
  542. {
  543. return qsa_open_playback(self, name);
  544. }
  545. static ALCboolean PlaybackWrapper_reset(PlaybackWrapper *self)
  546. {
  547. return qsa_reset_playback(self);
  548. }
  549. static ALCboolean PlaybackWrapper_start(PlaybackWrapper *self)
  550. {
  551. return qsa_start_playback(self);
  552. }
  553. static void PlaybackWrapper_stop(PlaybackWrapper *self)
  554. {
  555. qsa_stop_playback(self);
  556. }
  557. /***********/
  558. /* Capture */
  559. /***********/
  560. typedef struct CaptureWrapper {
  561. DERIVE_FROM_TYPE(ALCbackend);
  562. qsa_data *ExtraData;
  563. } CaptureWrapper;
  564. static void CaptureWrapper_Construct(CaptureWrapper *self, ALCdevice *device);
  565. static void CaptureWrapper_Destruct(CaptureWrapper *self);
  566. static ALCenum CaptureWrapper_open(CaptureWrapper *self, const ALCchar *name);
  567. static DECLARE_FORWARD(CaptureWrapper, ALCbackend, ALCboolean, reset)
  568. static ALCboolean CaptureWrapper_start(CaptureWrapper *self);
  569. static void CaptureWrapper_stop(CaptureWrapper *self);
  570. static ALCenum CaptureWrapper_captureSamples(CaptureWrapper *self, void *buffer, ALCuint samples);
  571. static ALCuint CaptureWrapper_availableSamples(CaptureWrapper *self);
  572. static DECLARE_FORWARD(CaptureWrapper, ALCbackend, ClockLatency, getClockLatency)
  573. static DECLARE_FORWARD(CaptureWrapper, ALCbackend, void, lock)
  574. static DECLARE_FORWARD(CaptureWrapper, ALCbackend, void, unlock)
  575. DECLARE_DEFAULT_ALLOCATORS(CaptureWrapper)
  576. DEFINE_ALCBACKEND_VTABLE(CaptureWrapper);
  577. static ALCenum qsa_open_capture(CaptureWrapper *self, const ALCchar *deviceName)
  578. {
  579. ALCdevice *device = STATIC_CAST(ALCbackend,self)->mDevice;
  580. qsa_data *data;
  581. int card, dev;
  582. int format=-1;
  583. int status;
  584. data=(qsa_data*)calloc(1, sizeof(qsa_data));
  585. if (data==NULL)
  586. {
  587. return ALC_OUT_OF_MEMORY;
  588. }
  589. if(!deviceName)
  590. deviceName = qsaDevice;
  591. if(strcmp(deviceName, qsaDevice) == 0)
  592. status = snd_pcm_open_preferred(&data->pcmHandle, &card, &dev, SND_PCM_OPEN_CAPTURE);
  593. else
  594. {
  595. const DevMap *iter;
  596. if(VECTOR_SIZE(CaptureNameMap) == 0)
  597. deviceList(SND_PCM_CHANNEL_CAPTURE, &CaptureNameMap);
  598. #define MATCH_DEVNAME(iter) ((iter)->name && strcmp(deviceName, (iter)->name)==0)
  599. VECTOR_FIND_IF(iter, const DevMap, CaptureNameMap, MATCH_DEVNAME);
  600. #undef MATCH_DEVNAME
  601. if(iter == VECTOR_END(CaptureNameMap))
  602. {
  603. free(data);
  604. return ALC_INVALID_DEVICE;
  605. }
  606. status = snd_pcm_open(&data->pcmHandle, iter->card, iter->dev, SND_PCM_OPEN_CAPTURE);
  607. }
  608. if(status < 0)
  609. {
  610. free(data);
  611. return ALC_INVALID_DEVICE;
  612. }
  613. data->audio_fd = snd_pcm_file_descriptor(data->pcmHandle, SND_PCM_CHANNEL_CAPTURE);
  614. if(data->audio_fd < 0)
  615. {
  616. snd_pcm_close(data->pcmHandle);
  617. free(data);
  618. return ALC_INVALID_DEVICE;
  619. }
  620. alstr_copy_cstr(&device->DeviceName, deviceName);
  621. self->ExtraData = data;
  622. switch (device->FmtType)
  623. {
  624. case DevFmtByte:
  625. format=SND_PCM_SFMT_S8;
  626. break;
  627. case DevFmtUByte:
  628. format=SND_PCM_SFMT_U8;
  629. break;
  630. case DevFmtShort:
  631. format=SND_PCM_SFMT_S16_LE;
  632. break;
  633. case DevFmtUShort:
  634. format=SND_PCM_SFMT_U16_LE;
  635. break;
  636. case DevFmtInt:
  637. format=SND_PCM_SFMT_S32_LE;
  638. break;
  639. case DevFmtUInt:
  640. format=SND_PCM_SFMT_U32_LE;
  641. break;
  642. case DevFmtFloat:
  643. format=SND_PCM_SFMT_FLOAT_LE;
  644. break;
  645. }
  646. /* we actually don't want to block on reads */
  647. snd_pcm_nonblock_mode(data->pcmHandle, 1);
  648. /* Disable mmap to control data transfer to the audio device */
  649. snd_pcm_plugin_set_disable(data->pcmHandle, PLUGIN_DISABLE_MMAP);
  650. /* configure a sound channel */
  651. memset(&data->cparams, 0, sizeof(data->cparams));
  652. data->cparams.mode=SND_PCM_MODE_BLOCK;
  653. data->cparams.channel=SND_PCM_CHANNEL_CAPTURE;
  654. data->cparams.start_mode=SND_PCM_START_GO;
  655. data->cparams.stop_mode=SND_PCM_STOP_STOP;
  656. data->cparams.buf.block.frag_size=device->UpdateSize*
  657. FrameSizeFromDevFmt(device->FmtChans, device->FmtType, device->AmbiOrder);
  658. data->cparams.buf.block.frags_max=device->NumUpdates;
  659. data->cparams.buf.block.frags_min=device->NumUpdates;
  660. data->cparams.format.interleave=1;
  661. data->cparams.format.rate=device->Frequency;
  662. data->cparams.format.voices=ChannelsFromDevFmt(device->FmtChans, device->AmbiOrder);
  663. data->cparams.format.format=format;
  664. if(snd_pcm_plugin_params(data->pcmHandle, &data->cparams) < 0)
  665. {
  666. snd_pcm_close(data->pcmHandle);
  667. free(data);
  668. return ALC_INVALID_VALUE;
  669. }
  670. return ALC_NO_ERROR;
  671. }
  672. static void qsa_close_capture(CaptureWrapper *self)
  673. {
  674. qsa_data *data = self->ExtraData;
  675. if (data->pcmHandle!=NULL)
  676. snd_pcm_close(data->pcmHandle);
  677. free(data);
  678. self->ExtraData = NULL;
  679. }
  680. static void qsa_start_capture(CaptureWrapper *self)
  681. {
  682. qsa_data *data = self->ExtraData;
  683. int rstatus;
  684. if ((rstatus=snd_pcm_plugin_prepare(data->pcmHandle, SND_PCM_CHANNEL_CAPTURE))<0)
  685. {
  686. ERR("capture prepare failed: %s\n", snd_strerror(rstatus));
  687. return;
  688. }
  689. memset(&data->csetup, 0, sizeof(data->csetup));
  690. data->csetup.channel=SND_PCM_CHANNEL_CAPTURE;
  691. if ((rstatus=snd_pcm_plugin_setup(data->pcmHandle, &data->csetup))<0)
  692. {
  693. ERR("capture setup failed: %s\n", snd_strerror(rstatus));
  694. return;
  695. }
  696. snd_pcm_capture_go(data->pcmHandle);
  697. }
  698. static void qsa_stop_capture(CaptureWrapper *self)
  699. {
  700. qsa_data *data = self->ExtraData;
  701. snd_pcm_capture_flush(data->pcmHandle);
  702. }
  703. static ALCuint qsa_available_samples(CaptureWrapper *self)
  704. {
  705. ALCdevice *device = STATIC_CAST(ALCbackend,self)->mDevice;
  706. qsa_data *data = self->ExtraData;
  707. snd_pcm_channel_status_t status;
  708. ALint frame_size = FrameSizeFromDevFmt(device->FmtChans, device->FmtType, device->AmbiOrder);
  709. ALint free_size;
  710. int rstatus;
  711. memset(&status, 0, sizeof (status));
  712. status.channel=SND_PCM_CHANNEL_CAPTURE;
  713. snd_pcm_plugin_status(data->pcmHandle, &status);
  714. if ((status.status==SND_PCM_STATUS_OVERRUN) ||
  715. (status.status==SND_PCM_STATUS_READY))
  716. {
  717. if ((rstatus=snd_pcm_plugin_prepare(data->pcmHandle, SND_PCM_CHANNEL_CAPTURE))<0)
  718. {
  719. ERR("capture prepare failed: %s\n", snd_strerror(rstatus));
  720. aluHandleDisconnect(device, "Failed capture recovery: %s", snd_strerror(rstatus));
  721. return 0;
  722. }
  723. snd_pcm_capture_go(data->pcmHandle);
  724. return 0;
  725. }
  726. free_size=data->csetup.buf.block.frag_size*data->csetup.buf.block.frags;
  727. free_size-=status.free;
  728. return free_size/frame_size;
  729. }
  730. static ALCenum qsa_capture_samples(CaptureWrapper *self, ALCvoid *buffer, ALCuint samples)
  731. {
  732. ALCdevice *device = STATIC_CAST(ALCbackend,self)->mDevice;
  733. qsa_data *data = self->ExtraData;
  734. char* read_ptr;
  735. snd_pcm_channel_status_t status;
  736. fd_set rfds;
  737. int selectret;
  738. struct timeval timeout;
  739. int bytes_read;
  740. ALint frame_size=FrameSizeFromDevFmt(device->FmtChans, device->FmtType, device->AmbiOrder);
  741. ALint len=samples*frame_size;
  742. int rstatus;
  743. read_ptr=buffer;
  744. while (len>0)
  745. {
  746. FD_ZERO(&rfds);
  747. FD_SET(data->audio_fd, &rfds);
  748. timeout.tv_sec=2;
  749. timeout.tv_usec=0;
  750. /* Select also works like time slice to OS */
  751. bytes_read=0;
  752. selectret=select(data->audio_fd+1, &rfds, NULL, NULL, &timeout);
  753. switch (selectret)
  754. {
  755. case -1:
  756. aluHandleDisconnect(device, "Failed to check capture samples");
  757. return ALC_INVALID_DEVICE;
  758. case 0:
  759. break;
  760. default:
  761. if (FD_ISSET(data->audio_fd, &rfds))
  762. {
  763. bytes_read=snd_pcm_plugin_read(data->pcmHandle, read_ptr, len);
  764. break;
  765. }
  766. break;
  767. }
  768. if (bytes_read<=0)
  769. {
  770. if ((errno==EAGAIN) || (errno==EWOULDBLOCK))
  771. {
  772. continue;
  773. }
  774. memset(&status, 0, sizeof (status));
  775. status.channel=SND_PCM_CHANNEL_CAPTURE;
  776. snd_pcm_plugin_status(data->pcmHandle, &status);
  777. /* we need to reinitialize the sound channel if we've overrun the buffer */
  778. if ((status.status==SND_PCM_STATUS_OVERRUN) ||
  779. (status.status==SND_PCM_STATUS_READY))
  780. {
  781. if ((rstatus=snd_pcm_plugin_prepare(data->pcmHandle, SND_PCM_CHANNEL_CAPTURE))<0)
  782. {
  783. ERR("capture prepare failed: %s\n", snd_strerror(rstatus));
  784. aluHandleDisconnect(device, "Failed capture recovery: %s",
  785. snd_strerror(rstatus));
  786. return ALC_INVALID_DEVICE;
  787. }
  788. snd_pcm_capture_go(data->pcmHandle);
  789. }
  790. }
  791. else
  792. {
  793. read_ptr+=bytes_read;
  794. len-=bytes_read;
  795. }
  796. }
  797. return ALC_NO_ERROR;
  798. }
  799. static void CaptureWrapper_Construct(CaptureWrapper *self, ALCdevice *device)
  800. {
  801. ALCbackend_Construct(STATIC_CAST(ALCbackend, self), device);
  802. SET_VTABLE2(CaptureWrapper, ALCbackend, self);
  803. self->ExtraData = NULL;
  804. }
  805. static void CaptureWrapper_Destruct(CaptureWrapper *self)
  806. {
  807. if(self->ExtraData)
  808. qsa_close_capture(self);
  809. ALCbackend_Destruct(STATIC_CAST(ALCbackend, self));
  810. }
  811. static ALCenum CaptureWrapper_open(CaptureWrapper *self, const ALCchar *name)
  812. {
  813. return qsa_open_capture(self, name);
  814. }
  815. static ALCboolean CaptureWrapper_start(CaptureWrapper *self)
  816. {
  817. qsa_start_capture(self);
  818. return ALC_TRUE;
  819. }
  820. static void CaptureWrapper_stop(CaptureWrapper *self)
  821. {
  822. qsa_stop_capture(self);
  823. }
  824. static ALCenum CaptureWrapper_captureSamples(CaptureWrapper *self, void *buffer, ALCuint samples)
  825. {
  826. return qsa_capture_samples(self, buffer, samples);
  827. }
  828. static ALCuint CaptureWrapper_availableSamples(CaptureWrapper *self)
  829. {
  830. return qsa_available_samples(self);
  831. }
  832. typedef struct ALCqsaBackendFactory {
  833. DERIVE_FROM_TYPE(ALCbackendFactory);
  834. } ALCqsaBackendFactory;
  835. #define ALCQSABACKENDFACTORY_INITIALIZER { { GET_VTABLE2(ALCqsaBackendFactory, ALCbackendFactory) } }
  836. static ALCboolean ALCqsaBackendFactory_init(ALCqsaBackendFactory* UNUSED(self));
  837. static void ALCqsaBackendFactory_deinit(ALCqsaBackendFactory* UNUSED(self));
  838. static ALCboolean ALCqsaBackendFactory_querySupport(ALCqsaBackendFactory* UNUSED(self), ALCbackend_Type type);
  839. static void ALCqsaBackendFactory_probe(ALCqsaBackendFactory* UNUSED(self), enum DevProbe type);
  840. static ALCbackend* ALCqsaBackendFactory_createBackend(ALCqsaBackendFactory* UNUSED(self), ALCdevice *device, ALCbackend_Type type);
  841. DEFINE_ALCBACKENDFACTORY_VTABLE(ALCqsaBackendFactory);
  842. static ALCboolean ALCqsaBackendFactory_init(ALCqsaBackendFactory* UNUSED(self))
  843. {
  844. return ALC_TRUE;
  845. }
  846. static void ALCqsaBackendFactory_deinit(ALCqsaBackendFactory* UNUSED(self))
  847. {
  848. #define FREE_NAME(iter) free((iter)->name)
  849. VECTOR_FOR_EACH(DevMap, DeviceNameMap, FREE_NAME);
  850. VECTOR_DEINIT(DeviceNameMap);
  851. VECTOR_FOR_EACH(DevMap, CaptureNameMap, FREE_NAME);
  852. VECTOR_DEINIT(CaptureNameMap);
  853. #undef FREE_NAME
  854. }
  855. static ALCboolean ALCqsaBackendFactory_querySupport(ALCqsaBackendFactory* UNUSED(self), ALCbackend_Type type)
  856. {
  857. if(type == ALCbackend_Playback || type == ALCbackend_Capture)
  858. return ALC_TRUE;
  859. return ALC_FALSE;
  860. }
  861. static void ALCqsaBackendFactory_probe(ALCqsaBackendFactory* UNUSED(self), enum DevProbe type)
  862. {
  863. switch (type)
  864. {
  865. case ALL_DEVICE_PROBE:
  866. #define FREE_NAME(iter) free((iter)->name)
  867. VECTOR_FOR_EACH(DevMap, DeviceNameMap, FREE_NAME);
  868. VECTOR_RESIZE(DeviceNameMap, 0, 0);
  869. #undef FREE_NAME
  870. deviceList(SND_PCM_CHANNEL_PLAYBACK, &DeviceNameMap);
  871. #define APPEND_DEVICE(iter) AppendAllDevicesList((iter)->name)
  872. VECTOR_FOR_EACH(const DevMap, DeviceNameMap, APPEND_DEVICE);
  873. #undef APPEND_DEVICE
  874. break;
  875. case CAPTURE_DEVICE_PROBE:
  876. #define FREE_NAME(iter) free((iter)->name)
  877. VECTOR_FOR_EACH(DevMap, CaptureNameMap, FREE_NAME);
  878. VECTOR_RESIZE(CaptureNameMap, 0, 0);
  879. #undef FREE_NAME
  880. deviceList(SND_PCM_CHANNEL_CAPTURE, &CaptureNameMap);
  881. #define APPEND_DEVICE(iter) AppendCaptureDeviceList((iter)->name)
  882. VECTOR_FOR_EACH(const DevMap, CaptureNameMap, APPEND_DEVICE);
  883. #undef APPEND_DEVICE
  884. break;
  885. }
  886. }
  887. static ALCbackend* ALCqsaBackendFactory_createBackend(ALCqsaBackendFactory* UNUSED(self), ALCdevice *device, ALCbackend_Type type)
  888. {
  889. if(type == ALCbackend_Playback)
  890. {
  891. PlaybackWrapper *backend;
  892. NEW_OBJ(backend, PlaybackWrapper)(device);
  893. if(!backend) return NULL;
  894. return STATIC_CAST(ALCbackend, backend);
  895. }
  896. if(type == ALCbackend_Capture)
  897. {
  898. CaptureWrapper *backend;
  899. NEW_OBJ(backend, CaptureWrapper)(device);
  900. if(!backend) return NULL;
  901. return STATIC_CAST(ALCbackend, backend);
  902. }
  903. return NULL;
  904. }
  905. ALCbackendFactory *ALCqsaBackendFactory_getFactory(void)
  906. {
  907. static ALCqsaBackendFactory factory = ALCQSABACKENDFACTORY_INITIALIZER;
  908. return STATIC_CAST(ALCbackendFactory, &factory);
  909. }