dp_audio.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2022-2023, Qualcomm Innovation Center, Inc. All rights reserved.
  4. * Copyright (c) 2016-2021, The Linux Foundation. All rights reserved.
  5. */
  6. #include <linux/of_platform.h>
  7. #include <linux/soc/qcom/msm_ext_display.h>
  8. #include <linux/version.h>
  9. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0))
  10. #include <drm/display/drm_dp_helper.h>
  11. #else
  12. #include <drm/drm_dp_helper.h>
  13. #endif
  14. #include "dp_catalog.h"
  15. #include "dp_audio.h"
  16. #include "dp_panel.h"
  17. #include "dp_debug.h"
  18. struct dp_audio_private {
  19. struct platform_device *ext_pdev;
  20. struct platform_device *pdev;
  21. struct dp_catalog_audio *catalog;
  22. struct msm_ext_disp_init_data ext_audio_data;
  23. struct dp_panel *panel;
  24. bool ack_enabled;
  25. atomic_t session_on;
  26. bool engine_on;
  27. u32 channels;
  28. struct completion hpd_comp;
  29. struct workqueue_struct *notify_workqueue;
  30. struct delayed_work notify_delayed_work;
  31. struct mutex ops_lock;
  32. struct dp_audio dp_audio;
  33. atomic_t acked;
  34. };
  35. static u32 dp_audio_get_header(struct dp_catalog_audio *catalog,
  36. enum dp_catalog_audio_sdp_type sdp,
  37. enum dp_catalog_audio_header_type header)
  38. {
  39. catalog->sdp_type = sdp;
  40. catalog->sdp_header = header;
  41. catalog->get_header(catalog);
  42. return catalog->data;
  43. }
  44. static void dp_audio_set_header(struct dp_catalog_audio *catalog,
  45. u32 data,
  46. enum dp_catalog_audio_sdp_type sdp,
  47. enum dp_catalog_audio_header_type header)
  48. {
  49. catalog->sdp_type = sdp;
  50. catalog->sdp_header = header;
  51. catalog->data = data;
  52. catalog->set_header(catalog);
  53. }
  54. static void dp_audio_stream_sdp(struct dp_audio_private *audio)
  55. {
  56. struct dp_catalog_audio *catalog = audio->catalog;
  57. u32 value, new_value;
  58. u8 parity_byte;
  59. /* Config header and parity byte 1 */
  60. value = dp_audio_get_header(catalog,
  61. DP_AUDIO_SDP_STREAM, DP_AUDIO_SDP_HEADER_1);
  62. value &= 0x0000ffff;
  63. new_value = 0x02;
  64. parity_byte = dp_header_get_parity(new_value);
  65. value |= ((new_value << HEADER_BYTE_1_BIT)
  66. | (parity_byte << PARITY_BYTE_1_BIT));
  67. DP_DEBUG("Header Byte 1: value = 0x%x, parity_byte = 0x%x\n",
  68. value, parity_byte);
  69. dp_audio_set_header(catalog, value,
  70. DP_AUDIO_SDP_STREAM, DP_AUDIO_SDP_HEADER_1);
  71. /* Config header and parity byte 2 */
  72. value = dp_audio_get_header(catalog,
  73. DP_AUDIO_SDP_STREAM, DP_AUDIO_SDP_HEADER_2);
  74. value &= 0xffff0000;
  75. new_value = 0x0;
  76. parity_byte = dp_header_get_parity(new_value);
  77. value |= ((new_value << HEADER_BYTE_2_BIT)
  78. | (parity_byte << PARITY_BYTE_2_BIT));
  79. DP_DEBUG("Header Byte 2: value = 0x%x, parity_byte = 0x%x\n",
  80. value, parity_byte);
  81. dp_audio_set_header(catalog, value,
  82. DP_AUDIO_SDP_STREAM, DP_AUDIO_SDP_HEADER_2);
  83. /* Config header and parity byte 3 */
  84. value = dp_audio_get_header(catalog,
  85. DP_AUDIO_SDP_STREAM, DP_AUDIO_SDP_HEADER_3);
  86. value &= 0x0000ffff;
  87. new_value = audio->channels - 1;
  88. parity_byte = dp_header_get_parity(new_value);
  89. value |= ((new_value << HEADER_BYTE_3_BIT)
  90. | (parity_byte << PARITY_BYTE_3_BIT));
  91. DP_DEBUG("Header Byte 3: value = 0x%x, parity_byte = 0x%x\n",
  92. value, parity_byte);
  93. dp_audio_set_header(catalog, value,
  94. DP_AUDIO_SDP_STREAM, DP_AUDIO_SDP_HEADER_3);
  95. }
  96. static void dp_audio_timestamp_sdp(struct dp_audio_private *audio)
  97. {
  98. struct dp_catalog_audio *catalog = audio->catalog;
  99. u32 value, new_value;
  100. u8 parity_byte;
  101. /* Config header and parity byte 1 */
  102. value = dp_audio_get_header(catalog,
  103. DP_AUDIO_SDP_TIMESTAMP, DP_AUDIO_SDP_HEADER_1);
  104. value &= 0x0000ffff;
  105. new_value = 0x1;
  106. parity_byte = dp_header_get_parity(new_value);
  107. value |= ((new_value << HEADER_BYTE_1_BIT)
  108. | (parity_byte << PARITY_BYTE_1_BIT));
  109. DP_DEBUG("Header Byte 1: value = 0x%x, parity_byte = 0x%x\n",
  110. value, parity_byte);
  111. dp_audio_set_header(catalog, value,
  112. DP_AUDIO_SDP_TIMESTAMP, DP_AUDIO_SDP_HEADER_1);
  113. /* Config header and parity byte 2 */
  114. value = dp_audio_get_header(catalog,
  115. DP_AUDIO_SDP_TIMESTAMP, DP_AUDIO_SDP_HEADER_2);
  116. value &= 0xffff0000;
  117. new_value = 0x17;
  118. parity_byte = dp_header_get_parity(new_value);
  119. value |= ((new_value << HEADER_BYTE_2_BIT)
  120. | (parity_byte << PARITY_BYTE_2_BIT));
  121. DP_DEBUG("Header Byte 2: value = 0x%x, parity_byte = 0x%x\n",
  122. value, parity_byte);
  123. dp_audio_set_header(catalog, value,
  124. DP_AUDIO_SDP_TIMESTAMP, DP_AUDIO_SDP_HEADER_2);
  125. /* Config header and parity byte 3 */
  126. value = dp_audio_get_header(catalog,
  127. DP_AUDIO_SDP_TIMESTAMP, DP_AUDIO_SDP_HEADER_3);
  128. value &= 0x0000ffff;
  129. new_value = (0x0 | (0x11 << 2));
  130. parity_byte = dp_header_get_parity(new_value);
  131. value |= ((new_value << HEADER_BYTE_3_BIT)
  132. | (parity_byte << PARITY_BYTE_3_BIT));
  133. DP_DEBUG("Header Byte 3: value = 0x%x, parity_byte = 0x%x\n",
  134. value, parity_byte);
  135. dp_audio_set_header(catalog, value,
  136. DP_AUDIO_SDP_TIMESTAMP, DP_AUDIO_SDP_HEADER_3);
  137. }
  138. static void dp_audio_infoframe_sdp(struct dp_audio_private *audio)
  139. {
  140. struct dp_catalog_audio *catalog = audio->catalog;
  141. u32 value, new_value;
  142. u8 parity_byte;
  143. /* Config header and parity byte 1 */
  144. value = dp_audio_get_header(catalog,
  145. DP_AUDIO_SDP_INFOFRAME, DP_AUDIO_SDP_HEADER_1);
  146. value &= 0x0000ffff;
  147. new_value = 0x84;
  148. parity_byte = dp_header_get_parity(new_value);
  149. value |= ((new_value << HEADER_BYTE_1_BIT)
  150. | (parity_byte << PARITY_BYTE_1_BIT));
  151. DP_DEBUG("Header Byte 1: value = 0x%x, parity_byte = 0x%x\n",
  152. value, parity_byte);
  153. dp_audio_set_header(catalog, value,
  154. DP_AUDIO_SDP_INFOFRAME, DP_AUDIO_SDP_HEADER_1);
  155. /* Config header and parity byte 2 */
  156. value = dp_audio_get_header(catalog,
  157. DP_AUDIO_SDP_INFOFRAME, DP_AUDIO_SDP_HEADER_2);
  158. value &= 0xffff0000;
  159. new_value = 0x1b;
  160. parity_byte = dp_header_get_parity(new_value);
  161. value |= ((new_value << HEADER_BYTE_2_BIT)
  162. | (parity_byte << PARITY_BYTE_2_BIT));
  163. DP_DEBUG("Header Byte 2: value = 0x%x, parity_byte = 0x%x\n",
  164. value, parity_byte);
  165. dp_audio_set_header(catalog, value,
  166. DP_AUDIO_SDP_INFOFRAME, DP_AUDIO_SDP_HEADER_2);
  167. /* Config header and parity byte 3 */
  168. value = dp_audio_get_header(catalog,
  169. DP_AUDIO_SDP_INFOFRAME, DP_AUDIO_SDP_HEADER_3);
  170. value &= 0x0000ffff;
  171. new_value = (0x0 | (0x11 << 2));
  172. parity_byte = dp_header_get_parity(new_value);
  173. value |= ((new_value << HEADER_BYTE_3_BIT)
  174. | (parity_byte << PARITY_BYTE_3_BIT));
  175. DP_DEBUG("Header Byte 3: value = 0x%x, parity_byte = 0x%x\n",
  176. new_value, parity_byte);
  177. dp_audio_set_header(catalog, value,
  178. DP_AUDIO_SDP_INFOFRAME, DP_AUDIO_SDP_HEADER_3);
  179. }
  180. static void dp_audio_copy_management_sdp(struct dp_audio_private *audio)
  181. {
  182. struct dp_catalog_audio *catalog = audio->catalog;
  183. u32 value, new_value;
  184. u8 parity_byte;
  185. /* Config header and parity byte 1 */
  186. value = dp_audio_get_header(catalog,
  187. DP_AUDIO_SDP_COPYMANAGEMENT, DP_AUDIO_SDP_HEADER_1);
  188. value &= 0x0000ffff;
  189. new_value = 0x05;
  190. parity_byte = dp_header_get_parity(new_value);
  191. value |= ((new_value << HEADER_BYTE_1_BIT)
  192. | (parity_byte << PARITY_BYTE_1_BIT));
  193. DP_DEBUG("Header Byte 1: value = 0x%x, parity_byte = 0x%x\n",
  194. value, parity_byte);
  195. dp_audio_set_header(catalog, value,
  196. DP_AUDIO_SDP_COPYMANAGEMENT, DP_AUDIO_SDP_HEADER_1);
  197. /* Config header and parity byte 2 */
  198. value = dp_audio_get_header(catalog,
  199. DP_AUDIO_SDP_COPYMANAGEMENT, DP_AUDIO_SDP_HEADER_2);
  200. value &= 0xffff0000;
  201. new_value = 0x0F;
  202. parity_byte = dp_header_get_parity(new_value);
  203. value |= ((new_value << HEADER_BYTE_2_BIT)
  204. | (parity_byte << PARITY_BYTE_2_BIT));
  205. DP_DEBUG("Header Byte 2: value = 0x%x, parity_byte = 0x%x\n",
  206. value, parity_byte);
  207. dp_audio_set_header(catalog, value,
  208. DP_AUDIO_SDP_COPYMANAGEMENT, DP_AUDIO_SDP_HEADER_2);
  209. /* Config header and parity byte 3 */
  210. value = dp_audio_get_header(catalog,
  211. DP_AUDIO_SDP_COPYMANAGEMENT, DP_AUDIO_SDP_HEADER_3);
  212. value &= 0x0000ffff;
  213. new_value = 0x0;
  214. parity_byte = dp_header_get_parity(new_value);
  215. value |= ((new_value << HEADER_BYTE_3_BIT)
  216. | (parity_byte << PARITY_BYTE_3_BIT));
  217. DP_DEBUG("Header Byte 3: value = 0x%x, parity_byte = 0x%x\n",
  218. value, parity_byte);
  219. dp_audio_set_header(catalog, value,
  220. DP_AUDIO_SDP_COPYMANAGEMENT, DP_AUDIO_SDP_HEADER_3);
  221. }
  222. static void dp_audio_isrc_sdp(struct dp_audio_private *audio)
  223. {
  224. struct dp_catalog_audio *catalog = audio->catalog;
  225. u32 value, new_value;
  226. u8 parity_byte;
  227. /* Config header and parity byte 1 */
  228. value = dp_audio_get_header(catalog,
  229. DP_AUDIO_SDP_ISRC, DP_AUDIO_SDP_HEADER_1);
  230. value &= 0x0000ffff;
  231. new_value = 0x06;
  232. parity_byte = dp_header_get_parity(new_value);
  233. value |= ((new_value << HEADER_BYTE_1_BIT)
  234. | (parity_byte << PARITY_BYTE_1_BIT));
  235. DP_DEBUG("Header Byte 1: value = 0x%x, parity_byte = 0x%x\n",
  236. value, parity_byte);
  237. dp_audio_set_header(catalog, value,
  238. DP_AUDIO_SDP_ISRC, DP_AUDIO_SDP_HEADER_1);
  239. /* Config header and parity byte 2 */
  240. value = dp_audio_get_header(catalog,
  241. DP_AUDIO_SDP_ISRC, DP_AUDIO_SDP_HEADER_2);
  242. value &= 0xffff0000;
  243. new_value = 0x0F;
  244. parity_byte = dp_header_get_parity(new_value);
  245. value |= ((new_value << HEADER_BYTE_2_BIT)
  246. | (parity_byte << PARITY_BYTE_2_BIT));
  247. DP_DEBUG("Header Byte 2: value = 0x%x, parity_byte = 0x%x\n",
  248. value, parity_byte);
  249. dp_audio_set_header(catalog, value,
  250. DP_AUDIO_SDP_ISRC, DP_AUDIO_SDP_HEADER_2);
  251. }
  252. static void dp_audio_setup_sdp(struct dp_audio_private *audio)
  253. {
  254. if (!atomic_read(&audio->session_on)) {
  255. DP_WARN("session inactive\n");
  256. return;
  257. }
  258. /* always program stream 0 first before actual stream cfg */
  259. audio->catalog->stream_id = DP_STREAM_0;
  260. audio->catalog->config_sdp(audio->catalog);
  261. if (audio->panel->stream_id == DP_STREAM_1) {
  262. audio->catalog->stream_id = DP_STREAM_1;
  263. audio->catalog->config_sdp(audio->catalog);
  264. }
  265. dp_audio_stream_sdp(audio);
  266. dp_audio_timestamp_sdp(audio);
  267. dp_audio_infoframe_sdp(audio);
  268. dp_audio_copy_management_sdp(audio);
  269. dp_audio_isrc_sdp(audio);
  270. }
  271. static void dp_audio_setup_acr(struct dp_audio_private *audio)
  272. {
  273. u32 select = 0;
  274. struct dp_catalog_audio *catalog = audio->catalog;
  275. if (!atomic_read(&audio->session_on)) {
  276. DP_WARN("session inactive\n");
  277. return;
  278. }
  279. switch (audio->dp_audio.bw_code) {
  280. case DP_LINK_BW_1_62:
  281. select = 0;
  282. break;
  283. case DP_LINK_BW_2_7:
  284. select = 1;
  285. break;
  286. case DP_LINK_BW_5_4:
  287. select = 2;
  288. break;
  289. case DP_LINK_BW_8_1:
  290. select = 3;
  291. break;
  292. default:
  293. DP_DEBUG("Unknown link rate\n");
  294. select = 0;
  295. break;
  296. }
  297. catalog->data = select;
  298. catalog->config_acr(catalog);
  299. }
  300. static void dp_audio_enable(struct dp_audio_private *audio, bool enable)
  301. {
  302. struct dp_catalog_audio *catalog = audio->catalog;
  303. audio->engine_on = enable;
  304. if (!atomic_read(&audio->session_on)) {
  305. DP_WARN("session inactive. enable=%d\n", enable);
  306. return;
  307. }
  308. catalog->data = enable;
  309. if (audio->panel->get_panel_on(audio->panel))
  310. catalog->enable(catalog);
  311. }
  312. static struct dp_audio_private *dp_audio_get_data(struct platform_device *pdev)
  313. {
  314. struct msm_ext_disp_data *ext_data;
  315. struct dp_audio *dp_audio;
  316. if (!pdev) {
  317. DP_ERR("invalid input\n");
  318. return ERR_PTR(-ENODEV);
  319. }
  320. ext_data = platform_get_drvdata(pdev);
  321. if (!ext_data) {
  322. DP_ERR("invalid ext disp data\n");
  323. return ERR_PTR(-EINVAL);
  324. }
  325. dp_audio = ext_data->intf_data;
  326. if (!dp_audio) {
  327. DP_ERR("invalid intf data\n");
  328. return ERR_PTR(-EINVAL);
  329. }
  330. return container_of(dp_audio, struct dp_audio_private, dp_audio);
  331. }
  332. static int dp_audio_info_setup(struct platform_device *pdev,
  333. struct msm_ext_disp_audio_setup_params *params)
  334. {
  335. int rc = 0;
  336. struct dp_audio_private *audio;
  337. audio = dp_audio_get_data(pdev);
  338. if (IS_ERR(audio)) {
  339. rc = PTR_ERR(audio);
  340. return rc;
  341. }
  342. if (audio->dp_audio.tui_active) {
  343. DP_DEBUG("TUI session active\n");
  344. return 0;
  345. }
  346. mutex_lock(&audio->ops_lock);
  347. audio->channels = params->num_of_channels;
  348. if (audio->panel->stream_id >= DP_STREAM_MAX) {
  349. DP_ERR("invalid stream id: %d\n",
  350. audio->panel->stream_id);
  351. rc = -EINVAL;
  352. mutex_unlock(&audio->ops_lock);
  353. return rc;
  354. }
  355. dp_audio_setup_sdp(audio);
  356. dp_audio_setup_acr(audio);
  357. dp_audio_enable(audio, true);
  358. mutex_unlock(&audio->ops_lock);
  359. DP_DEBUG("audio stream configured\n");
  360. return rc;
  361. }
  362. static int dp_audio_get_edid_blk(struct platform_device *pdev,
  363. struct msm_ext_disp_audio_edid_blk *blk)
  364. {
  365. int rc = 0;
  366. struct dp_audio_private *audio;
  367. struct sde_edid_ctrl *edid;
  368. if (!blk) {
  369. DP_ERR("invalid input\n");
  370. return -EINVAL;
  371. }
  372. audio = dp_audio_get_data(pdev);
  373. if (IS_ERR(audio)) {
  374. rc = PTR_ERR(audio);
  375. goto end;
  376. }
  377. if (!audio->panel || !audio->panel->edid_ctrl) {
  378. DP_ERR("invalid panel data\n");
  379. rc = -EINVAL;
  380. goto end;
  381. }
  382. edid = audio->panel->edid_ctrl;
  383. blk->audio_data_blk = edid->audio_data_block;
  384. blk->audio_data_blk_size = edid->adb_size;
  385. blk->spk_alloc_data_blk = edid->spkr_alloc_data_block;
  386. blk->spk_alloc_data_blk_size = edid->sadb_size;
  387. end:
  388. return rc;
  389. }
  390. static int dp_audio_get_cable_status(struct platform_device *pdev, u32 vote)
  391. {
  392. int rc = 0;
  393. struct dp_audio_private *audio;
  394. audio = dp_audio_get_data(pdev);
  395. if (IS_ERR(audio)) {
  396. rc = PTR_ERR(audio);
  397. goto end;
  398. }
  399. return atomic_read(&audio->session_on);
  400. end:
  401. return rc;
  402. }
  403. static int dp_audio_get_intf_id(struct platform_device *pdev)
  404. {
  405. int rc = 0;
  406. struct dp_audio_private *audio;
  407. audio = dp_audio_get_data(pdev);
  408. if (IS_ERR(audio)) {
  409. rc = PTR_ERR(audio);
  410. goto end;
  411. }
  412. return EXT_DISPLAY_TYPE_DP;
  413. end:
  414. return rc;
  415. }
  416. static void dp_audio_teardown_done(struct platform_device *pdev)
  417. {
  418. struct dp_audio_private *audio;
  419. audio = dp_audio_get_data(pdev);
  420. if (IS_ERR(audio))
  421. return;
  422. if (audio->dp_audio.tui_active) {
  423. DP_DEBUG("TUI session active\n");
  424. return;
  425. }
  426. if (audio->panel->stream_id >= DP_STREAM_MAX) {
  427. DP_WARN("invalid stream id: %d\n",
  428. audio->panel->stream_id);
  429. return;
  430. }
  431. mutex_lock(&audio->ops_lock);
  432. dp_audio_enable(audio, false);
  433. mutex_unlock(&audio->ops_lock);
  434. atomic_set(&audio->acked, 1);
  435. complete_all(&audio->hpd_comp);
  436. DP_DEBUG("audio engine disabled\n");
  437. }
  438. static int dp_audio_ack_done(struct platform_device *pdev, u32 ack)
  439. {
  440. int rc = 0, ack_hpd;
  441. struct dp_audio_private *audio;
  442. audio = dp_audio_get_data(pdev);
  443. if (IS_ERR(audio)) {
  444. rc = PTR_ERR(audio);
  445. goto end;
  446. }
  447. if (ack & AUDIO_ACK_SET_ENABLE) {
  448. audio->ack_enabled = ack & AUDIO_ACK_ENABLE ?
  449. true : false;
  450. DP_DEBUG("audio ack feature %s\n",
  451. audio->ack_enabled ? "enabled" : "disabled");
  452. goto end;
  453. }
  454. if (!audio->ack_enabled)
  455. goto end;
  456. ack_hpd = ack & AUDIO_ACK_CONNECT;
  457. DP_DEBUG("acknowledging audio (%d)\n", ack_hpd);
  458. if (!audio->engine_on) {
  459. atomic_set(&audio->acked, 1);
  460. complete_all(&audio->hpd_comp);
  461. }
  462. end:
  463. return rc;
  464. }
  465. static int dp_audio_codec_ready(struct platform_device *pdev)
  466. {
  467. int rc = 0;
  468. struct dp_audio_private *audio;
  469. audio = dp_audio_get_data(pdev);
  470. if (IS_ERR(audio)) {
  471. DP_ERR("invalid input\n");
  472. rc = PTR_ERR(audio);
  473. goto end;
  474. }
  475. queue_delayed_work(audio->notify_workqueue,
  476. &audio->notify_delayed_work, HZ/4);
  477. end:
  478. return rc;
  479. }
  480. static int dp_audio_register_ext_disp(struct dp_audio_private *audio)
  481. {
  482. int rc = 0;
  483. struct device_node *pd = NULL;
  484. const char *phandle = "qcom,ext-disp";
  485. struct msm_ext_disp_init_data *ext;
  486. struct msm_ext_disp_audio_codec_ops *ops;
  487. ext = &audio->ext_audio_data;
  488. ops = &ext->codec_ops;
  489. ext->codec.type = EXT_DISPLAY_TYPE_DP;
  490. ext->codec.ctrl_id = 0;
  491. ext->codec.stream_id = audio->panel->stream_id;
  492. ext->pdev = audio->pdev;
  493. ext->intf_data = &audio->dp_audio;
  494. ops->audio_info_setup = dp_audio_info_setup;
  495. ops->get_audio_edid_blk = dp_audio_get_edid_blk;
  496. ops->cable_status = dp_audio_get_cable_status;
  497. ops->get_intf_id = dp_audio_get_intf_id;
  498. ops->teardown_done = dp_audio_teardown_done;
  499. ops->acknowledge = dp_audio_ack_done;
  500. ops->ready = dp_audio_codec_ready;
  501. if (!audio->pdev->dev.of_node) {
  502. DP_ERR("cannot find audio dev.of_node\n");
  503. rc = -ENODEV;
  504. goto end;
  505. }
  506. pd = of_parse_phandle(audio->pdev->dev.of_node, phandle, 0);
  507. if (!pd) {
  508. DP_ERR("cannot parse %s handle\n", phandle);
  509. rc = -ENODEV;
  510. goto end;
  511. }
  512. audio->ext_pdev = of_find_device_by_node(pd);
  513. if (!audio->ext_pdev) {
  514. DP_ERR("cannot find %s pdev\n", phandle);
  515. rc = -ENODEV;
  516. goto end;
  517. }
  518. #if IS_ENABLED(CONFIG_MSM_EXT_DISPLAY)
  519. rc = msm_ext_disp_register_intf(audio->ext_pdev, ext);
  520. if (rc)
  521. DP_ERR("failed to register disp\n");
  522. #endif
  523. end:
  524. if (pd)
  525. of_node_put(pd);
  526. return rc;
  527. }
  528. static int dp_audio_deregister_ext_disp(struct dp_audio_private *audio)
  529. {
  530. int rc = 0;
  531. struct device_node *pd = NULL;
  532. const char *phandle = "qcom,ext-disp";
  533. struct msm_ext_disp_init_data *ext;
  534. ext = &audio->ext_audio_data;
  535. if (!audio->pdev->dev.of_node) {
  536. DP_ERR("cannot find audio dev.of_node\n");
  537. rc = -ENODEV;
  538. goto end;
  539. }
  540. pd = of_parse_phandle(audio->pdev->dev.of_node, phandle, 0);
  541. if (!pd) {
  542. DP_ERR("cannot parse %s handle\n", phandle);
  543. rc = -ENODEV;
  544. goto end;
  545. }
  546. audio->ext_pdev = of_find_device_by_node(pd);
  547. if (!audio->ext_pdev) {
  548. DP_ERR("cannot find %s pdev\n", phandle);
  549. rc = -ENODEV;
  550. goto end;
  551. }
  552. #if IS_ENABLED(CONFIG_MSM_EXT_DISPLAY)
  553. rc = msm_ext_disp_deregister_intf(audio->ext_pdev, ext);
  554. if (rc)
  555. DP_ERR("failed to deregister disp\n");
  556. #endif
  557. end:
  558. return rc;
  559. }
  560. static int dp_audio_notify(struct dp_audio_private *audio, u32 state)
  561. {
  562. int rc = 0;
  563. struct msm_ext_disp_init_data *ext = &audio->ext_audio_data;
  564. atomic_set(&audio->acked, 0);
  565. if (!ext->intf_ops.audio_notify) {
  566. DP_ERR("audio notify not defined\n");
  567. goto end;
  568. }
  569. reinit_completion(&audio->hpd_comp);
  570. rc = ext->intf_ops.audio_notify(audio->ext_pdev,
  571. &ext->codec, state);
  572. if (rc)
  573. goto end;
  574. if (atomic_read(&audio->acked))
  575. goto end;
  576. if (state == EXT_DISPLAY_CABLE_DISCONNECT && !audio->engine_on)
  577. goto end;
  578. if (state == EXT_DISPLAY_CABLE_CONNECT)
  579. goto end;
  580. rc = wait_for_completion_timeout(&audio->hpd_comp, HZ * 4);
  581. if (!rc) {
  582. DP_ERR("timeout. state=%d err=%d\n", state, rc);
  583. rc = -ETIMEDOUT;
  584. goto end;
  585. }
  586. DP_DEBUG("success\n");
  587. end:
  588. return rc;
  589. }
  590. static int dp_audio_config(struct dp_audio_private *audio, u32 state)
  591. {
  592. int rc = 0;
  593. struct msm_ext_disp_init_data *ext = &audio->ext_audio_data;
  594. if (!ext || !ext->intf_ops.audio_config) {
  595. DP_ERR("audio_config not defined\n");
  596. goto end;
  597. }
  598. /*
  599. * DP Audio sets default STREAM_0 only, other streams are
  600. * set by audio driver based on the hardware/software support.
  601. */
  602. if (audio->panel->stream_id == DP_STREAM_0) {
  603. rc = ext->intf_ops.audio_config(audio->ext_pdev,
  604. &ext->codec, state);
  605. if (rc)
  606. DP_ERR("failed to config audio, err=%d\n",
  607. rc);
  608. }
  609. end:
  610. return rc;
  611. }
  612. static int dp_audio_on(struct dp_audio *dp_audio)
  613. {
  614. int rc = 0;
  615. struct dp_audio_private *audio;
  616. struct msm_ext_disp_init_data *ext;
  617. if (!dp_audio) {
  618. DP_ERR("invalid input\n");
  619. return -EINVAL;
  620. }
  621. audio = container_of(dp_audio, struct dp_audio_private, dp_audio);
  622. if (IS_ERR(audio)) {
  623. DP_ERR("invalid input\n");
  624. return -EINVAL;
  625. }
  626. dp_audio_register_ext_disp(audio);
  627. ext = &audio->ext_audio_data;
  628. atomic_set(&audio->session_on, 1);
  629. rc = dp_audio_config(audio, EXT_DISPLAY_CABLE_CONNECT);
  630. if (rc)
  631. goto end;
  632. rc = dp_audio_notify(audio, EXT_DISPLAY_CABLE_CONNECT);
  633. if (rc)
  634. goto end;
  635. DP_DEBUG("success\n");
  636. end:
  637. return rc;
  638. }
  639. static int dp_audio_off(struct dp_audio *dp_audio, bool skip_wait)
  640. {
  641. int rc = 0;
  642. struct dp_audio_private *audio;
  643. struct msm_ext_disp_init_data *ext;
  644. bool work_pending = false;
  645. if (!dp_audio) {
  646. DP_ERR("invalid input\n");
  647. return -EINVAL;
  648. }
  649. audio = container_of(dp_audio, struct dp_audio_private, dp_audio);
  650. if (!atomic_read(&audio->session_on)) {
  651. DP_DEBUG("audio already off\n");
  652. return rc;
  653. }
  654. ext = &audio->ext_audio_data;
  655. work_pending = cancel_delayed_work_sync(&audio->notify_delayed_work);
  656. if (work_pending)
  657. DP_DEBUG("pending notification work completed\n");
  658. if (!skip_wait) {
  659. rc = dp_audio_notify(audio, EXT_DISPLAY_CABLE_DISCONNECT);
  660. if (rc)
  661. goto end;
  662. }
  663. DP_DEBUG("success\n");
  664. end:
  665. dp_audio_config(audio, EXT_DISPLAY_CABLE_DISCONNECT);
  666. atomic_set(&audio->session_on, 0);
  667. audio->engine_on = false;
  668. dp_audio_deregister_ext_disp(audio);
  669. return rc;
  670. }
  671. static void dp_audio_notify_work_fn(struct work_struct *work)
  672. {
  673. struct dp_audio_private *audio;
  674. struct delayed_work *dw = to_delayed_work(work);
  675. audio = container_of(dw, struct dp_audio_private, notify_delayed_work);
  676. dp_audio_notify(audio, EXT_DISPLAY_CABLE_CONNECT);
  677. }
  678. static int dp_audio_create_notify_workqueue(struct dp_audio_private *audio)
  679. {
  680. audio->notify_workqueue = create_workqueue("sdm_dp_audio_notify");
  681. if (IS_ERR_OR_NULL(audio->notify_workqueue)) {
  682. DP_ERR("Error creating notify_workqueue\n");
  683. return -EPERM;
  684. }
  685. INIT_DELAYED_WORK(&audio->notify_delayed_work, dp_audio_notify_work_fn);
  686. return 0;
  687. }
  688. static void dp_audio_destroy_notify_workqueue(struct dp_audio_private *audio)
  689. {
  690. if (audio->notify_workqueue)
  691. destroy_workqueue(audio->notify_workqueue);
  692. }
  693. struct dp_audio *dp_audio_get(struct platform_device *pdev,
  694. struct dp_panel *panel,
  695. struct dp_catalog_audio *catalog)
  696. {
  697. int rc = 0;
  698. struct dp_audio_private *audio;
  699. struct dp_audio *dp_audio;
  700. if (!pdev || !panel || !catalog) {
  701. DP_ERR("invalid input\n");
  702. rc = -EINVAL;
  703. goto error;
  704. }
  705. audio = devm_kzalloc(&pdev->dev, sizeof(*audio), GFP_KERNEL);
  706. if (!audio) {
  707. rc = -ENOMEM;
  708. goto error;
  709. }
  710. rc = dp_audio_create_notify_workqueue(audio);
  711. if (rc)
  712. goto error_notify_workqueue;
  713. init_completion(&audio->hpd_comp);
  714. audio->pdev = pdev;
  715. audio->panel = panel;
  716. audio->catalog = catalog;
  717. atomic_set(&audio->acked, 0);
  718. dp_audio = &audio->dp_audio;
  719. mutex_init(&audio->ops_lock);
  720. dp_audio->on = dp_audio_on;
  721. dp_audio->off = dp_audio_off;
  722. catalog->init(catalog);
  723. return dp_audio;
  724. error_notify_workqueue:
  725. devm_kfree(&pdev->dev, audio);
  726. error:
  727. return ERR_PTR(rc);
  728. }
  729. void dp_audio_put(struct dp_audio *dp_audio)
  730. {
  731. struct dp_audio_private *audio;
  732. if (!dp_audio)
  733. return;
  734. audio = container_of(dp_audio, struct dp_audio_private, dp_audio);
  735. mutex_destroy(&audio->ops_lock);
  736. dp_audio_destroy_notify_workqueue(audio);
  737. devm_kfree(&audio->pdev->dev, audio);
  738. }