2
0

audio_driver_wasapi.cpp 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880
  1. /*************************************************************************/
  2. /* audio_driver_wasapi.cpp */
  3. /*************************************************************************/
  4. /* This file is part of: */
  5. /* GODOT ENGINE */
  6. /* https://godotengine.org */
  7. /*************************************************************************/
  8. /* Copyright (c) 2007-2019 Juan Linietsky, Ariel Manzur. */
  9. /* Copyright (c) 2014-2019 Godot Engine contributors (cf. AUTHORS.md) */
  10. /* */
  11. /* Permission is hereby granted, free of charge, to any person obtaining */
  12. /* a copy of this software and associated documentation files (the */
  13. /* "Software"), to deal in the Software without restriction, including */
  14. /* without limitation the rights to use, copy, modify, merge, publish, */
  15. /* distribute, sublicense, and/or sell copies of the Software, and to */
  16. /* permit persons to whom the Software is furnished to do so, subject to */
  17. /* the following conditions: */
  18. /* */
  19. /* The above copyright notice and this permission notice shall be */
  20. /* included in all copies or substantial portions of the Software. */
  21. /* */
  22. /* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, */
  23. /* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF */
  24. /* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.*/
  25. /* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY */
  26. /* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, */
  27. /* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE */
  28. /* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */
  29. /*************************************************************************/
  30. #ifdef WASAPI_ENABLED
  31. #include "audio_driver_wasapi.h"
  32. #include "core/os/os.h"
  33. #include "core/project_settings.h"
  34. #include <functiondiscoverykeys.h>
  35. #ifndef PKEY_Device_FriendlyName
  36. #undef DEFINE_PROPERTYKEY
  37. /* clang-format off */
  38. #define DEFINE_PROPERTYKEY(id, a, b, c, d, e, f, g, h, i, j, k, l) \
  39. const PROPERTYKEY id = { { a, b, c, { d, e, f, g, h, i, j, k, } }, l };
  40. /* clang-format on */
  41. DEFINE_PROPERTYKEY(PKEY_Device_FriendlyName, 0xa45c254e, 0xdf1c, 0x4efd, 0x80, 0x20, 0x67, 0xd1, 0x46, 0xa8, 0x50, 0xe0, 14);
  42. #endif
  43. const CLSID CLSID_MMDeviceEnumerator = __uuidof(MMDeviceEnumerator);
  44. const IID IID_IMMDeviceEnumerator = __uuidof(IMMDeviceEnumerator);
  45. const IID IID_IAudioClient = __uuidof(IAudioClient);
  46. const IID IID_IAudioRenderClient = __uuidof(IAudioRenderClient);
  47. const IID IID_IAudioCaptureClient = __uuidof(IAudioCaptureClient);
  48. #define SAFE_RELEASE(memory) \
  49. if ((memory) != NULL) { \
  50. (memory)->Release(); \
  51. (memory) = NULL; \
  52. }
  53. #define REFTIMES_PER_SEC 10000000
  54. #define REFTIMES_PER_MILLISEC 10000
  55. #define CAPTURE_BUFFER_CHANNELS 2
  56. static bool default_render_device_changed = false;
  57. static bool default_capture_device_changed = false;
  58. class CMMNotificationClient : public IMMNotificationClient {
  59. LONG _cRef;
  60. IMMDeviceEnumerator *_pEnumerator;
  61. public:
  62. CMMNotificationClient() :
  63. _cRef(1),
  64. _pEnumerator(NULL) {}
  65. ~CMMNotificationClient() {
  66. if ((_pEnumerator) != NULL) {
  67. (_pEnumerator)->Release();
  68. (_pEnumerator) = NULL;
  69. }
  70. }
  71. ULONG STDMETHODCALLTYPE AddRef() {
  72. return InterlockedIncrement(&_cRef);
  73. }
  74. ULONG STDMETHODCALLTYPE Release() {
  75. ULONG ulRef = InterlockedDecrement(&_cRef);
  76. if (0 == ulRef) {
  77. delete this;
  78. }
  79. return ulRef;
  80. }
  81. HRESULT STDMETHODCALLTYPE QueryInterface(REFIID riid, VOID **ppvInterface) {
  82. if (IID_IUnknown == riid) {
  83. AddRef();
  84. *ppvInterface = (IUnknown *)this;
  85. } else if (__uuidof(IMMNotificationClient) == riid) {
  86. AddRef();
  87. *ppvInterface = (IMMNotificationClient *)this;
  88. } else {
  89. *ppvInterface = NULL;
  90. return E_NOINTERFACE;
  91. }
  92. return S_OK;
  93. }
  94. HRESULT STDMETHODCALLTYPE OnDeviceAdded(LPCWSTR pwstrDeviceId) {
  95. return S_OK;
  96. };
  97. HRESULT STDMETHODCALLTYPE OnDeviceRemoved(LPCWSTR pwstrDeviceId) {
  98. return S_OK;
  99. }
  100. HRESULT STDMETHODCALLTYPE OnDeviceStateChanged(LPCWSTR pwstrDeviceId, DWORD dwNewState) {
  101. return S_OK;
  102. }
  103. HRESULT STDMETHODCALLTYPE OnDefaultDeviceChanged(EDataFlow flow, ERole role, LPCWSTR pwstrDeviceId) {
  104. if (role == eConsole) {
  105. if (flow == eRender) {
  106. default_render_device_changed = true;
  107. } else if (flow == eCapture) {
  108. default_capture_device_changed = true;
  109. }
  110. }
  111. return S_OK;
  112. }
  113. HRESULT STDMETHODCALLTYPE OnPropertyValueChanged(LPCWSTR pwstrDeviceId, const PROPERTYKEY key) {
  114. return S_OK;
  115. }
  116. };
  117. static CMMNotificationClient notif_client;
  118. Error AudioDriverWASAPI::audio_device_init(AudioDeviceWASAPI *p_device, bool p_capture, bool reinit) {
  119. WAVEFORMATEX *pwfex;
  120. IMMDeviceEnumerator *enumerator = NULL;
  121. IMMDevice *device = NULL;
  122. CoInitialize(NULL);
  123. HRESULT hr = CoCreateInstance(CLSID_MMDeviceEnumerator, NULL, CLSCTX_ALL, IID_IMMDeviceEnumerator, (void **)&enumerator);
  124. ERR_FAIL_COND_V(hr != S_OK, ERR_CANT_OPEN);
  125. if (p_device->device_name == "Default") {
  126. hr = enumerator->GetDefaultAudioEndpoint(p_capture ? eCapture : eRender, eConsole, &device);
  127. } else {
  128. IMMDeviceCollection *devices = NULL;
  129. hr = enumerator->EnumAudioEndpoints(p_capture ? eCapture : eRender, DEVICE_STATE_ACTIVE, &devices);
  130. ERR_FAIL_COND_V(hr != S_OK, ERR_CANT_OPEN);
  131. LPWSTR strId = NULL;
  132. bool found = false;
  133. UINT count = 0;
  134. hr = devices->GetCount(&count);
  135. ERR_FAIL_COND_V(hr != S_OK, ERR_CANT_OPEN);
  136. for (ULONG i = 0; i < count && !found; i++) {
  137. IMMDevice *tmp_device = NULL;
  138. hr = devices->Item(i, &tmp_device);
  139. ERR_BREAK(hr != S_OK);
  140. IPropertyStore *props = NULL;
  141. hr = tmp_device->OpenPropertyStore(STGM_READ, &props);
  142. ERR_BREAK(hr != S_OK);
  143. PROPVARIANT propvar;
  144. PropVariantInit(&propvar);
  145. hr = props->GetValue(PKEY_Device_FriendlyName, &propvar);
  146. ERR_BREAK(hr != S_OK);
  147. if (p_device->device_name == String(propvar.pwszVal)) {
  148. hr = tmp_device->GetId(&strId);
  149. ERR_BREAK(hr != S_OK);
  150. found = true;
  151. }
  152. PropVariantClear(&propvar);
  153. props->Release();
  154. tmp_device->Release();
  155. }
  156. if (found) {
  157. hr = enumerator->GetDevice(strId, &device);
  158. }
  159. if (strId) {
  160. CoTaskMemFree(strId);
  161. }
  162. if (device == NULL) {
  163. hr = enumerator->GetDefaultAudioEndpoint(p_capture ? eCapture : eRender, eConsole, &device);
  164. }
  165. }
  166. if (reinit) {
  167. // In case we're trying to re-initialize the device prevent throwing this error on the console,
  168. // otherwise if there is currently no device available this will spam the console.
  169. if (hr != S_OK) {
  170. return ERR_CANT_OPEN;
  171. }
  172. } else {
  173. ERR_FAIL_COND_V(hr != S_OK, ERR_CANT_OPEN);
  174. }
  175. hr = enumerator->RegisterEndpointNotificationCallback(&notif_client);
  176. SAFE_RELEASE(enumerator)
  177. if (hr != S_OK) {
  178. ERR_PRINT("WASAPI: RegisterEndpointNotificationCallback error");
  179. }
  180. hr = device->Activate(IID_IAudioClient, CLSCTX_ALL, NULL, (void **)&p_device->audio_client);
  181. SAFE_RELEASE(device)
  182. if (reinit) {
  183. if (hr != S_OK) {
  184. return ERR_CANT_OPEN;
  185. }
  186. } else {
  187. ERR_FAIL_COND_V(hr != S_OK, ERR_CANT_OPEN);
  188. }
  189. hr = p_device->audio_client->GetMixFormat(&pwfex);
  190. ERR_FAIL_COND_V(hr != S_OK, ERR_CANT_OPEN);
  191. print_verbose("WASAPI: wFormatTag = " + itos(pwfex->wFormatTag));
  192. print_verbose("WASAPI: nChannels = " + itos(pwfex->nChannels));
  193. print_verbose("WASAPI: nSamplesPerSec = " + itos(pwfex->nSamplesPerSec));
  194. print_verbose("WASAPI: nAvgBytesPerSec = " + itos(pwfex->nAvgBytesPerSec));
  195. print_verbose("WASAPI: nBlockAlign = " + itos(pwfex->nBlockAlign));
  196. print_verbose("WASAPI: wBitsPerSample = " + itos(pwfex->wBitsPerSample));
  197. print_verbose("WASAPI: cbSize = " + itos(pwfex->cbSize));
  198. WAVEFORMATEX *closest = NULL;
  199. hr = p_device->audio_client->IsFormatSupported(AUDCLNT_SHAREMODE_SHARED, pwfex, &closest);
  200. if (hr == S_FALSE) {
  201. WARN_PRINT("WASAPI: Mix format is not supported by the Device");
  202. if (closest) {
  203. print_verbose("WASAPI: closest->wFormatTag = " + itos(closest->wFormatTag));
  204. print_verbose("WASAPI: closest->nChannels = " + itos(closest->nChannels));
  205. print_verbose("WASAPI: closest->nSamplesPerSec = " + itos(closest->nSamplesPerSec));
  206. print_verbose("WASAPI: closest->nAvgBytesPerSec = " + itos(closest->nAvgBytesPerSec));
  207. print_verbose("WASAPI: closest->nBlockAlign = " + itos(closest->nBlockAlign));
  208. print_verbose("WASAPI: closest->wBitsPerSample = " + itos(closest->wBitsPerSample));
  209. print_verbose("WASAPI: closest->cbSize = " + itos(closest->cbSize));
  210. WARN_PRINT("WASAPI: Using closest match instead");
  211. pwfex = closest;
  212. }
  213. }
  214. // Since we're using WASAPI Shared Mode we can't control any of these, we just tag along
  215. p_device->channels = pwfex->nChannels;
  216. p_device->format_tag = pwfex->wFormatTag;
  217. p_device->bits_per_sample = pwfex->wBitsPerSample;
  218. p_device->frame_size = (p_device->bits_per_sample / 8) * p_device->channels;
  219. if (p_device->format_tag == WAVE_FORMAT_EXTENSIBLE) {
  220. WAVEFORMATEXTENSIBLE *wfex = (WAVEFORMATEXTENSIBLE *)pwfex;
  221. if (wfex->SubFormat == KSDATAFORMAT_SUBTYPE_PCM) {
  222. p_device->format_tag = WAVE_FORMAT_PCM;
  223. } else if (wfex->SubFormat == KSDATAFORMAT_SUBTYPE_IEEE_FLOAT) {
  224. p_device->format_tag = WAVE_FORMAT_IEEE_FLOAT;
  225. } else {
  226. ERR_PRINT("WASAPI: Format not supported");
  227. ERR_FAIL_V(ERR_CANT_OPEN);
  228. }
  229. } else {
  230. if (p_device->format_tag != WAVE_FORMAT_PCM && p_device->format_tag != WAVE_FORMAT_IEEE_FLOAT) {
  231. ERR_PRINT("WASAPI: Format not supported");
  232. ERR_FAIL_V(ERR_CANT_OPEN);
  233. }
  234. }
  235. DWORD streamflags = 0;
  236. if ((DWORD)mix_rate != pwfex->nSamplesPerSec) {
  237. streamflags |= AUDCLNT_STREAMFLAGS_RATEADJUST;
  238. pwfex->nSamplesPerSec = mix_rate;
  239. pwfex->nAvgBytesPerSec = pwfex->nSamplesPerSec * pwfex->nChannels * (pwfex->wBitsPerSample / 8);
  240. }
  241. hr = p_device->audio_client->Initialize(AUDCLNT_SHAREMODE_SHARED, streamflags, p_capture ? REFTIMES_PER_SEC : 0, 0, pwfex, NULL);
  242. ERR_EXPLAIN("WASAPI: Initialize failed with error 0x" + String::num_uint64(hr, 16));
  243. ERR_FAIL_COND_V(hr != S_OK, ERR_CANT_OPEN);
  244. if (p_capture) {
  245. hr = p_device->audio_client->GetService(IID_IAudioCaptureClient, (void **)&p_device->capture_client);
  246. } else {
  247. hr = p_device->audio_client->GetService(IID_IAudioRenderClient, (void **)&p_device->render_client);
  248. }
  249. ERR_FAIL_COND_V(hr != S_OK, ERR_CANT_OPEN);
  250. // Free memory
  251. CoTaskMemFree(pwfex);
  252. SAFE_RELEASE(device)
  253. return OK;
  254. }
  255. Error AudioDriverWASAPI::init_render_device(bool reinit) {
  256. Error err = audio_device_init(&audio_output, false, reinit);
  257. if (err != OK)
  258. return err;
  259. switch (audio_output.channels) {
  260. case 2: // Stereo
  261. case 4: // Surround 3.1
  262. case 6: // Surround 5.1
  263. case 8: // Surround 7.1
  264. channels = audio_output.channels;
  265. break;
  266. default:
  267. WARN_PRINTS("WASAPI: Unsupported number of channels: " + itos(audio_output.channels));
  268. channels = 2;
  269. break;
  270. }
  271. UINT32 max_frames;
  272. HRESULT hr = audio_output.audio_client->GetBufferSize(&max_frames);
  273. ERR_FAIL_COND_V(hr != S_OK, ERR_CANT_OPEN);
  274. // Due to WASAPI Shared Mode we have no control of the buffer size
  275. buffer_frames = max_frames;
  276. // Sample rate is independent of channels (ref: https://stackoverflow.com/questions/11048825/audio-sample-frequency-rely-on-channels)
  277. samples_in.resize(buffer_frames * channels);
  278. input_position = 0;
  279. input_size = 0;
  280. print_verbose("WASAPI: detected " + itos(channels) + " channels");
  281. print_verbose("WASAPI: audio buffer frames: " + itos(buffer_frames) + " calculated latency: " + itos(buffer_frames * 1000 / mix_rate) + "ms");
  282. return OK;
  283. }
  284. Error AudioDriverWASAPI::init_capture_device(bool reinit) {
  285. Error err = audio_device_init(&audio_input, true, reinit);
  286. if (err != OK)
  287. return err;
  288. // Get the max frames
  289. UINT32 max_frames;
  290. HRESULT hr = audio_input.audio_client->GetBufferSize(&max_frames);
  291. ERR_FAIL_COND_V(hr != S_OK, ERR_CANT_OPEN);
  292. input_buffer_init(max_frames);
  293. return OK;
  294. }
  295. Error AudioDriverWASAPI::audio_device_finish(AudioDeviceWASAPI *p_device) {
  296. if (p_device->active) {
  297. if (p_device->audio_client) {
  298. p_device->audio_client->Stop();
  299. }
  300. p_device->active = false;
  301. }
  302. SAFE_RELEASE(p_device->audio_client)
  303. SAFE_RELEASE(p_device->render_client)
  304. SAFE_RELEASE(p_device->capture_client)
  305. return OK;
  306. }
  307. Error AudioDriverWASAPI::finish_render_device() {
  308. return audio_device_finish(&audio_output);
  309. }
  310. Error AudioDriverWASAPI::finish_capture_device() {
  311. return audio_device_finish(&audio_input);
  312. }
  313. Error AudioDriverWASAPI::init() {
  314. mix_rate = GLOBAL_DEF_RST("audio/mix_rate", DEFAULT_MIX_RATE);
  315. Error err = init_render_device();
  316. if (err != OK) {
  317. ERR_PRINT("WASAPI: init_render_device error");
  318. }
  319. exit_thread = false;
  320. thread_exited = false;
  321. mutex = Mutex::create(true);
  322. thread = Thread::create(thread_func, this);
  323. return OK;
  324. }
  325. int AudioDriverWASAPI::get_mix_rate() const {
  326. return mix_rate;
  327. }
  328. AudioDriver::SpeakerMode AudioDriverWASAPI::get_speaker_mode() const {
  329. return get_speaker_mode_by_total_channels(channels);
  330. }
  331. Array AudioDriverWASAPI::audio_device_get_list(bool p_capture) {
  332. Array list;
  333. IMMDeviceCollection *devices = NULL;
  334. IMMDeviceEnumerator *enumerator = NULL;
  335. list.push_back(String("Default"));
  336. CoInitialize(NULL);
  337. HRESULT hr = CoCreateInstance(CLSID_MMDeviceEnumerator, NULL, CLSCTX_ALL, IID_IMMDeviceEnumerator, (void **)&enumerator);
  338. ERR_FAIL_COND_V(hr != S_OK, Array());
  339. hr = enumerator->EnumAudioEndpoints(p_capture ? eCapture : eRender, DEVICE_STATE_ACTIVE, &devices);
  340. ERR_FAIL_COND_V(hr != S_OK, Array());
  341. UINT count = 0;
  342. hr = devices->GetCount(&count);
  343. ERR_FAIL_COND_V(hr != S_OK, Array());
  344. for (ULONG i = 0; i < count; i++) {
  345. IMMDevice *device = NULL;
  346. hr = devices->Item(i, &device);
  347. ERR_BREAK(hr != S_OK);
  348. IPropertyStore *props = NULL;
  349. hr = device->OpenPropertyStore(STGM_READ, &props);
  350. ERR_BREAK(hr != S_OK);
  351. PROPVARIANT propvar;
  352. PropVariantInit(&propvar);
  353. hr = props->GetValue(PKEY_Device_FriendlyName, &propvar);
  354. ERR_BREAK(hr != S_OK);
  355. list.push_back(String(propvar.pwszVal));
  356. PropVariantClear(&propvar);
  357. props->Release();
  358. device->Release();
  359. }
  360. devices->Release();
  361. enumerator->Release();
  362. return list;
  363. }
  364. Array AudioDriverWASAPI::get_device_list() {
  365. return audio_device_get_list(false);
  366. }
  367. String AudioDriverWASAPI::get_device() {
  368. lock();
  369. String name = audio_output.device_name;
  370. unlock();
  371. return name;
  372. }
  373. void AudioDriverWASAPI::set_device(String device) {
  374. lock();
  375. audio_output.new_device = device;
  376. unlock();
  377. }
  378. int32_t AudioDriverWASAPI::read_sample(WORD format_tag, int bits_per_sample, BYTE *buffer, int i) {
  379. if (format_tag == WAVE_FORMAT_PCM) {
  380. int32_t sample = 0;
  381. switch (bits_per_sample) {
  382. case 8:
  383. sample = int32_t(((int8_t *)buffer)[i]) << 24;
  384. break;
  385. case 16:
  386. sample = int32_t(((int16_t *)buffer)[i]) << 16;
  387. break;
  388. case 24:
  389. sample |= int32_t(((int8_t *)buffer)[i * 3 + 2]) << 24;
  390. sample |= int32_t(((int8_t *)buffer)[i * 3 + 1]) << 16;
  391. sample |= int32_t(((int8_t *)buffer)[i * 3 + 0]) << 8;
  392. break;
  393. case 32:
  394. sample = ((int32_t *)buffer)[i];
  395. break;
  396. }
  397. return sample;
  398. } else if (format_tag == WAVE_FORMAT_IEEE_FLOAT) {
  399. return int32_t(((float *)buffer)[i] * 32768.0) << 16;
  400. } else {
  401. ERR_PRINT("WASAPI: Unknown format tag");
  402. }
  403. return 0;
  404. }
  405. void AudioDriverWASAPI::write_sample(WORD format_tag, int bits_per_sample, BYTE *buffer, int i, int32_t sample) {
  406. if (format_tag == WAVE_FORMAT_PCM) {
  407. switch (bits_per_sample) {
  408. case 8:
  409. ((int8_t *)buffer)[i] = sample >> 24;
  410. break;
  411. case 16:
  412. ((int16_t *)buffer)[i] = sample >> 16;
  413. break;
  414. case 24:
  415. ((int8_t *)buffer)[i * 3 + 2] = sample >> 24;
  416. ((int8_t *)buffer)[i * 3 + 1] = sample >> 16;
  417. ((int8_t *)buffer)[i * 3 + 0] = sample >> 8;
  418. break;
  419. case 32:
  420. ((int32_t *)buffer)[i] = sample;
  421. break;
  422. }
  423. } else if (format_tag == WAVE_FORMAT_IEEE_FLOAT) {
  424. ((float *)buffer)[i] = (sample >> 16) / 32768.f;
  425. } else {
  426. ERR_PRINT("WASAPI: Unknown format tag");
  427. }
  428. }
  429. void AudioDriverWASAPI::thread_func(void *p_udata) {
  430. AudioDriverWASAPI *ad = (AudioDriverWASAPI *)p_udata;
  431. uint32_t avail_frames = 0;
  432. uint32_t write_ofs = 0;
  433. while (!ad->exit_thread) {
  434. uint32_t read_frames = 0;
  435. uint32_t written_frames = 0;
  436. if (avail_frames == 0) {
  437. ad->lock();
  438. ad->start_counting_ticks();
  439. if (ad->audio_output.active) {
  440. ad->audio_server_process(ad->buffer_frames, ad->samples_in.ptrw());
  441. } else {
  442. for (int i = 0; i < ad->samples_in.size(); i++) {
  443. ad->samples_in.write[i] = 0;
  444. }
  445. }
  446. avail_frames = ad->buffer_frames;
  447. write_ofs = 0;
  448. ad->stop_counting_ticks();
  449. ad->unlock();
  450. }
  451. ad->lock();
  452. ad->start_counting_ticks();
  453. if (avail_frames > 0 && ad->audio_output.audio_client) {
  454. UINT32 cur_frames;
  455. bool invalidated = false;
  456. HRESULT hr = ad->audio_output.audio_client->GetCurrentPadding(&cur_frames);
  457. if (hr == S_OK) {
  458. // Check how much frames are available on the WASAPI buffer
  459. UINT32 write_frames = MIN(ad->buffer_frames - cur_frames, avail_frames);
  460. if (write_frames > 0) {
  461. BYTE *buffer = NULL;
  462. hr = ad->audio_output.render_client->GetBuffer(write_frames, &buffer);
  463. if (hr == S_OK) {
  464. // We're using WASAPI Shared Mode so we must convert the buffer
  465. if (ad->channels == ad->audio_output.channels) {
  466. for (unsigned int i = 0; i < write_frames * ad->channels; i++) {
  467. ad->write_sample(ad->audio_output.format_tag, ad->audio_output.bits_per_sample, buffer, i, ad->samples_in.write[write_ofs++]);
  468. }
  469. } else {
  470. for (unsigned int i = 0; i < write_frames; i++) {
  471. for (unsigned int j = 0; j < MIN(ad->channels, ad->audio_output.channels); j++) {
  472. ad->write_sample(ad->audio_output.format_tag, ad->audio_output.bits_per_sample, buffer, i * ad->audio_output.channels + j, ad->samples_in.write[write_ofs++]);
  473. }
  474. if (ad->audio_output.channels > ad->channels) {
  475. for (unsigned int j = ad->channels; j < ad->audio_output.channels; j++) {
  476. ad->write_sample(ad->audio_output.format_tag, ad->audio_output.bits_per_sample, buffer, i * ad->audio_output.channels + j, 0);
  477. }
  478. }
  479. }
  480. }
  481. hr = ad->audio_output.render_client->ReleaseBuffer(write_frames, 0);
  482. if (hr != S_OK) {
  483. ERR_PRINT("WASAPI: Release buffer error");
  484. }
  485. avail_frames -= write_frames;
  486. written_frames += write_frames;
  487. } else if (hr == AUDCLNT_E_DEVICE_INVALIDATED) {
  488. // Device is not valid anymore, reopen it
  489. Error err = ad->finish_render_device();
  490. if (err != OK) {
  491. ERR_PRINT("WASAPI: finish_render_device error");
  492. } else {
  493. // We reopened the device and samples_in may have resized, so invalidate the current avail_frames
  494. avail_frames = 0;
  495. }
  496. } else {
  497. ERR_PRINT("WASAPI: Get buffer error");
  498. ad->exit_thread = true;
  499. }
  500. }
  501. } else if (hr == AUDCLNT_E_DEVICE_INVALIDATED) {
  502. invalidated = true;
  503. } else {
  504. ERR_PRINT("WASAPI: GetCurrentPadding error");
  505. }
  506. if (invalidated) {
  507. // Device is not valid anymore
  508. WARN_PRINT("WASAPI: Current device invalidated, closing device");
  509. Error err = ad->finish_render_device();
  510. if (err != OK) {
  511. ERR_PRINT("WASAPI: finish_render_device error");
  512. }
  513. }
  514. }
  515. // If we're using the Default device and it changed finish it so we'll re-init the device
  516. if (ad->audio_output.device_name == "Default" && default_render_device_changed) {
  517. Error err = ad->finish_render_device();
  518. if (err != OK) {
  519. ERR_PRINT("WASAPI: finish_render_device error");
  520. }
  521. default_render_device_changed = false;
  522. }
  523. // User selected a new device, finish the current one so we'll init the new device
  524. if (ad->audio_output.device_name != ad->audio_output.new_device) {
  525. ad->audio_output.device_name = ad->audio_output.new_device;
  526. Error err = ad->finish_render_device();
  527. if (err != OK) {
  528. ERR_PRINT("WASAPI: finish_render_device error");
  529. }
  530. }
  531. if (!ad->audio_output.audio_client) {
  532. Error err = ad->init_render_device(true);
  533. if (err == OK) {
  534. ad->start();
  535. }
  536. avail_frames = 0;
  537. write_ofs = 0;
  538. }
  539. if (ad->audio_input.active) {
  540. UINT32 packet_length = 0;
  541. BYTE *data;
  542. UINT32 num_frames_available;
  543. DWORD flags;
  544. HRESULT hr = ad->audio_input.capture_client->GetNextPacketSize(&packet_length);
  545. if (hr == S_OK) {
  546. while (packet_length != 0) {
  547. hr = ad->audio_input.capture_client->GetBuffer(&data, &num_frames_available, &flags, NULL, NULL);
  548. ERR_BREAK(hr != S_OK);
  549. // fixme: Only works for floating point atm
  550. for (UINT32 j = 0; j < num_frames_available; j++) {
  551. int32_t l, r;
  552. if (flags & AUDCLNT_BUFFERFLAGS_SILENT) {
  553. l = r = 0;
  554. } else {
  555. if (ad->audio_input.channels == 2) {
  556. l = read_sample(ad->audio_input.format_tag, ad->audio_input.bits_per_sample, data, j * 2);
  557. r = read_sample(ad->audio_input.format_tag, ad->audio_input.bits_per_sample, data, j * 2 + 1);
  558. } else if (ad->audio_input.channels == 1) {
  559. l = r = read_sample(ad->audio_input.format_tag, ad->audio_input.bits_per_sample, data, j);
  560. } else {
  561. l = r = 0;
  562. ERR_PRINT("WASAPI: unsupported channel count in microphone!");
  563. }
  564. }
  565. ad->input_buffer_write(l);
  566. ad->input_buffer_write(r);
  567. }
  568. read_frames += num_frames_available;
  569. hr = ad->audio_input.capture_client->ReleaseBuffer(num_frames_available);
  570. ERR_BREAK(hr != S_OK);
  571. hr = ad->audio_input.capture_client->GetNextPacketSize(&packet_length);
  572. ERR_BREAK(hr != S_OK);
  573. }
  574. }
  575. // If we're using the Default device and it changed finish it so we'll re-init the device
  576. if (ad->audio_input.device_name == "Default" && default_capture_device_changed) {
  577. Error err = ad->finish_capture_device();
  578. if (err != OK) {
  579. ERR_PRINT("WASAPI: finish_capture_device error");
  580. }
  581. default_capture_device_changed = false;
  582. }
  583. // User selected a new device, finish the current one so we'll init the new device
  584. if (ad->audio_input.device_name != ad->audio_input.new_device) {
  585. ad->audio_input.device_name = ad->audio_input.new_device;
  586. Error err = ad->finish_capture_device();
  587. if (err != OK) {
  588. ERR_PRINT("WASAPI: finish_capture_device error");
  589. }
  590. }
  591. if (!ad->audio_input.audio_client) {
  592. Error err = ad->init_capture_device(true);
  593. if (err == OK) {
  594. ad->capture_start();
  595. }
  596. }
  597. }
  598. ad->stop_counting_ticks();
  599. ad->unlock();
  600. // Let the thread rest a while if we haven't read or write anything
  601. if (written_frames == 0 && read_frames == 0) {
  602. OS::get_singleton()->delay_usec(1000);
  603. }
  604. }
  605. ad->thread_exited = true;
  606. }
  607. void AudioDriverWASAPI::start() {
  608. if (audio_output.audio_client) {
  609. HRESULT hr = audio_output.audio_client->Start();
  610. if (hr != S_OK) {
  611. ERR_PRINT("WASAPI: Start failed");
  612. } else {
  613. audio_output.active = true;
  614. }
  615. }
  616. }
  617. void AudioDriverWASAPI::lock() {
  618. if (mutex)
  619. mutex->lock();
  620. }
  621. void AudioDriverWASAPI::unlock() {
  622. if (mutex)
  623. mutex->unlock();
  624. }
  625. void AudioDriverWASAPI::finish() {
  626. if (thread) {
  627. exit_thread = true;
  628. Thread::wait_to_finish(thread);
  629. memdelete(thread);
  630. thread = NULL;
  631. }
  632. finish_capture_device();
  633. finish_render_device();
  634. if (mutex) {
  635. memdelete(mutex);
  636. mutex = NULL;
  637. }
  638. }
  639. Error AudioDriverWASAPI::capture_start() {
  640. Error err = init_capture_device();
  641. if (err != OK) {
  642. ERR_PRINT("WASAPI: init_capture_device error");
  643. return err;
  644. }
  645. if (audio_input.active) {
  646. return FAILED;
  647. }
  648. audio_input.audio_client->Start();
  649. audio_input.active = true;
  650. return OK;
  651. }
  652. Error AudioDriverWASAPI::capture_stop() {
  653. if (audio_input.active) {
  654. audio_input.audio_client->Stop();
  655. audio_input.active = false;
  656. return OK;
  657. }
  658. return FAILED;
  659. }
  660. void AudioDriverWASAPI::capture_set_device(const String &p_name) {
  661. lock();
  662. audio_input.new_device = p_name;
  663. unlock();
  664. }
  665. Array AudioDriverWASAPI::capture_get_device_list() {
  666. return audio_device_get_list(true);
  667. }
  668. String AudioDriverWASAPI::capture_get_device() {
  669. lock();
  670. String name = audio_input.device_name;
  671. unlock();
  672. return name;
  673. }
  674. AudioDriverWASAPI::AudioDriverWASAPI() {
  675. mutex = NULL;
  676. thread = NULL;
  677. samples_in.clear();
  678. channels = 0;
  679. mix_rate = 0;
  680. buffer_frames = 0;
  681. thread_exited = false;
  682. exit_thread = false;
  683. }
  684. #endif