aac_in.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709
  1. /*
  2. * Copyright (c) 2010-2017, The Linux Foundation. All rights reserved.
  3. *
  4. * This program is free software; you can redistribute it and/or modify
  5. * it under the terms of the GNU General Public License version 2 and
  6. * only version 2 as published by the Free Software Foundation.
  7. *
  8. * This program is distributed in the hope that it will be useful,
  9. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. * GNU General Public License for more details.
  12. *
  13. */
  14. #include <linux/module.h>
  15. #include <linux/fs.h>
  16. #include <linux/miscdevice.h>
  17. #include <linux/uaccess.h>
  18. #include <linux/sched.h>
  19. #include <linux/wait.h>
  20. #include <linux/dma-mapping.h>
  21. #include <linux/slab.h>
  22. #include <linux/msm_audio_aac.h>
  23. #include <linux/compat.h>
  24. #include <linux/atomic.h>
  25. #include <asm/ioctls.h>
  26. #include "audio_utils.h"
  27. /* Buffer with meta*/
  28. #define PCM_BUF_SIZE (4096 + sizeof(struct meta_in))
  29. /* Maximum 5 frames in buffer with meta */
  30. #define FRAME_SIZE (1 + ((1536+sizeof(struct meta_out_dsp)) * 5))
  31. #define AAC_FORMAT_ADTS 65535
  32. #define MAX_SAMPLE_RATE_384K 384000
  33. static long aac_in_ioctl_shared(struct file *file, unsigned int cmd, void *arg)
  34. {
  35. struct q6audio_in *audio = file->private_data;
  36. int rc = 0;
  37. int cnt = 0;
  38. switch (cmd) {
  39. case AUDIO_START: {
  40. struct msm_audio_aac_enc_config *enc_cfg;
  41. struct msm_audio_aac_config *aac_config;
  42. uint32_t aac_mode = AAC_ENC_MODE_AAC_LC;
  43. enc_cfg = audio->enc_cfg;
  44. aac_config = audio->codec_cfg;
  45. /* ENCODE CFG (after new set of API's are published )bharath*/
  46. pr_debug("%s:session id %d: default buf alloc[%d]\n", __func__,
  47. audio->ac->session, audio->buf_alloc);
  48. if (audio->enabled == 1) {
  49. pr_info("%s:AUDIO_START already over\n", __func__);
  50. rc = 0;
  51. break;
  52. }
  53. if (audio->opened) {
  54. rc = audio_in_buf_alloc(audio);
  55. if (rc < 0) {
  56. pr_err("%s:session id %d: buffer allocation failed\n",
  57. __func__, audio->ac->session);
  58. break;
  59. }
  60. } else {
  61. if (audio->feedback == NON_TUNNEL_MODE) {
  62. pr_debug("%s: starting in non_tunnel mode",
  63. __func__);
  64. rc = q6asm_open_read_write(audio->ac,
  65. FORMAT_MPEG4_AAC, FORMAT_LINEAR_PCM);
  66. if (rc < 0) {
  67. pr_err("%s:open read write failed\n",
  68. __func__);
  69. break;
  70. }
  71. }
  72. if (audio->feedback == TUNNEL_MODE) {
  73. pr_debug("%s: starting in tunnel mode",
  74. __func__);
  75. rc = q6asm_open_read(audio->ac,
  76. FORMAT_MPEG4_AAC);
  77. if (rc < 0) {
  78. pr_err("%s:open read failed\n",
  79. __func__);
  80. break;
  81. }
  82. }
  83. audio->stopped = 0;
  84. }
  85. pr_debug("%s:sbr_ps_flag = %d, sbr_flag = %d\n", __func__,
  86. aac_config->sbr_ps_on_flag, aac_config->sbr_on_flag);
  87. if (aac_config->sbr_ps_on_flag)
  88. aac_mode = AAC_ENC_MODE_EAAC_P;
  89. else if (aac_config->sbr_on_flag)
  90. aac_mode = AAC_ENC_MODE_AAC_P;
  91. else
  92. aac_mode = AAC_ENC_MODE_AAC_LC;
  93. rc = q6asm_enc_cfg_blk_aac(audio->ac,
  94. audio->buf_cfg.frames_per_buf,
  95. enc_cfg->sample_rate,
  96. enc_cfg->channels,
  97. enc_cfg->bit_rate,
  98. aac_mode,
  99. enc_cfg->stream_format);
  100. if (rc < 0) {
  101. pr_err("%s:session id %d: cmd media format block failed\n",
  102. __func__, audio->ac->session);
  103. break;
  104. }
  105. if (audio->feedback == NON_TUNNEL_MODE) {
  106. rc = q6asm_media_format_block_pcm(audio->ac,
  107. audio->pcm_cfg.sample_rate,
  108. audio->pcm_cfg.channel_count);
  109. if (rc < 0) {
  110. pr_err("%s:session id %d: media format block failed\n",
  111. __func__, audio->ac->session);
  112. break;
  113. }
  114. }
  115. rc = audio_in_enable(audio);
  116. if (!rc) {
  117. audio->enabled = 1;
  118. } else {
  119. audio->enabled = 0;
  120. pr_err("%s:session id %d: Audio Start procedure failed rc=%d\n",
  121. __func__, audio->ac->session, rc);
  122. break;
  123. }
  124. while (cnt++ < audio->str_cfg.buffer_count)
  125. q6asm_read(audio->ac);
  126. pr_debug("%s:session id %d: AUDIO_START success enable[%d]\n",
  127. __func__, audio->ac->session, audio->enabled);
  128. break;
  129. }
  130. case AUDIO_STOP: {
  131. pr_debug("%s:session id %d: Rxed AUDIO_STOP\n", __func__,
  132. audio->ac->session);
  133. rc = audio_in_disable(audio);
  134. if (rc < 0) {
  135. pr_err("%s:session id %d: Audio Stop procedure failed rc=%d\n",
  136. __func__, audio->ac->session, rc);
  137. break;
  138. }
  139. break;
  140. }
  141. case AUDIO_GET_AAC_ENC_CONFIG: {
  142. struct msm_audio_aac_enc_config *cfg;
  143. struct msm_audio_aac_enc_config *enc_cfg;
  144. cfg = (struct msm_audio_aac_enc_config *)arg;
  145. if (cfg == NULL) {
  146. pr_err("%s: NULL config pointer for %s\n",
  147. __func__, "AUDIO_GET_AAC_CONFIG");
  148. rc = -EINVAL;
  149. break;
  150. }
  151. memset(cfg, 0, sizeof(*cfg));
  152. enc_cfg = audio->enc_cfg;
  153. if (enc_cfg->channels == CH_MODE_MONO)
  154. cfg->channels = 1;
  155. else
  156. cfg->channels = 2;
  157. cfg->sample_rate = enc_cfg->sample_rate;
  158. cfg->bit_rate = enc_cfg->bit_rate;
  159. switch (enc_cfg->stream_format) {
  160. case 0x00:
  161. cfg->stream_format = AUDIO_AAC_FORMAT_ADTS;
  162. break;
  163. case 0x01:
  164. cfg->stream_format = AUDIO_AAC_FORMAT_LOAS;
  165. break;
  166. case 0x02:
  167. cfg->stream_format = AUDIO_AAC_FORMAT_ADIF;
  168. break;
  169. default:
  170. case 0x03:
  171. cfg->stream_format = AUDIO_AAC_FORMAT_RAW;
  172. }
  173. pr_debug("%s:session id %d: Get-aac-cfg: format=%d sr=%d bitrate=%d\n",
  174. __func__, audio->ac->session,
  175. cfg->stream_format, cfg->sample_rate, cfg->bit_rate);
  176. break;
  177. }
  178. case AUDIO_SET_AAC_ENC_CONFIG: {
  179. struct msm_audio_aac_enc_config *cfg;
  180. struct msm_audio_aac_enc_config *enc_cfg;
  181. uint32_t min_bitrate, max_bitrate;
  182. cfg = (struct msm_audio_aac_enc_config *)arg;
  183. if (cfg == NULL) {
  184. pr_err("%s: NULL config pointer for %s\n",
  185. "AUDIO_SET_AAC_ENC_CONFIG", __func__);
  186. rc = -EINVAL;
  187. break;
  188. }
  189. enc_cfg = audio->enc_cfg;
  190. pr_debug("%s:session id %d: Set-aac-cfg: stream=%d\n", __func__,
  191. audio->ac->session, cfg->stream_format);
  192. switch (cfg->stream_format) {
  193. case AUDIO_AAC_FORMAT_ADTS:
  194. enc_cfg->stream_format = 0x00;
  195. break;
  196. case AUDIO_AAC_FORMAT_LOAS:
  197. enc_cfg->stream_format = 0x01;
  198. break;
  199. case AUDIO_AAC_FORMAT_ADIF:
  200. enc_cfg->stream_format = 0x02;
  201. break;
  202. case AUDIO_AAC_FORMAT_RAW:
  203. enc_cfg->stream_format = 0x03;
  204. break;
  205. default:
  206. pr_err("%s:session id %d: unsupported AAC format %d\n",
  207. __func__, audio->ac->session,
  208. cfg->stream_format);
  209. rc = -EINVAL;
  210. break;
  211. }
  212. if (cfg->channels == 1) {
  213. cfg->channels = CH_MODE_MONO;
  214. } else if (cfg->channels == 2) {
  215. cfg->channels = CH_MODE_STEREO;
  216. } else {
  217. rc = -EINVAL;
  218. break;
  219. }
  220. if (cfg->sample_rate > MAX_SAMPLE_RATE_384K) {
  221. pr_err("%s: ERROR: invalid sample rate = %u",
  222. __func__, cfg->sample_rate);
  223. rc = -EINVAL;
  224. break;
  225. }
  226. min_bitrate = ((cfg->sample_rate)*(cfg->channels))/2;
  227. /* This calculation should be based on AAC mode. But we cannot
  228. * get AAC mode in this setconfig. min_bitrate's logical max
  229. * value is 24000. So if min_bitrate is higher than 24000,
  230. * choose 24000.
  231. */
  232. if (min_bitrate > 24000)
  233. min_bitrate = 24000;
  234. max_bitrate = 6*(cfg->sample_rate)*(cfg->channels);
  235. if (max_bitrate > 192000)
  236. max_bitrate = 192000;
  237. if ((cfg->bit_rate < min_bitrate) ||
  238. (cfg->bit_rate > max_bitrate)) {
  239. pr_err("%s: bitrate permissible: max=%d, min=%d\n",
  240. __func__, max_bitrate, min_bitrate);
  241. pr_err("%s: ERROR in setting bitrate = %d\n",
  242. __func__, cfg->bit_rate);
  243. rc = -EINVAL;
  244. break;
  245. }
  246. enc_cfg->sample_rate = cfg->sample_rate;
  247. enc_cfg->channels = cfg->channels;
  248. enc_cfg->bit_rate = cfg->bit_rate;
  249. pr_debug("%s:session id %d: Set-aac-cfg:SR= 0x%x ch=0x%x bitrate=0x%x, format(adts/raw) = %d\n",
  250. __func__, audio->ac->session, enc_cfg->sample_rate,
  251. enc_cfg->channels, enc_cfg->bit_rate,
  252. enc_cfg->stream_format);
  253. break;
  254. }
  255. case AUDIO_SET_AAC_CONFIG: {
  256. struct msm_audio_aac_config *aac_cfg;
  257. struct msm_audio_aac_config *audio_aac_cfg;
  258. struct msm_audio_aac_enc_config *enc_cfg;
  259. enc_cfg = audio->enc_cfg;
  260. audio_aac_cfg = audio->codec_cfg;
  261. aac_cfg = (struct msm_audio_aac_config *)arg;
  262. if (aac_cfg == NULL) {
  263. pr_err("%s: NULL config pointer %s\n",
  264. __func__, "AUDIO_SET_AAC_CONFIG");
  265. rc = -EINVAL;
  266. break;
  267. }
  268. pr_debug("%s:session id %d: AUDIO_SET_AAC_CONFIG: sbr_flag = %d sbr_ps_flag = %d\n",
  269. __func__, audio->ac->session, aac_cfg->sbr_on_flag,
  270. aac_cfg->sbr_ps_on_flag);
  271. audio_aac_cfg->sbr_on_flag = aac_cfg->sbr_on_flag;
  272. audio_aac_cfg->sbr_ps_on_flag = aac_cfg->sbr_ps_on_flag;
  273. if ((audio_aac_cfg->sbr_on_flag == 1) ||
  274. (audio_aac_cfg->sbr_ps_on_flag == 1)) {
  275. if (enc_cfg->sample_rate < 24000) {
  276. pr_err("%s: ERROR in setting samplerate = %d\n",
  277. __func__, enc_cfg->sample_rate);
  278. rc = -EINVAL;
  279. break;
  280. }
  281. }
  282. break;
  283. }
  284. default:
  285. pr_err("%s: Unknown ioctl cmd = %d", __func__, cmd);
  286. rc = -EINVAL;
  287. }
  288. return rc;
  289. }
  290. static long aac_in_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
  291. {
  292. struct q6audio_in *audio = file->private_data;
  293. int rc = 0;
  294. switch (cmd) {
  295. case AUDIO_START:
  296. case AUDIO_STOP: {
  297. rc = aac_in_ioctl_shared(file, cmd, NULL);
  298. break;
  299. }
  300. case AUDIO_GET_AAC_ENC_CONFIG: {
  301. struct msm_audio_aac_enc_config cfg;
  302. rc = aac_in_ioctl_shared(file, cmd, &cfg);
  303. if (rc) {
  304. pr_err("%s:AUDIO_GET_AAC_ENC_CONFIG failed. rc=%d\n",
  305. __func__, rc);
  306. break;
  307. }
  308. if (copy_to_user((void *)arg, &cfg, sizeof(cfg))) {
  309. pr_err("%s: copy_to_user for AUDIO_GET_AAC_ENC_CONFIG failed\n",
  310. __func__);
  311. rc = -EFAULT;
  312. }
  313. break;
  314. }
  315. case AUDIO_SET_AAC_ENC_CONFIG: {
  316. struct msm_audio_aac_enc_config cfg;
  317. if (copy_from_user(&cfg, (void *)arg, sizeof(cfg))) {
  318. pr_err("%s: copy_from_user for AUDIO_SET_AAC_ENC_CONFIG failed\n",
  319. __func__);
  320. rc = -EFAULT;
  321. break;
  322. }
  323. rc = aac_in_ioctl_shared(file, cmd, &cfg);
  324. if (rc)
  325. pr_err("%s:AUDIO_SET_AAC_ENC_CONFIG failed. rc=%d\n",
  326. __func__, rc);
  327. break;
  328. }
  329. case AUDIO_GET_AAC_CONFIG: {
  330. if (copy_to_user((void *)arg, &audio->codec_cfg,
  331. sizeof(struct msm_audio_aac_config))) {
  332. pr_err("%s: copy_to_user for AUDIO_GET_AAC_CONFIG failed\n",
  333. __func__);
  334. rc = -EFAULT;
  335. break;
  336. }
  337. break;
  338. }
  339. case AUDIO_SET_AAC_CONFIG: {
  340. struct msm_audio_aac_config aac_cfg;
  341. if (copy_from_user(&aac_cfg, (void *)arg,
  342. sizeof(struct msm_audio_aac_config))) {
  343. pr_err("%s: copy_to_user for AUDIO_SET_CONFIG failed\n",
  344. __func__);
  345. rc = -EFAULT;
  346. break;
  347. }
  348. rc = aac_in_ioctl_shared(file, cmd, &aac_cfg);
  349. if (rc)
  350. pr_err("%s:AUDIO_SET_AAC_CONFIG failed. rc=%d\n",
  351. __func__, rc);
  352. break;
  353. }
  354. default:
  355. pr_err("%s: Unknown ioctl cmd=%d\n", __func__, cmd);
  356. rc = -EINVAL;
  357. }
  358. return rc;
  359. }
  360. #ifdef CONFIG_COMPAT
  361. struct msm_audio_aac_enc_config32 {
  362. u32 channels;
  363. u32 sample_rate;
  364. u32 bit_rate;
  365. u32 stream_format;
  366. };
  367. struct msm_audio_aac_config32 {
  368. s16 format;
  369. u16 audio_object;
  370. u16 ep_config; /* 0 ~ 3 useful only obj = ERLC */
  371. u16 aac_section_data_resilience_flag;
  372. u16 aac_scalefactor_data_resilience_flag;
  373. u16 aac_spectral_data_resilience_flag;
  374. u16 sbr_on_flag;
  375. u16 sbr_ps_on_flag;
  376. u16 dual_mono_mode;
  377. u16 channel_configuration;
  378. u16 sample_rate;
  379. };
  380. enum {
  381. AUDIO_SET_AAC_CONFIG_32 = _IOW(AUDIO_IOCTL_MAGIC,
  382. (AUDIO_MAX_COMMON_IOCTL_NUM+0), struct msm_audio_aac_config32),
  383. AUDIO_GET_AAC_CONFIG_32 = _IOR(AUDIO_IOCTL_MAGIC,
  384. (AUDIO_MAX_COMMON_IOCTL_NUM+1), struct msm_audio_aac_config32),
  385. AUDIO_SET_AAC_ENC_CONFIG_32 = _IOW(AUDIO_IOCTL_MAGIC,
  386. (AUDIO_MAX_COMMON_IOCTL_NUM+3), struct msm_audio_aac_enc_config32),
  387. AUDIO_GET_AAC_ENC_CONFIG_32 = _IOR(AUDIO_IOCTL_MAGIC,
  388. (AUDIO_MAX_COMMON_IOCTL_NUM+4), struct msm_audio_aac_enc_config32)
  389. };
  390. static long aac_in_compat_ioctl(struct file *file, unsigned int cmd,
  391. unsigned long arg)
  392. {
  393. struct q6audio_in *audio = file->private_data;
  394. int rc = 0;
  395. switch (cmd) {
  396. case AUDIO_START:
  397. case AUDIO_STOP: {
  398. rc = aac_in_ioctl_shared(file, cmd, NULL);
  399. break;
  400. }
  401. case AUDIO_GET_AAC_ENC_CONFIG_32: {
  402. struct msm_audio_aac_enc_config cfg;
  403. struct msm_audio_aac_enc_config32 cfg_32;
  404. memset(&cfg_32, 0, sizeof(cfg_32));
  405. cmd = AUDIO_GET_AAC_ENC_CONFIG;
  406. rc = aac_in_ioctl_shared(file, cmd, &cfg);
  407. if (rc) {
  408. pr_err("%s:AUDIO_GET_AAC_ENC_CONFIG_32 failed. Rc= %d\n",
  409. __func__, rc);
  410. break;
  411. }
  412. cfg_32.channels = cfg.channels;
  413. cfg_32.sample_rate = cfg.sample_rate;
  414. cfg_32.bit_rate = cfg.bit_rate;
  415. cfg_32.stream_format = cfg.stream_format;
  416. if (copy_to_user((void *)arg, &cfg_32, sizeof(cfg_32))) {
  417. pr_err("%s: copy_to_user for AUDIO_GET_AAC_ENC_CONFIG_32 failed\n",
  418. __func__);
  419. rc = -EFAULT;
  420. }
  421. break;
  422. }
  423. case AUDIO_SET_AAC_ENC_CONFIG_32: {
  424. struct msm_audio_aac_enc_config cfg;
  425. struct msm_audio_aac_enc_config32 cfg_32;
  426. if (copy_from_user(&cfg_32, (void *)arg, sizeof(cfg_32))) {
  427. pr_err("%s: copy_from_user for AUDIO_GET_AAC_ENC_CONFIG_32 failed\n",
  428. __func__);
  429. rc = -EFAULT;
  430. break;
  431. }
  432. cfg.channels = cfg_32.channels;
  433. cfg.sample_rate = cfg_32.sample_rate;
  434. cfg.bit_rate = cfg_32.bit_rate;
  435. cfg.stream_format = cfg_32.stream_format;
  436. /* The command should be converted from 32 bit to normal
  437. * before the shared ioctl is called as shared ioctl
  438. * can process only normal commands
  439. */
  440. cmd = AUDIO_SET_AAC_ENC_CONFIG;
  441. rc = aac_in_ioctl_shared(file, cmd, &cfg);
  442. if (rc)
  443. pr_err("%s:AUDIO_SET_AAC_ENC_CONFIG_32 failed. rc=%d\n",
  444. __func__, rc);
  445. break;
  446. }
  447. case AUDIO_GET_AAC_CONFIG_32: {
  448. struct msm_audio_aac_config *aac_config;
  449. struct msm_audio_aac_config32 aac_config_32;
  450. aac_config = (struct msm_audio_aac_config *)audio->codec_cfg;
  451. aac_config_32.format = aac_config->format;
  452. aac_config_32.audio_object = aac_config->audio_object;
  453. aac_config_32.ep_config = aac_config->ep_config;
  454. aac_config_32.aac_section_data_resilience_flag =
  455. aac_config->aac_section_data_resilience_flag;
  456. aac_config_32.aac_scalefactor_data_resilience_flag =
  457. aac_config->aac_scalefactor_data_resilience_flag;
  458. aac_config_32.aac_spectral_data_resilience_flag =
  459. aac_config->aac_spectral_data_resilience_flag;
  460. aac_config_32.sbr_on_flag = aac_config->sbr_on_flag;
  461. aac_config_32.sbr_ps_on_flag = aac_config->sbr_ps_on_flag;
  462. aac_config_32.dual_mono_mode = aac_config->dual_mono_mode;
  463. aac_config_32.channel_configuration =
  464. aac_config->channel_configuration;
  465. aac_config_32.sample_rate = aac_config->sample_rate;
  466. if (copy_to_user((void *)arg, &aac_config_32,
  467. sizeof(aac_config_32))) {
  468. pr_err("%s: copy_to_user for AUDIO_GET_AAC_CONFIG_32 failed\n",
  469. __func__);
  470. rc = -EFAULT;
  471. break;
  472. }
  473. break;
  474. }
  475. case AUDIO_SET_AAC_CONFIG_32: {
  476. struct msm_audio_aac_config aac_cfg;
  477. struct msm_audio_aac_config32 aac_cfg_32;
  478. if (copy_from_user(&aac_cfg_32, (void *)arg,
  479. sizeof(aac_cfg_32))) {
  480. pr_err("%s: copy_from_user for AUDIO_SET_AAC_CONFIG_32 failed\n",
  481. __func__);
  482. rc = -EFAULT;
  483. break;
  484. }
  485. aac_cfg.format = aac_cfg_32.format;
  486. aac_cfg.audio_object = aac_cfg_32.audio_object;
  487. aac_cfg.ep_config = aac_cfg_32.ep_config;
  488. aac_cfg.aac_section_data_resilience_flag =
  489. aac_cfg_32.aac_section_data_resilience_flag;
  490. aac_cfg.aac_scalefactor_data_resilience_flag =
  491. aac_cfg_32.aac_scalefactor_data_resilience_flag;
  492. aac_cfg.aac_spectral_data_resilience_flag =
  493. aac_cfg_32.aac_spectral_data_resilience_flag;
  494. aac_cfg.sbr_on_flag = aac_cfg_32.sbr_on_flag;
  495. aac_cfg.sbr_ps_on_flag = aac_cfg_32.sbr_ps_on_flag;
  496. aac_cfg.dual_mono_mode = aac_cfg_32.dual_mono_mode;
  497. aac_cfg.channel_configuration =
  498. aac_cfg_32.channel_configuration;
  499. aac_cfg.sample_rate = aac_cfg_32.sample_rate;
  500. cmd = AUDIO_SET_AAC_CONFIG;
  501. rc = aac_in_ioctl_shared(file, cmd, &aac_cfg);
  502. if (rc)
  503. pr_err("%s:AUDIO_SET_AAC_CONFIG failed. Rc= %d\n",
  504. __func__, rc);
  505. break;
  506. }
  507. default:
  508. pr_err("%s: Unknown ioctl cmd = %d\n", __func__, cmd);
  509. rc = -EINVAL;
  510. }
  511. return rc;
  512. }
  513. #else
  514. #define aac_in_compat_ioctl NULL
  515. #endif
  516. static int aac_in_open(struct inode *inode, struct file *file)
  517. {
  518. struct q6audio_in *audio = NULL;
  519. struct msm_audio_aac_enc_config *enc_cfg;
  520. struct msm_audio_aac_config *aac_config;
  521. int rc = 0;
  522. audio = kzalloc(sizeof(struct q6audio_in), GFP_KERNEL);
  523. if (audio == NULL)
  524. return -ENOMEM;
  525. /* Allocate memory for encoder config param */
  526. audio->enc_cfg = kzalloc(sizeof(struct msm_audio_aac_enc_config),
  527. GFP_KERNEL);
  528. if (audio->enc_cfg == NULL) {
  529. kfree(audio);
  530. return -ENOMEM;
  531. }
  532. enc_cfg = audio->enc_cfg;
  533. audio->codec_cfg = kzalloc(sizeof(struct msm_audio_aac_config),
  534. GFP_KERNEL);
  535. if (audio->codec_cfg == NULL) {
  536. kfree(audio->enc_cfg);
  537. kfree(audio);
  538. return -ENOMEM;
  539. }
  540. aac_config = audio->codec_cfg;
  541. mutex_init(&audio->lock);
  542. mutex_init(&audio->read_lock);
  543. mutex_init(&audio->write_lock);
  544. spin_lock_init(&audio->dsp_lock);
  545. init_waitqueue_head(&audio->read_wait);
  546. init_waitqueue_head(&audio->write_wait);
  547. /* Settings will be re-config at AUDIO_SET_CONFIG,
  548. * but at least we need to have initial config
  549. */
  550. audio->str_cfg.buffer_size = FRAME_SIZE;
  551. audio->str_cfg.buffer_count = FRAME_NUM;
  552. audio->min_frame_size = 1536;
  553. audio->max_frames_per_buf = 5;
  554. enc_cfg->sample_rate = 8000;
  555. enc_cfg->channels = 1;
  556. enc_cfg->bit_rate = 16000;
  557. enc_cfg->stream_format = 0x00;/* 0:ADTS, 3:RAW */
  558. audio->buf_cfg.meta_info_enable = 0x01;
  559. audio->buf_cfg.frames_per_buf = 0x01;
  560. audio->pcm_cfg.buffer_count = PCM_BUF_COUNT;
  561. audio->pcm_cfg.buffer_size = PCM_BUF_SIZE;
  562. aac_config->format = AUDIO_AAC_FORMAT_ADTS;
  563. aac_config->audio_object = AUDIO_AAC_OBJECT_LC;
  564. aac_config->sbr_on_flag = 0;
  565. aac_config->sbr_ps_on_flag = 0;
  566. aac_config->channel_configuration = 1;
  567. audio->ac = q6asm_audio_client_alloc((app_cb)q6asm_in_cb,
  568. (void *)audio);
  569. if (!audio->ac) {
  570. pr_err("%s: Could not allocate memory for audio client\n",
  571. __func__);
  572. kfree(audio->enc_cfg);
  573. kfree(audio->codec_cfg);
  574. kfree(audio);
  575. return -ENOMEM;
  576. }
  577. /* open aac encoder in tunnel mode */
  578. audio->buf_cfg.frames_per_buf = 0x01;
  579. if ((file->f_mode & FMODE_WRITE) &&
  580. (file->f_mode & FMODE_READ)) {
  581. audio->feedback = NON_TUNNEL_MODE;
  582. rc = q6asm_open_read_write(audio->ac, FORMAT_MPEG4_AAC,
  583. FORMAT_LINEAR_PCM);
  584. if (rc < 0) {
  585. pr_err("%s:session id %d: NT Open failed rc=%d\n",
  586. __func__, audio->ac->session, rc);
  587. rc = -ENODEV;
  588. goto fail;
  589. }
  590. audio->buf_cfg.meta_info_enable = 0x01;
  591. pr_info("%s:session id %d: NT mode encoder success\n", __func__,
  592. audio->ac->session);
  593. } else if (!(file->f_mode & FMODE_WRITE) &&
  594. (file->f_mode & FMODE_READ)) {
  595. audio->feedback = TUNNEL_MODE;
  596. rc = q6asm_open_read(audio->ac, FORMAT_MPEG4_AAC);
  597. if (rc < 0) {
  598. pr_err("%s:session id %d: Tunnel Open failed rc=%d\n",
  599. __func__, audio->ac->session, rc);
  600. rc = -ENODEV;
  601. goto fail;
  602. }
  603. /* register for tx overflow (valid for tunnel mode only) */
  604. rc = q6asm_reg_tx_overflow(audio->ac, 0x01);
  605. if (rc < 0) {
  606. pr_err("%s:session id %d: TX Overflow registration failed rc=%d\n",
  607. __func__,
  608. audio->ac->session, rc);
  609. rc = -ENODEV;
  610. goto fail;
  611. }
  612. audio->buf_cfg.meta_info_enable = 0x00;
  613. pr_info("%s:session id %d: T mode encoder success\n", __func__,
  614. audio->ac->session);
  615. } else {
  616. pr_err("%s:session id %d: Unexpected mode\n", __func__,
  617. audio->ac->session);
  618. rc = -EACCES;
  619. goto fail;
  620. }
  621. audio->opened = 1;
  622. audio->reset_event = false;
  623. atomic_set(&audio->in_count, PCM_BUF_COUNT);
  624. atomic_set(&audio->out_count, 0x00);
  625. audio->enc_compat_ioctl = aac_in_compat_ioctl;
  626. audio->enc_ioctl = aac_in_ioctl;
  627. file->private_data = audio;
  628. pr_info("%s:session id %d: success\n", __func__, audio->ac->session);
  629. return 0;
  630. fail:
  631. q6asm_audio_client_free(audio->ac);
  632. kfree(audio->enc_cfg);
  633. kfree(audio->codec_cfg);
  634. kfree(audio);
  635. return rc;
  636. }
  637. static const struct file_operations audio_in_fops = {
  638. .owner = THIS_MODULE,
  639. .open = aac_in_open,
  640. .release = audio_in_release,
  641. .read = audio_in_read,
  642. .write = audio_in_write,
  643. .unlocked_ioctl = audio_in_ioctl,
  644. .compat_ioctl = audio_in_compat_ioctl
  645. };
  646. struct miscdevice audio_aac_in_misc = {
  647. .minor = MISC_DYNAMIC_MINOR,
  648. .name = "msm_aac_in",
  649. .fops = &audio_in_fops,
  650. };
  651. static int __init aac_in_init(void)
  652. {
  653. return misc_register(&audio_aac_in_misc);
  654. }
  655. device_initcall(aac_in_init);