msm_hdmi_codec_rx.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715
  1. // SPDX-License-Identifier: GPL-2.0
  2. /* Copyright (c) 2012-2018, The Linux Foundation. All rights reserved.
  3. */
  4. #include <linux/platform_device.h>
  5. #include <linux/slab.h>
  6. #include <linux/module.h>
  7. #include <linux/of_device.h>
  8. #include <linux/err.h>
  9. #include <sound/core.h>
  10. #include <sound/pcm.h>
  11. #include <sound/soc.h>
  12. #include <linux/msm_ext_display.h>
  13. #define MSM_EXT_DISP_PCM_RATES SNDRV_PCM_RATE_48000
  14. #define AUD_EXT_DISP_ACK_DISCONNECT (AUDIO_ACK_CONNECT ^ AUDIO_ACK_CONNECT)
  15. #define AUD_EXT_DISP_ACK_CONNECT (AUDIO_ACK_CONNECT)
  16. #define AUD_EXT_DISP_ACK_ENABLE (AUDIO_ACK_SET_ENABLE | AUDIO_ACK_ENABLE)
  17. #define SOC_EXT_DISP_AUDIO_TYPE(index) \
  18. static SOC_ENUM_SINGLE_DECL(ext_disp_audio_type##index, SND_SOC_NOPM, \
  19. index, ext_disp_audio_type_text)
  20. #define SOC_EXT_DISP_AUDIO_ACK_STATE(index) \
  21. static SOC_ENUM_SINGLE_DECL(ext_disp_audio_ack_state##index, \
  22. SND_SOC_NOPM, index, ext_disp_audio_ack_text)
  23. #define SWITCH_DP_CODEC(codec_info, codec_data, dai_id) \
  24. codec_info.type = EXT_DISPLAY_TYPE_DP; \
  25. codec_info.ctrl_id = codec_data->ctl[dai_id]; \
  26. codec_info.stream_id = codec_data->stream[dai_id]; \
  27. msm_ext_disp_select_audio_codec(codec_data->ext_disp_core_pdev, \
  28. &codec_info)
  29. enum {
  30. DP_STREAM0 = 0,
  31. DP_STREAM1,
  32. DP_STREAM_MAX,
  33. };
  34. enum {
  35. DP_DAI1 = 0,
  36. DP_DAI2,
  37. HDMI_DAI,
  38. DP_DAI_MAX,
  39. };
  40. static const char *const ext_disp_audio_type_text[] = {"None", "HDMI", "DP"};
  41. static const char *const ext_disp_audio_ack_text[] = {"Disconnect", "Connect",
  42. "Ack_Enable"};
  43. SOC_EXT_DISP_AUDIO_TYPE(0);
  44. SOC_EXT_DISP_AUDIO_ACK_STATE(0);
  45. SOC_EXT_DISP_AUDIO_TYPE(1);
  46. SOC_EXT_DISP_AUDIO_ACK_STATE(1);
  47. struct msm_ext_disp_audio_codec_rx_data {
  48. struct platform_device *ext_disp_core_pdev;
  49. struct msm_ext_disp_audio_codec_ops ext_disp_ops;
  50. int cable_status;
  51. struct mutex dp_ops_lock;
  52. int stream[DP_DAI_MAX];
  53. int ctl[DP_DAI_MAX];
  54. };
  55. static int msm_ext_disp_edid_ctl_info(struct snd_kcontrol *kcontrol,
  56. struct snd_ctl_elem_info *uinfo)
  57. {
  58. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  59. struct msm_ext_disp_audio_codec_rx_data *codec_data;
  60. struct msm_ext_disp_audio_edid_blk edid_blk;
  61. int rc = 0;
  62. struct msm_ext_disp_codec_id codec_info;
  63. int dai_id = kcontrol->private_value;
  64. codec_data = snd_soc_codec_get_drvdata(codec);
  65. if (!codec_data) {
  66. dev_err(codec->dev, "%s: codec_data is NULL\n", __func__);
  67. return -EINVAL;
  68. }
  69. if (!codec_data->ext_disp_ops.get_audio_edid_blk) {
  70. dev_dbg(codec->dev, "%s: get_audio_edid_blk() is NULL\n",
  71. __func__);
  72. uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
  73. uinfo->count = 0;
  74. return 0;
  75. }
  76. dev_dbg(codec->dev, "%s: DP ctl id %d Stream id %d\n", __func__,
  77. codec_data->ctl[dai_id], codec_data->stream[dai_id]);
  78. mutex_lock(&codec_data->dp_ops_lock);
  79. SWITCH_DP_CODEC(codec_info, codec_data, dai_id);
  80. rc = codec_data->ext_disp_ops.get_audio_edid_blk(
  81. codec_data->ext_disp_core_pdev, &edid_blk);
  82. mutex_unlock(&codec_data->dp_ops_lock);
  83. if (rc >= 0) {
  84. uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
  85. uinfo->count = edid_blk.audio_data_blk_size +
  86. edid_blk.spk_alloc_data_blk_size;
  87. }
  88. dev_dbg(codec->dev, "%s: count: %d\n", __func__, uinfo->count);
  89. return rc;
  90. }
  91. static int msm_ext_disp_edid_get(struct snd_kcontrol *kcontrol,
  92. struct snd_ctl_elem_value *ucontrol) {
  93. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  94. struct msm_ext_disp_audio_codec_rx_data *codec_data;
  95. struct msm_ext_disp_audio_edid_blk edid_blk;
  96. struct msm_ext_disp_codec_id codec_info;
  97. int rc = 0;
  98. int dai_id = kcontrol->private_value;
  99. codec_data = snd_soc_codec_get_drvdata(codec);
  100. if (!codec_data || !codec_data->ext_disp_ops.get_audio_edid_blk) {
  101. dev_err(codec->dev, "%s: codec_data or get_audio_edid_blk() is NULL\n",
  102. __func__);
  103. return -EINVAL;
  104. }
  105. dev_dbg(codec->dev, "%s: DP ctl id %d Stream id %d\n", __func__,
  106. codec_data->ctl[dai_id], codec_data->stream[dai_id]);
  107. mutex_lock(&codec_data->dp_ops_lock);
  108. SWITCH_DP_CODEC(codec_info, codec_data, dai_id);
  109. rc = codec_data->ext_disp_ops.get_audio_edid_blk(
  110. codec_data->ext_disp_core_pdev, &edid_blk);
  111. mutex_unlock(&codec_data->dp_ops_lock);
  112. if (rc >= 0) {
  113. if (sizeof(ucontrol->value.bytes.data) <
  114. (edid_blk.audio_data_blk_size +
  115. edid_blk.spk_alloc_data_blk_size)) {
  116. dev_err(codec->dev,
  117. "%s: Not enough memory to copy EDID data\n",
  118. __func__);
  119. return -ENOMEM;
  120. }
  121. memcpy(ucontrol->value.bytes.data,
  122. edid_blk.audio_data_blk,
  123. edid_blk.audio_data_blk_size);
  124. memcpy((ucontrol->value.bytes.data +
  125. edid_blk.audio_data_blk_size),
  126. edid_blk.spk_alloc_data_blk,
  127. edid_blk.spk_alloc_data_blk_size);
  128. dev_dbg(codec->dev, "%s: data_blk_size:%d, spk_alloc_data_blk_size:%d\n",
  129. __func__, edid_blk.audio_data_blk_size,
  130. edid_blk.spk_alloc_data_blk_size);
  131. }
  132. return rc;
  133. }
  134. static int msm_ext_disp_audio_type_get(struct snd_kcontrol *kcontrol,
  135. struct snd_ctl_elem_value *ucontrol)
  136. {
  137. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  138. struct msm_ext_disp_audio_codec_rx_data *codec_data;
  139. enum msm_ext_disp_cable_state cable_state;
  140. enum msm_ext_disp_type disp_type;
  141. struct msm_ext_disp_codec_id codec_info;
  142. int rc = 0;
  143. int dai_id = ((struct soc_enum *) kcontrol->private_value)->shift_l;
  144. codec_data = snd_soc_codec_get_drvdata(codec);
  145. if (!codec_data ||
  146. !codec_data->ext_disp_ops.get_audio_edid_blk ||
  147. !codec_data->ext_disp_ops.get_intf_id) {
  148. dev_err(codec->dev, "%s: codec_data, get_audio_edid_blk() or get_intf_id is NULL\n",
  149. __func__);
  150. return -EINVAL;
  151. }
  152. dev_dbg(codec->dev, "%s: DP ctl id %d Stream id %d\n", __func__,
  153. codec_data->ctl[dai_id], codec_data->stream[dai_id]);
  154. mutex_lock(&codec_data->dp_ops_lock);
  155. SWITCH_DP_CODEC(codec_info, codec_data, dai_id);
  156. cable_state = codec_data->ext_disp_ops.cable_status(
  157. codec_data->ext_disp_core_pdev, 1);
  158. if (cable_state < 0) {
  159. dev_err(codec->dev, "%s: Error retrieving cable state from ext_disp, err:%d\n",
  160. __func__, cable_state);
  161. rc = cable_state;
  162. goto cable_err;
  163. }
  164. codec_data->cable_status = cable_state;
  165. if (cable_state == EXT_DISPLAY_CABLE_DISCONNECT) {
  166. dev_err(codec->dev, "%s: Display cable disconnected\n",
  167. __func__);
  168. ucontrol->value.integer.value[0] = 0;
  169. rc = 0;
  170. goto cable_err;
  171. }
  172. disp_type = codec_data->ext_disp_ops.get_intf_id(
  173. codec_data->ext_disp_core_pdev);
  174. mutex_unlock(&codec_data->dp_ops_lock);
  175. if (disp_type >= 0) {
  176. switch (disp_type) {
  177. case EXT_DISPLAY_TYPE_DP:
  178. ucontrol->value.integer.value[0] = 2;
  179. rc = 0;
  180. break;
  181. case EXT_DISPLAY_TYPE_HDMI:
  182. ucontrol->value.integer.value[0] = 1;
  183. rc = 0;
  184. break;
  185. default:
  186. rc = -EINVAL;
  187. dev_err(codec->dev, "%s: Invalid disp_type:%d\n",
  188. __func__, disp_type);
  189. goto done;
  190. }
  191. dev_dbg(codec->dev, "%s: Display type: %d\n",
  192. __func__, disp_type);
  193. } else {
  194. dev_err(codec->dev, "%s: Error retrieving disp_type from ext_disp, err:%d\n",
  195. __func__, disp_type);
  196. rc = disp_type;
  197. }
  198. return rc;
  199. cable_err:
  200. mutex_unlock(&codec_data->dp_ops_lock);
  201. done:
  202. return rc;
  203. }
  204. static int msm_ext_disp_audio_ack_set(struct snd_kcontrol *kcontrol,
  205. struct snd_ctl_elem_value *ucontrol)
  206. {
  207. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  208. struct msm_ext_disp_audio_codec_rx_data *codec_data;
  209. u32 ack_state = 0;
  210. struct msm_ext_disp_codec_id codec_info;
  211. int rc = 0;
  212. int dai_id = ((struct soc_enum *) kcontrol->private_value)->shift_l;
  213. codec_data = snd_soc_codec_get_drvdata(codec);
  214. if (!codec_data ||
  215. !codec_data->ext_disp_ops.acknowledge) {
  216. dev_err(codec->dev,
  217. "%s: codec_data or ops acknowledge() is NULL\n",
  218. __func__);
  219. rc = -EINVAL;
  220. goto done;
  221. }
  222. dev_dbg(codec->dev, "%s: DP ctl id %d Stream id %d\n", __func__,
  223. codec_data->ctl[dai_id], codec_data->stream[dai_id]);
  224. switch (ucontrol->value.enumerated.item[0]) {
  225. case 0:
  226. ack_state = AUD_EXT_DISP_ACK_DISCONNECT;
  227. break;
  228. case 1:
  229. ack_state = AUD_EXT_DISP_ACK_CONNECT;
  230. break;
  231. case 2:
  232. ack_state = AUD_EXT_DISP_ACK_ENABLE;
  233. break;
  234. default:
  235. rc = -EINVAL;
  236. dev_err(codec->dev,
  237. "%s: invalid value %d for mixer ctl\n",
  238. __func__, ucontrol->value.enumerated.item[0]);
  239. goto done;
  240. }
  241. dev_dbg(codec->dev, "%s: control %d, ack set value 0x%x\n",
  242. __func__, ucontrol->value.enumerated.item[0], ack_state);
  243. mutex_lock(&codec_data->dp_ops_lock);
  244. SWITCH_DP_CODEC(codec_info, codec_data, dai_id);
  245. rc = codec_data->ext_disp_ops.acknowledge(
  246. codec_data->ext_disp_core_pdev, ack_state);
  247. mutex_unlock(&codec_data->dp_ops_lock);
  248. if (rc < 0) {
  249. dev_err(codec->dev, "%s: error from acknowledge(), err:%d\n",
  250. __func__, rc);
  251. }
  252. done:
  253. return rc;
  254. }
  255. static int msm_ext_disp_audio_device_set(struct snd_kcontrol *kcontrol,
  256. struct snd_ctl_elem_value *ucontrol)
  257. {
  258. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  259. struct msm_ext_disp_audio_codec_rx_data *codec_data;
  260. int rc = 0;
  261. int dai_id = ((struct soc_enum *) kcontrol->private_value)->shift_l;
  262. codec_data = snd_soc_codec_get_drvdata(codec);
  263. if (!codec_data) {
  264. dev_err(codec->dev,
  265. "%s: codec_data or ops acknowledge() is NULL\n",
  266. __func__);
  267. rc = -EINVAL;
  268. goto done;
  269. }
  270. mutex_lock(&codec_data->dp_ops_lock);
  271. codec_data->ctl[dai_id] = ucontrol->value.enumerated.item[0];
  272. codec_data->stream[dai_id] = ucontrol->value.enumerated.item[1];
  273. mutex_unlock(&codec_data->dp_ops_lock);
  274. done:
  275. return rc;
  276. }
  277. static const struct snd_kcontrol_new msm_ext_disp_codec_rx_controls[] = {
  278. {
  279. .access = SNDRV_CTL_ELEM_ACCESS_READ |
  280. SNDRV_CTL_ELEM_ACCESS_VOLATILE,
  281. .iface = SNDRV_CTL_ELEM_IFACE_PCM,
  282. .name = "HDMI EDID",
  283. .info = msm_ext_disp_edid_ctl_info,
  284. .get = msm_ext_disp_edid_get,
  285. .private_value = HDMI_DAI,
  286. },
  287. {
  288. .access = SNDRV_CTL_ELEM_ACCESS_READ |
  289. SNDRV_CTL_ELEM_ACCESS_VOLATILE,
  290. .iface = SNDRV_CTL_ELEM_IFACE_PCM,
  291. .name = "Display Port EDID",
  292. .info = msm_ext_disp_edid_ctl_info,
  293. .get = msm_ext_disp_edid_get,
  294. .private_value = DP_DAI1,
  295. },
  296. {
  297. .access = SNDRV_CTL_ELEM_ACCESS_READ |
  298. SNDRV_CTL_ELEM_ACCESS_VOLATILE,
  299. .iface = SNDRV_CTL_ELEM_IFACE_PCM,
  300. .name = "Display Port1 EDID",
  301. .info = msm_ext_disp_edid_ctl_info,
  302. .get = msm_ext_disp_edid_get,
  303. .private_value = DP_DAI2,
  304. },
  305. SOC_ENUM_EXT("External Display Type",
  306. ext_disp_audio_type0,
  307. msm_ext_disp_audio_type_get, NULL),
  308. SOC_ENUM_EXT("External Display1 Type",
  309. ext_disp_audio_type1,
  310. msm_ext_disp_audio_type_get, NULL),
  311. SOC_ENUM_EXT("External Display Audio Ack",
  312. ext_disp_audio_ack_state0,
  313. NULL, msm_ext_disp_audio_ack_set),
  314. SOC_ENUM_EXT("External Display1 Audio Ack",
  315. ext_disp_audio_ack_state1,
  316. NULL, msm_ext_disp_audio_ack_set),
  317. SOC_SINGLE_EXT("External Display Audio Device",
  318. SND_SOC_NOPM, DP_DAI1, DP_STREAM_MAX, 0,
  319. NULL, msm_ext_disp_audio_device_set),
  320. SOC_SINGLE_EXT("External Display1 Audio Device",
  321. SND_SOC_NOPM, DP_DAI2, DP_STREAM_MAX, 0,
  322. NULL, msm_ext_disp_audio_device_set),
  323. };
  324. static int msm_ext_disp_audio_codec_rx_dai_startup(
  325. struct snd_pcm_substream *substream,
  326. struct snd_soc_dai *dai)
  327. {
  328. int ret = 0;
  329. struct msm_ext_disp_codec_id codec_info;
  330. struct msm_ext_disp_audio_codec_rx_data *codec_data =
  331. dev_get_drvdata(dai->codec->dev);
  332. if (!codec_data || !codec_data->ext_disp_ops.cable_status) {
  333. dev_err(dai->dev, "%s() codec_data or cable_status is null\n",
  334. __func__);
  335. return -EINVAL;
  336. }
  337. dev_dbg(dai->codec->dev, "%s: DP ctl id %d Stream id %d\n", __func__,
  338. codec_data->ctl[dai->id], codec_data->stream[dai->id]);
  339. mutex_lock(&codec_data->dp_ops_lock);
  340. SWITCH_DP_CODEC(codec_info, codec_data, dai->id);
  341. codec_data->cable_status =
  342. codec_data->ext_disp_ops.cable_status(
  343. codec_data->ext_disp_core_pdev, 1);
  344. mutex_unlock(&codec_data->dp_ops_lock);
  345. if (codec_data->cable_status < 0) {
  346. dev_err(dai->dev,
  347. "%s() ext disp core is not ready (ret val = %d)\n",
  348. __func__, codec_data->cable_status);
  349. ret = codec_data->cable_status;
  350. } else if (!codec_data->cable_status) {
  351. dev_err(dai->dev,
  352. "%s() ext disp cable is not connected (ret val = %d)\n",
  353. __func__, codec_data->cable_status);
  354. ret = -ENODEV;
  355. }
  356. return ret;
  357. }
  358. static int msm_ext_disp_audio_codec_rx_dai_hw_params(
  359. struct snd_pcm_substream *substream,
  360. struct snd_pcm_hw_params *params,
  361. struct snd_soc_dai *dai)
  362. {
  363. u32 channel_allocation = 0;
  364. u32 level_shift = 0; /* 0dB */
  365. bool down_mix = 0;
  366. u32 num_channels = params_channels(params);
  367. struct msm_ext_disp_codec_id codec_info;
  368. int rc = 0;
  369. struct msm_ext_disp_audio_setup_params audio_setup_params = {0};
  370. struct msm_ext_disp_audio_codec_rx_data *codec_data =
  371. dev_get_drvdata(dai->codec->dev);
  372. if (!codec_data || !codec_data->ext_disp_ops.audio_info_setup) {
  373. dev_err(dai->dev, "%s: codec_data or audio_info_setup is null\n",
  374. __func__);
  375. return -EINVAL;
  376. }
  377. dev_dbg(dai->codec->dev, "%s: DP ctl id %d Stream id %d\n", __func__,
  378. codec_data->ctl[dai->id], codec_data->stream[dai->id]);
  379. if (codec_data->cable_status < 0) {
  380. dev_err_ratelimited(dai->dev,
  381. "%s() ext disp core is not ready (ret val = %d)\n",
  382. __func__, codec_data->cable_status);
  383. return codec_data->cable_status;
  384. } else if (!codec_data->cable_status) {
  385. dev_err_ratelimited(dai->dev,
  386. "%s() ext disp cable is not connected (ret val = %d)\n",
  387. __func__, codec_data->cable_status);
  388. return -ENODEV;
  389. }
  390. /*refer to HDMI spec CEA-861-E: Table 28 Audio InfoFrame Data Byte 4*/
  391. switch (num_channels) {
  392. case 2:
  393. channel_allocation = 0;
  394. break;
  395. case 3:
  396. channel_allocation = 0x02;/*default to FL/FR/FC*/
  397. audio_setup_params.sample_present = 0x3;
  398. break;
  399. case 4:
  400. channel_allocation = 0x06;/*default to FL/FR/FC/RC*/
  401. audio_setup_params.sample_present = 0x7;
  402. break;
  403. case 5:
  404. channel_allocation = 0x0A;/*default to FL/FR/FC/RR/RL*/
  405. audio_setup_params.sample_present = 0x7;
  406. break;
  407. case 6:
  408. channel_allocation = 0x0B;
  409. audio_setup_params.sample_present = 0x7;
  410. break;
  411. case 7:
  412. channel_allocation = 0x12;/*default to FL/FR/FC/RL/RR/RRC/RLC*/
  413. audio_setup_params.sample_present = 0xf;
  414. break;
  415. case 8:
  416. channel_allocation = 0x13;
  417. audio_setup_params.sample_present = 0xf;
  418. break;
  419. default:
  420. dev_err(dai->dev, "invalid Channels = %u\n", num_channels);
  421. return -EINVAL;
  422. }
  423. dev_dbg(dai->dev,
  424. "%s() num_ch %u samplerate %u channel_allocation = %u\n",
  425. __func__, num_channels, params_rate(params),
  426. channel_allocation);
  427. audio_setup_params.sample_rate_hz = params_rate(params);
  428. audio_setup_params.num_of_channels = num_channels;
  429. audio_setup_params.channel_allocation = channel_allocation;
  430. audio_setup_params.level_shift = level_shift;
  431. audio_setup_params.down_mix = down_mix;
  432. mutex_lock(&codec_data->dp_ops_lock);
  433. SWITCH_DP_CODEC(codec_info, codec_data, dai->id);
  434. rc = codec_data->ext_disp_ops.audio_info_setup(
  435. codec_data->ext_disp_core_pdev, &audio_setup_params);
  436. mutex_unlock(&codec_data->dp_ops_lock);
  437. if (rc < 0) {
  438. dev_err_ratelimited(dai->dev,
  439. "%s() ext disp core is not ready, rc: %d\n",
  440. __func__, rc);
  441. }
  442. return rc;
  443. }
  444. static void msm_ext_disp_audio_codec_rx_dai_shutdown(
  445. struct snd_pcm_substream *substream,
  446. struct snd_soc_dai *dai)
  447. {
  448. int rc = 0;
  449. struct msm_ext_disp_codec_id codec_info;
  450. struct msm_ext_disp_audio_codec_rx_data *codec_data =
  451. dev_get_drvdata(dai->codec->dev);
  452. if (!codec_data || !codec_data->ext_disp_ops.teardown_done ||
  453. !codec_data->ext_disp_ops.cable_status) {
  454. dev_err(dai->dev, "%s: codec data or teardown_done or cable_status is null\n",
  455. __func__);
  456. return;
  457. }
  458. dev_dbg(dai->codec->dev, "%s: DP ctl id %d Stream id %d\n", __func__,
  459. codec_data->ctl[dai->id], codec_data->stream[dai->id]);
  460. mutex_lock(&codec_data->dp_ops_lock);
  461. SWITCH_DP_CODEC(codec_info, codec_data, dai->id);
  462. rc = codec_data->ext_disp_ops.cable_status(
  463. codec_data->ext_disp_core_pdev, 0);
  464. if (rc < 0) {
  465. dev_err(dai->dev,
  466. "%s: ext disp core had problems releasing audio flag\n",
  467. __func__);
  468. }
  469. codec_data->ext_disp_ops.teardown_done(
  470. codec_data->ext_disp_core_pdev);
  471. mutex_unlock(&codec_data->dp_ops_lock);
  472. }
  473. static int msm_ext_disp_audio_codec_rx_probe(struct snd_soc_codec *codec)
  474. {
  475. struct msm_ext_disp_audio_codec_rx_data *codec_data;
  476. struct device_node *of_node_parent = NULL;
  477. codec_data = kzalloc(sizeof(struct msm_ext_disp_audio_codec_rx_data),
  478. GFP_KERNEL);
  479. if (!codec_data) {
  480. dev_err(codec->dev, "%s(): fail to allocate dai data\n",
  481. __func__);
  482. return -ENOMEM;
  483. }
  484. of_node_parent = of_get_parent(codec->dev->of_node);
  485. if (!of_node_parent) {
  486. dev_err(codec->dev, "%s(): Parent device tree node not found\n",
  487. __func__);
  488. kfree(codec_data);
  489. return -ENODEV;
  490. }
  491. codec_data->ext_disp_core_pdev = of_find_device_by_node(of_node_parent);
  492. if (!codec_data->ext_disp_core_pdev) {
  493. dev_err(codec->dev, "%s(): can't get parent pdev\n", __func__);
  494. kfree(codec_data);
  495. return -ENODEV;
  496. }
  497. if (msm_ext_disp_register_audio_codec(codec_data->ext_disp_core_pdev,
  498. &codec_data->ext_disp_ops)) {
  499. dev_err(codec->dev, "%s(): can't register with ext disp core",
  500. __func__);
  501. kfree(codec_data);
  502. return -ENODEV;
  503. }
  504. mutex_init(&codec_data->dp_ops_lock);
  505. dev_set_drvdata(codec->dev, codec_data);
  506. dev_dbg(codec->dev, "%s(): registered %s with ext disp core\n",
  507. __func__, codec->component.name);
  508. return 0;
  509. }
  510. static int msm_ext_disp_audio_codec_rx_remove(struct snd_soc_codec *codec)
  511. {
  512. struct msm_ext_disp_audio_codec_rx_data *codec_data;
  513. codec_data = dev_get_drvdata(codec->dev);
  514. mutex_destroy(&codec_data->dp_ops_lock);
  515. kfree(codec_data);
  516. return 0;
  517. }
  518. static struct snd_soc_dai_ops msm_ext_disp_audio_codec_rx_dai_ops = {
  519. .startup = msm_ext_disp_audio_codec_rx_dai_startup,
  520. .hw_params = msm_ext_disp_audio_codec_rx_dai_hw_params,
  521. .shutdown = msm_ext_disp_audio_codec_rx_dai_shutdown
  522. };
  523. static struct snd_soc_dai_driver msm_ext_disp_audio_codec_rx_dais[] = {
  524. {
  525. .name = "msm_hdmi_audio_codec_rx_dai",
  526. .id = HDMI_DAI,
  527. .playback = {
  528. .stream_name = "HDMI Playback",
  529. .channels_min = 1,
  530. .channels_max = 8,
  531. .rate_min = 48000,
  532. .rate_max = 48000,
  533. .rates = MSM_EXT_DISP_PCM_RATES,
  534. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  535. },
  536. .ops = &msm_ext_disp_audio_codec_rx_dai_ops,
  537. },
  538. {
  539. .name = "msm_dp_audio_codec_rx_dai",
  540. .id = DP_DAI1,
  541. .playback = {
  542. .stream_name = "Display Port Playback",
  543. .channels_min = 1,
  544. .channels_max = 8,
  545. .rate_min = 48000,
  546. .rate_max = 192000,
  547. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  548. SNDRV_PCM_RATE_192000,
  549. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  550. SNDRV_PCM_FMTBIT_S24_LE |
  551. SNDRV_PCM_FMTBIT_S24_3LE,
  552. },
  553. .ops = &msm_ext_disp_audio_codec_rx_dai_ops,
  554. },
  555. {
  556. .name = "msm_dp_audio_codec_rx1_dai",
  557. .id = DP_DAI2,
  558. .playback = {
  559. .stream_name = "Display Port1 Playback",
  560. .channels_min = 1,
  561. .channels_max = 8,
  562. .rate_min = 48000,
  563. .rate_max = 192000,
  564. .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 |
  565. SNDRV_PCM_RATE_192000,
  566. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  567. SNDRV_PCM_FMTBIT_S24_LE |
  568. SNDRV_PCM_FMTBIT_S24_3LE,
  569. },
  570. .ops = &msm_ext_disp_audio_codec_rx_dai_ops,
  571. },
  572. };
  573. static struct snd_soc_codec_driver msm_ext_disp_audio_codec_rx_soc_driver = {
  574. .probe = msm_ext_disp_audio_codec_rx_probe,
  575. .remove = msm_ext_disp_audio_codec_rx_remove,
  576. .component_driver = {
  577. .controls = msm_ext_disp_codec_rx_controls,
  578. .num_controls = ARRAY_SIZE(msm_ext_disp_codec_rx_controls),
  579. },
  580. };
  581. static int msm_ext_disp_audio_codec_rx_plat_probe(
  582. struct platform_device *pdev)
  583. {
  584. dev_dbg(&pdev->dev, "%s(): dev name %s\n", __func__,
  585. dev_name(&pdev->dev));
  586. return snd_soc_register_codec(&pdev->dev,
  587. &msm_ext_disp_audio_codec_rx_soc_driver,
  588. msm_ext_disp_audio_codec_rx_dais,
  589. ARRAY_SIZE(msm_ext_disp_audio_codec_rx_dais));
  590. }
  591. static int msm_ext_disp_audio_codec_rx_plat_remove(
  592. struct platform_device *pdev)
  593. {
  594. snd_soc_unregister_codec(&pdev->dev);
  595. return 0;
  596. }
  597. static const struct of_device_id msm_ext_disp_audio_codec_rx_dt_match[] = {
  598. { .compatible = "qcom,msm-ext-disp-audio-codec-rx", },
  599. {}
  600. };
  601. MODULE_DEVICE_TABLE(of, msm_ext_disp_audio_codec_rx_dt_match);
  602. static struct platform_driver msm_ext_disp_audio_codec_rx_driver = {
  603. .driver = {
  604. .name = "msm-ext-disp-audio-codec-rx",
  605. .owner = THIS_MODULE,
  606. .of_match_table = msm_ext_disp_audio_codec_rx_dt_match,
  607. },
  608. .probe = msm_ext_disp_audio_codec_rx_plat_probe,
  609. .remove = msm_ext_disp_audio_codec_rx_plat_remove,
  610. };
  611. static int __init msm_ext_disp_audio_codec_rx_init(void)
  612. {
  613. int rc = 0;
  614. rc = platform_driver_register(&msm_ext_disp_audio_codec_rx_driver);
  615. if (rc) {
  616. pr_err("%s: failed to register ext disp codec driver err:%d\n",
  617. __func__, rc);
  618. }
  619. return rc;
  620. }
  621. module_init(msm_ext_disp_audio_codec_rx_init);
  622. static void __exit msm_ext_disp_audio_codec_rx_exit(void)
  623. {
  624. platform_driver_unregister(&msm_ext_disp_audio_codec_rx_driver);
  625. }
  626. module_exit(msm_ext_disp_audio_codec_rx_exit);
  627. MODULE_DESCRIPTION("MSM External Display Audio CODEC Driver");
  628. MODULE_LICENSE("GPL v2");