msm_vidc.c 26 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2020-2021, The Linux Foundation. All rights reserved.
  4. */
  5. /* Copyright (c) 2022-2023. Qualcomm Innovation Center, Inc. All rights reserved. */
  6. #include <linux/types.h>
  7. #include <linux/hash.h>
  8. #include "msm_vidc_core.h"
  9. #include "msm_vidc_inst.h"
  10. #include "msm_vdec.h"
  11. #include "msm_venc.h"
  12. #include "msm_vidc_internal.h"
  13. #include "msm_vidc_driver.h"
  14. #include "msm_vidc_vb2.h"
  15. #include "msm_vidc_v4l2.h"
  16. #include "msm_vidc_debug.h"
  17. #include "msm_vidc_control.h"
  18. #include "msm_vidc_power.h"
  19. #include "msm_vidc_fence.h"
  20. #include "msm_vidc_memory.h"
  21. #include "venus_hfi_response.h"
  22. #include "msm_vidc.h"
  23. extern const char video_banner[];
  24. #define MSM_VIDC_DRV_NAME "msm_vidc_driver"
  25. #define MSM_VIDC_BUS_NAME "platform:msm_vidc_bus"
  26. /* kernel/msm-4.19 */
  27. #define MSM_VIDC_VERSION ((5 << 16) + (10 << 8) + 0)
  28. static inline bool valid_v4l2_buffer(struct v4l2_buffer *b,
  29. struct msm_vidc_inst *inst)
  30. {
  31. if (b->type == INPUT_MPLANE || b->type == OUTPUT_MPLANE)
  32. return b->length > 0;
  33. else if (b->type == INPUT_META_PLANE || b->type == OUTPUT_META_PLANE)
  34. return true;
  35. return false;
  36. }
  37. static int get_poll_flags(struct msm_vidc_inst *inst, u32 port)
  38. {
  39. int poll = 0;
  40. struct vb2_queue *q = NULL;
  41. struct vb2_buffer *vb = NULL;
  42. unsigned long flags = 0;
  43. if (!inst || port >= MAX_PORT) {
  44. d_vpr_e("%s: invalid params, inst %pK, port %d\n",
  45. __func__, inst, port);
  46. return poll;
  47. }
  48. q = inst->bufq[port].vb2q;
  49. spin_lock_irqsave(&q->done_lock, flags);
  50. if (!list_empty(&q->done_list))
  51. vb = list_first_entry(&q->done_list, struct vb2_buffer,
  52. done_entry);
  53. if (vb && (vb->state == VB2_BUF_STATE_DONE ||
  54. vb->state == VB2_BUF_STATE_ERROR)) {
  55. if (port == OUTPUT_PORT || port == OUTPUT_META_PORT)
  56. poll |= POLLIN | POLLRDNORM;
  57. else if (port == INPUT_PORT || port == INPUT_META_PORT)
  58. poll |= POLLOUT | POLLWRNORM;
  59. }
  60. spin_unlock_irqrestore(&q->done_lock, flags);
  61. return poll;
  62. }
  63. int msm_vidc_poll(void *instance, struct file *filp,
  64. struct poll_table_struct *wait)
  65. {
  66. int poll = 0;
  67. struct msm_vidc_inst *inst = instance;
  68. if (!inst) {
  69. d_vpr_e("%s: invalid params\n", __func__);
  70. return POLLERR;
  71. }
  72. if (is_session_error(inst)) {
  73. i_vpr_e(inst, "%s: inst in error state\n", __func__);
  74. return POLLERR;
  75. }
  76. poll_wait(filp, &inst->event_handler.wait, wait);
  77. poll_wait(filp, &inst->bufq[INPUT_META_PORT].vb2q->done_wq, wait);
  78. poll_wait(filp, &inst->bufq[OUTPUT_META_PORT].vb2q->done_wq, wait);
  79. poll_wait(filp, &inst->bufq[INPUT_PORT].vb2q->done_wq, wait);
  80. poll_wait(filp, &inst->bufq[OUTPUT_PORT].vb2q->done_wq, wait);
  81. if (v4l2_event_pending(&inst->event_handler))
  82. poll |= POLLPRI;
  83. poll |= get_poll_flags(inst, INPUT_META_PORT);
  84. poll |= get_poll_flags(inst, OUTPUT_META_PORT);
  85. poll |= get_poll_flags(inst, INPUT_PORT);
  86. poll |= get_poll_flags(inst, OUTPUT_PORT);
  87. return poll;
  88. }
  89. EXPORT_SYMBOL(msm_vidc_poll);
  90. int msm_vidc_querycap(void *instance, struct v4l2_capability *cap)
  91. {
  92. struct msm_vidc_inst *inst = instance;
  93. if (!inst || !cap) {
  94. d_vpr_e("%s: invalid params\n", __func__);
  95. return -EINVAL;
  96. }
  97. strlcpy(cap->driver, MSM_VIDC_DRV_NAME, sizeof(cap->driver));
  98. strlcpy(cap->bus_info, MSM_VIDC_BUS_NAME, sizeof(cap->bus_info));
  99. cap->version = MSM_VIDC_VERSION;
  100. memset(cap->reserved, 0, sizeof(cap->reserved));
  101. if (inst->domain == MSM_VIDC_DECODER)
  102. strlcpy(cap->card, "msm_vidc_decoder", sizeof(cap->card));
  103. else if (inst->domain == MSM_VIDC_ENCODER)
  104. strlcpy(cap->card, "msm_vidc_encoder", sizeof(cap->card));
  105. else
  106. return -EINVAL;
  107. return 0;
  108. }
  109. EXPORT_SYMBOL(msm_vidc_querycap);
  110. int msm_vidc_enum_fmt(void *instance, struct v4l2_fmtdesc *f)
  111. {
  112. struct msm_vidc_inst *inst = instance;
  113. if (!inst || !f) {
  114. d_vpr_e("%s: invalid params\n", __func__);
  115. return -EINVAL;
  116. }
  117. if (inst->domain == MSM_VIDC_DECODER)
  118. return msm_vdec_enum_fmt(inst, f);
  119. if (inst->domain == MSM_VIDC_ENCODER)
  120. return msm_venc_enum_fmt(inst, f);
  121. return -EINVAL;
  122. }
  123. EXPORT_SYMBOL(msm_vidc_enum_fmt);
  124. int msm_vidc_query_ctrl(void *instance, struct v4l2_queryctrl *q_ctrl)
  125. {
  126. int rc = 0;
  127. struct msm_vidc_inst *inst = instance;
  128. struct v4l2_ctrl *ctrl;
  129. if (!inst || !q_ctrl) {
  130. d_vpr_e("%s: invalid params %pK %pK\n",
  131. __func__, inst, q_ctrl);
  132. return -EINVAL;
  133. }
  134. ctrl = v4l2_ctrl_find(&inst->ctrl_handler, q_ctrl->id);
  135. if (!ctrl) {
  136. i_vpr_e(inst, "%s: get_ctrl failed for id %d\n",
  137. __func__, q_ctrl->id);
  138. return -EINVAL;
  139. }
  140. q_ctrl->minimum = ctrl->minimum;
  141. q_ctrl->maximum = ctrl->maximum;
  142. q_ctrl->default_value = ctrl->default_value;
  143. q_ctrl->flags = 0;
  144. q_ctrl->step = ctrl->step;
  145. i_vpr_h(inst,
  146. "query ctrl: %s: min %d, max %d, default %d step %d flags %#x\n",
  147. ctrl->name, q_ctrl->minimum, q_ctrl->maximum,
  148. q_ctrl->default_value, q_ctrl->step, q_ctrl->flags);
  149. return rc;
  150. }
  151. EXPORT_SYMBOL(msm_vidc_query_ctrl);
  152. int msm_vidc_query_menu(void *instance, struct v4l2_querymenu *qmenu)
  153. {
  154. int rc = 0;
  155. struct msm_vidc_inst *inst = instance;
  156. struct v4l2_ctrl *ctrl;
  157. if (!inst || !qmenu) {
  158. d_vpr_e("%s: invalid params %pK %pK\n",
  159. __func__, inst, qmenu);
  160. return -EINVAL;
  161. }
  162. ctrl = v4l2_ctrl_find(&inst->ctrl_handler, qmenu->id);
  163. if (!ctrl) {
  164. i_vpr_e(inst, "%s: get_ctrl failed for id %d\n",
  165. __func__, qmenu->id);
  166. return -EINVAL;
  167. }
  168. if (ctrl->type != V4L2_CTRL_TYPE_MENU) {
  169. i_vpr_e(inst, "%s: ctrl: %s: type (%d) is not MENU type\n",
  170. __func__, ctrl->name, ctrl->type);
  171. return -EINVAL;
  172. }
  173. if (qmenu->index < ctrl->minimum || qmenu->index > ctrl->maximum)
  174. return -EINVAL;
  175. if (ctrl->menu_skip_mask & (1 << qmenu->index))
  176. rc = -EINVAL;
  177. i_vpr_h(inst,
  178. "%s: ctrl: %s: min %lld, max %lld, menu_skip_mask %lld, qmenu: id %u, index %d, %s\n",
  179. __func__, ctrl->name, ctrl->minimum, ctrl->maximum,
  180. ctrl->menu_skip_mask, qmenu->id, qmenu->index,
  181. rc ? "not supported" : "supported");
  182. return rc;
  183. }
  184. EXPORT_SYMBOL(msm_vidc_query_menu);
  185. int msm_vidc_try_fmt(void *instance, struct v4l2_format *f)
  186. {
  187. int rc = 0;
  188. struct msm_vidc_inst *inst = instance;
  189. if (!inst || !f) {
  190. d_vpr_e("%s: invalid params\n", __func__);
  191. return -EINVAL;
  192. }
  193. if (!msm_vidc_allow_s_fmt(inst, f->type))
  194. return -EBUSY;
  195. if (inst->domain == MSM_VIDC_DECODER)
  196. rc = msm_vdec_try_fmt(inst, f);
  197. if (inst->domain == MSM_VIDC_ENCODER)
  198. rc = msm_venc_try_fmt(inst, f);
  199. if (rc)
  200. i_vpr_e(inst, "%s: try_fmt(%d) failed %d\n",
  201. __func__, f->type, rc);
  202. return rc;
  203. }
  204. EXPORT_SYMBOL(msm_vidc_try_fmt);
  205. int msm_vidc_s_fmt(void *instance, struct v4l2_format *f)
  206. {
  207. int rc = 0;
  208. struct msm_vidc_inst *inst = instance;
  209. if (!inst || !f) {
  210. d_vpr_e("%s: invalid params\n", __func__);
  211. return -EINVAL;
  212. }
  213. if (!msm_vidc_allow_s_fmt(inst, f->type))
  214. return -EBUSY;
  215. if (inst->domain == MSM_VIDC_DECODER)
  216. rc = msm_vdec_s_fmt(inst, f);
  217. if (inst->domain == MSM_VIDC_ENCODER)
  218. rc = msm_venc_s_fmt(inst, f);
  219. if (rc)
  220. i_vpr_e(inst, "%s: s_fmt(%d) failed %d\n",
  221. __func__, f->type, rc);
  222. return rc;
  223. }
  224. EXPORT_SYMBOL(msm_vidc_s_fmt);
  225. int msm_vidc_g_fmt(void *instance, struct v4l2_format *f)
  226. {
  227. int rc = 0;
  228. struct msm_vidc_inst *inst = instance;
  229. if (!inst || !f) {
  230. d_vpr_e("%s: invalid params\n", __func__);
  231. return -EINVAL;
  232. }
  233. if (is_decode_session(inst))
  234. rc = msm_vdec_g_fmt(inst, f);
  235. if (is_encode_session(inst))
  236. rc = msm_venc_g_fmt(inst, f);
  237. if (rc)
  238. return rc;
  239. if (f->type == INPUT_MPLANE || f->type == OUTPUT_MPLANE)
  240. i_vpr_h(inst, "%s: type %s format %s width %d height %d size %d\n",
  241. __func__, v4l2_type_name(f->type),
  242. v4l2_pixelfmt_name(inst, f->fmt.pix_mp.pixelformat),
  243. f->fmt.pix_mp.width, f->fmt.pix_mp.height,
  244. f->fmt.pix_mp.plane_fmt[0].sizeimage);
  245. else if (f->type == INPUT_META_PLANE || f->type == OUTPUT_META_PLANE)
  246. i_vpr_h(inst, "%s: type %s size %d\n",
  247. __func__, v4l2_type_name(f->type), f->fmt.meta.buffersize);
  248. return 0;
  249. }
  250. EXPORT_SYMBOL(msm_vidc_g_fmt);
  251. int msm_vidc_s_selection(void *instance, struct v4l2_selection *s)
  252. {
  253. int rc = 0;
  254. struct msm_vidc_inst *inst = instance;
  255. if (!inst || !s) {
  256. d_vpr_e("%s: invalid params\n", __func__);
  257. return -EINVAL;
  258. }
  259. if (is_decode_session(inst))
  260. rc = msm_vdec_s_selection(inst, s);
  261. if (is_encode_session(inst))
  262. rc = msm_venc_s_selection(inst, s);
  263. return rc;
  264. }
  265. EXPORT_SYMBOL(msm_vidc_s_selection);
  266. int msm_vidc_g_selection(void *instance, struct v4l2_selection *s)
  267. {
  268. int rc = 0;
  269. struct msm_vidc_inst *inst = instance;
  270. if (!inst || !s) {
  271. d_vpr_e("%s: invalid params\n", __func__);
  272. return -EINVAL;
  273. }
  274. if (is_decode_session(inst))
  275. rc = msm_vdec_g_selection(inst, s);
  276. if (is_encode_session(inst))
  277. rc = msm_venc_g_selection(inst, s);
  278. return rc;
  279. }
  280. EXPORT_SYMBOL(msm_vidc_g_selection);
  281. int msm_vidc_s_param(void *instance, struct v4l2_streamparm *param)
  282. {
  283. int rc = 0;
  284. struct msm_vidc_inst *inst = instance;
  285. if (!inst || !param) {
  286. d_vpr_e("%s: invalid params\n", __func__);
  287. return -EINVAL;
  288. }
  289. if (param->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE &&
  290. param->type != V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
  291. return -EINVAL;
  292. if (is_encode_session(inst)) {
  293. rc = msm_venc_s_param(instance, param);
  294. } else {
  295. i_vpr_e(inst, "%s: invalid domain %#x\n",
  296. __func__, inst->domain);
  297. return -EINVAL;
  298. }
  299. return rc;
  300. }
  301. EXPORT_SYMBOL(msm_vidc_s_param);
  302. int msm_vidc_g_param(void *instance, struct v4l2_streamparm *param)
  303. {
  304. int rc = 0;
  305. struct msm_vidc_inst *inst = instance;
  306. if (!inst || !param) {
  307. d_vpr_e("%s: invalid params\n", __func__);
  308. return -EINVAL;
  309. }
  310. if (param->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE &&
  311. param->type != V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
  312. return -EINVAL;
  313. if (is_encode_session(inst)) {
  314. rc = msm_venc_g_param(instance, param);
  315. } else {
  316. i_vpr_e(inst, "%s: invalid domain %#x\n",
  317. __func__, inst->domain);
  318. return -EINVAL;
  319. }
  320. return rc;
  321. }
  322. EXPORT_SYMBOL(msm_vidc_g_param);
  323. int msm_vidc_reqbufs(void *instance, struct v4l2_requestbuffers *b)
  324. {
  325. int rc = 0;
  326. struct msm_vidc_inst *inst = instance;
  327. int port;
  328. if (!inst || !b) {
  329. d_vpr_e("%s: invalid params\n", __func__);
  330. return -EINVAL;
  331. }
  332. if (!msm_vidc_allow_reqbufs(inst, b->type)) {
  333. rc = -EBUSY;
  334. goto exit;
  335. }
  336. port = v4l2_type_to_driver_port(inst, b->type, __func__);
  337. if (port < 0) {
  338. rc = -EINVAL;
  339. goto exit;
  340. }
  341. rc = vb2_reqbufs(inst->bufq[port].vb2q, b);
  342. if (rc) {
  343. i_vpr_e(inst, "%s: vb2_reqbufs(%d) failed, %d\n",
  344. __func__, b->type, rc);
  345. goto exit;
  346. }
  347. exit:
  348. return rc;
  349. }
  350. EXPORT_SYMBOL(msm_vidc_reqbufs);
  351. int msm_vidc_querybuf(void *instance, struct v4l2_buffer *b)
  352. {
  353. int rc = 0;
  354. struct msm_vidc_inst *inst = instance;
  355. int port;
  356. if (!inst || !b) {
  357. d_vpr_e("%s: invalid params\n", __func__);
  358. return -EINVAL;
  359. }
  360. port = v4l2_type_to_driver_port(inst, b->type, __func__);
  361. if (port < 0) {
  362. rc = -EINVAL;
  363. goto exit;
  364. }
  365. rc = vb2_querybuf(inst->bufq[port].vb2q, b);
  366. if (rc) {
  367. i_vpr_e(inst, "%s: vb2_querybuf(%d) failed, %d\n",
  368. __func__, b->type, rc);
  369. goto exit;
  370. }
  371. exit:
  372. return rc;
  373. }
  374. EXPORT_SYMBOL(msm_vidc_querybuf);
  375. int msm_vidc_create_bufs(void *instance, struct v4l2_create_buffers *b)
  376. {
  377. int rc = 0;
  378. struct msm_vidc_inst *inst = instance;
  379. int port;
  380. struct v4l2_format *f;
  381. if (!inst || !b) {
  382. d_vpr_e("%s: invalid params\n", __func__);
  383. return -EINVAL;
  384. }
  385. f = &b->format;
  386. port = v4l2_type_to_driver_port(inst, f->type, __func__);
  387. if (port < 0) {
  388. rc = -EINVAL;
  389. goto exit;
  390. }
  391. rc = vb2_create_bufs(inst->bufq[port].vb2q, b);
  392. if (rc) {
  393. i_vpr_e(inst, "%s: vb2_create_bufs(%d) failed, %d\n",
  394. __func__, f->type, rc);
  395. goto exit;
  396. }
  397. exit:
  398. return rc;
  399. }
  400. EXPORT_SYMBOL(msm_vidc_create_bufs);
  401. int msm_vidc_prepare_buf(void *instance, struct media_device *mdev,
  402. struct v4l2_buffer *b)
  403. {
  404. int rc = 0;
  405. struct msm_vidc_inst *inst = instance;
  406. struct vb2_queue *q;
  407. if (!inst || !inst->core || !b || !valid_v4l2_buffer(b, inst)) {
  408. d_vpr_e("%s: invalid params %pK %pK\n", __func__, inst, b);
  409. return -EINVAL;
  410. }
  411. q = msm_vidc_get_vb2q(inst, b->type, __func__);
  412. if (!q) {
  413. rc = -EINVAL;
  414. goto exit;
  415. }
  416. rc = vb2_prepare_buf(q, mdev, b);
  417. if (rc) {
  418. i_vpr_e(inst, "%s: failed with %d\n", __func__, rc);
  419. goto exit;
  420. }
  421. exit:
  422. return rc;
  423. }
  424. EXPORT_SYMBOL(msm_vidc_prepare_buf);
  425. int msm_vidc_qbuf(void *instance, struct media_device *mdev,
  426. struct v4l2_buffer *b)
  427. {
  428. int rc = 0;
  429. struct msm_vidc_inst *inst = instance;
  430. struct vb2_queue *q;
  431. if (!inst || !inst->core || !b || !valid_v4l2_buffer(b, inst)) {
  432. d_vpr_e("%s: invalid params %pK %pK\n", __func__, inst, b);
  433. return -EINVAL;
  434. }
  435. q = msm_vidc_get_vb2q(inst, b->type, __func__);
  436. if (!q) {
  437. rc = -EINVAL;
  438. goto exit;
  439. }
  440. rc = vb2_qbuf(q, mdev, b);
  441. if (rc)
  442. i_vpr_e(inst, "%s: failed with %d\n", __func__, rc);
  443. exit:
  444. return rc;
  445. }
  446. EXPORT_SYMBOL(msm_vidc_qbuf);
  447. int msm_vidc_dqbuf(void *instance, struct v4l2_buffer *b)
  448. {
  449. int rc = 0;
  450. struct msm_vidc_inst *inst = instance;
  451. struct vb2_queue *q;
  452. if (!inst || !b || !valid_v4l2_buffer(b, inst)) {
  453. d_vpr_e("%s: invalid params %pK %pK\n", __func__, inst, b);
  454. return -EINVAL;
  455. }
  456. q = msm_vidc_get_vb2q(inst, b->type, __func__);
  457. if (!q) {
  458. rc = -EINVAL;
  459. goto exit;
  460. }
  461. rc = vb2_dqbuf(q, b, true);
  462. if (rc == -EAGAIN) {
  463. goto exit;
  464. } else if (rc) {
  465. i_vpr_l(inst, "%s: failed with %d\n", __func__, rc);
  466. goto exit;
  467. }
  468. exit:
  469. return rc;
  470. }
  471. EXPORT_SYMBOL(msm_vidc_dqbuf);
  472. int msm_vidc_streamon(void *instance, enum v4l2_buf_type type)
  473. {
  474. int rc = 0;
  475. struct msm_vidc_inst *inst = instance;
  476. int port;
  477. if (!inst) {
  478. d_vpr_e("%s: invalid params\n", __func__);
  479. return -EINVAL;
  480. }
  481. port = v4l2_type_to_driver_port(inst, type, __func__);
  482. if (port < 0) {
  483. rc = -EINVAL;
  484. goto exit;
  485. }
  486. rc = vb2_streamon(inst->bufq[port].vb2q, type);
  487. if (rc) {
  488. i_vpr_e(inst, "%s: vb2_streamon(%d) failed, %d\n",
  489. __func__, type, rc);
  490. goto exit;
  491. }
  492. exit:
  493. return rc;
  494. }
  495. EXPORT_SYMBOL(msm_vidc_streamon);
  496. int msm_vidc_streamoff(void *instance, enum v4l2_buf_type type)
  497. {
  498. int rc = 0;
  499. struct msm_vidc_inst *inst = instance;
  500. int port;
  501. if (!inst) {
  502. d_vpr_e("%s: invalid params\n", __func__);
  503. return -EINVAL;
  504. }
  505. port = v4l2_type_to_driver_port(inst, type, __func__);
  506. if (port < 0) {
  507. rc = -EINVAL;
  508. goto exit;
  509. }
  510. rc = vb2_streamoff(inst->bufq[port].vb2q, type);
  511. if (rc) {
  512. i_vpr_e(inst, "%s: vb2_streamoff(%d) failed, %d\n",
  513. __func__, type, rc);
  514. goto exit;
  515. }
  516. exit:
  517. return rc;
  518. }
  519. EXPORT_SYMBOL(msm_vidc_streamoff);
  520. int msm_vidc_try_cmd(void *instance, union msm_v4l2_cmd *cmd)
  521. {
  522. int rc = 0;
  523. struct msm_vidc_inst *inst = instance;
  524. struct v4l2_decoder_cmd *dec = NULL;
  525. struct v4l2_encoder_cmd *enc = NULL;
  526. if (is_decode_session(inst)) {
  527. dec = (struct v4l2_decoder_cmd *)cmd;
  528. i_vpr_h(inst, "%s: cmd %d\n", __func__, dec->cmd);
  529. if (dec->cmd != V4L2_DEC_CMD_STOP && dec->cmd != V4L2_DEC_CMD_START)
  530. return -EINVAL;
  531. dec->flags = 0;
  532. if (dec->cmd == V4L2_DEC_CMD_STOP) {
  533. dec->stop.pts = 0;
  534. } else if (dec->cmd == V4L2_DEC_CMD_START) {
  535. dec->start.speed = 0;
  536. dec->start.format = V4L2_DEC_START_FMT_NONE;
  537. }
  538. } else if (is_encode_session(inst)) {
  539. enc = (struct v4l2_encoder_cmd *)cmd;
  540. i_vpr_h(inst, "%s: cmd %d\n", __func__, enc->cmd);
  541. if (enc->cmd != V4L2_ENC_CMD_STOP && enc->cmd != V4L2_ENC_CMD_START)
  542. return -EINVAL;
  543. enc->flags = 0;
  544. }
  545. return rc;
  546. }
  547. EXPORT_SYMBOL(msm_vidc_try_cmd);
  548. int msm_vidc_start_cmd(void *instance)
  549. {
  550. struct msm_vidc_inst *inst = instance;
  551. int rc = 0;
  552. if (!is_decode_session(inst) && !is_encode_session(inst)) {
  553. i_vpr_e(inst, "%s: invalid session %d\n", __func__, inst->domain);
  554. return -EINVAL;
  555. }
  556. if (is_decode_session(inst)) {
  557. rc = msm_vdec_start_cmd(inst);
  558. if (rc)
  559. return rc;
  560. } else if (is_encode_session(inst)) {
  561. rc = msm_venc_start_cmd(inst);
  562. if (rc)
  563. return rc;
  564. }
  565. return rc;
  566. }
  567. EXPORT_SYMBOL(msm_vidc_start_cmd);
  568. int msm_vidc_stop_cmd(void *instance)
  569. {
  570. struct msm_vidc_inst *inst = instance;
  571. int rc = 0;
  572. if (!is_decode_session(inst) && !is_encode_session(inst)) {
  573. i_vpr_e(inst, "%s: invalid session %d\n", __func__, inst->domain);
  574. return -EINVAL;
  575. }
  576. if (is_decode_session(inst)) {
  577. rc = msm_vdec_stop_cmd(inst);
  578. if (rc)
  579. return rc;
  580. } else if (is_encode_session(inst)) {
  581. rc = msm_venc_stop_cmd(inst);
  582. if (rc)
  583. return rc;
  584. }
  585. return rc;
  586. }
  587. EXPORT_SYMBOL(msm_vidc_stop_cmd);
  588. int msm_vidc_enum_framesizes(void *instance, struct v4l2_frmsizeenum *fsize)
  589. {
  590. struct msm_vidc_inst *inst = instance;
  591. struct msm_vidc_inst_capability *capability;
  592. enum msm_vidc_colorformat_type colorfmt;
  593. enum msm_vidc_codec_type codec;
  594. u32 meta_fmt;
  595. if (!inst || !fsize) {
  596. d_vpr_e("%s: invalid params: %pK %pK\n",
  597. __func__, inst, fsize);
  598. return -EINVAL;
  599. }
  600. if (!inst->capabilities) {
  601. i_vpr_e(inst, "%s: capabilities not available\n", __func__);
  602. return -EINVAL;
  603. }
  604. capability = inst->capabilities;
  605. /* only index 0 allowed as per v4l2 spec */
  606. if (fsize->index)
  607. return -EINVAL;
  608. meta_fmt = v4l2_colorformat_from_driver(inst, MSM_VIDC_FMT_META, __func__);
  609. if (fsize->pixel_format != meta_fmt) {
  610. /* validate pixel format */
  611. codec = v4l2_codec_to_driver(inst, fsize->pixel_format, __func__);
  612. if (!codec) {
  613. colorfmt = v4l2_colorformat_to_driver(inst, fsize->pixel_format,
  614. __func__);
  615. if (colorfmt == MSM_VIDC_FMT_NONE) {
  616. i_vpr_e(inst, "%s: unsupported pix fmt %#x\n",
  617. __func__, fsize->pixel_format);
  618. return -EINVAL;
  619. }
  620. }
  621. }
  622. fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE;
  623. fsize->stepwise.min_width = capability->cap[FRAME_WIDTH].min;
  624. fsize->stepwise.max_width = capability->cap[FRAME_WIDTH].max;
  625. fsize->stepwise.step_width =
  626. capability->cap[FRAME_WIDTH].step_or_mask;
  627. fsize->stepwise.min_height = capability->cap[FRAME_HEIGHT].min;
  628. fsize->stepwise.max_height = capability->cap[FRAME_HEIGHT].max;
  629. fsize->stepwise.step_height =
  630. capability->cap[FRAME_HEIGHT].step_or_mask;
  631. return 0;
  632. }
  633. EXPORT_SYMBOL(msm_vidc_enum_framesizes);
  634. int msm_vidc_enum_frameintervals(void *instance, struct v4l2_frmivalenum *fival)
  635. {
  636. struct msm_vidc_inst *inst = instance;
  637. struct msm_vidc_core *core;
  638. struct msm_vidc_inst_capability *capability;
  639. enum msm_vidc_colorformat_type colorfmt;
  640. u32 fps, mbpf;
  641. u32 meta_fmt;
  642. if (!inst || !fival) {
  643. d_vpr_e("%s: invalid params: %pK %pK\n",
  644. __func__, inst, fival);
  645. return -EINVAL;
  646. }
  647. if (is_decode_session(inst)) {
  648. i_vpr_e(inst, "%s: not supported by decoder\n", __func__);
  649. return -ENOTTY;
  650. }
  651. core = inst->core;
  652. if (!inst->capabilities || !core->capabilities) {
  653. i_vpr_e(inst, "%s: capabilities not available\n", __func__);
  654. return -EINVAL;
  655. }
  656. capability = inst->capabilities;
  657. /* only index 0 allowed as per v4l2 spec */
  658. if (fival->index)
  659. return -EINVAL;
  660. meta_fmt = v4l2_colorformat_from_driver(inst, MSM_VIDC_FMT_META, __func__);
  661. if (fival->pixel_format != meta_fmt) {
  662. /* validate pixel format */
  663. colorfmt = v4l2_colorformat_to_driver(inst, fival->pixel_format, __func__);
  664. if (colorfmt == MSM_VIDC_FMT_NONE) {
  665. i_vpr_e(inst, "%s: unsupported pix fmt %#x\n",
  666. __func__, fival->pixel_format);
  667. return -EINVAL;
  668. }
  669. }
  670. /* validate resolution */
  671. if (fival->width > capability->cap[FRAME_WIDTH].max ||
  672. fival->width < capability->cap[FRAME_WIDTH].min ||
  673. fival->height > capability->cap[FRAME_HEIGHT].max ||
  674. fival->height < capability->cap[FRAME_HEIGHT].min) {
  675. i_vpr_e(inst, "%s: unsupported resolution %u x %u\n", __func__,
  676. fival->width, fival->height);
  677. return -EINVAL;
  678. }
  679. /* calculate max supported fps for a given resolution */
  680. mbpf = NUM_MBS_PER_FRAME(fival->height, fival->width);
  681. fps = core->capabilities[MAX_MBPS].value / mbpf;
  682. fival->type = V4L2_FRMIVAL_TYPE_STEPWISE;
  683. fival->stepwise.min.numerator = 1;
  684. fival->stepwise.min.denominator =
  685. min_t(u32, fps, capability->cap[FRAME_RATE].max);
  686. fival->stepwise.max.numerator = 1;
  687. fival->stepwise.max.denominator = 1;
  688. fival->stepwise.step.numerator = 1;
  689. fival->stepwise.step.denominator = capability->cap[FRAME_RATE].max;
  690. return 0;
  691. }
  692. EXPORT_SYMBOL(msm_vidc_enum_frameintervals);
  693. int msm_vidc_subscribe_event(void *instance,
  694. const struct v4l2_event_subscription *sub)
  695. {
  696. int rc = 0;
  697. struct msm_vidc_inst *inst = (struct msm_vidc_inst *)instance;
  698. if (!inst || !sub) {
  699. d_vpr_e("%s: invalid params\n", __func__);
  700. return -EINVAL;
  701. }
  702. i_vpr_h(inst, "%s: type %d id %d\n", __func__, sub->type, sub->id);
  703. if (inst->domain == MSM_VIDC_DECODER)
  704. rc = msm_vdec_subscribe_event(inst, sub);
  705. if (inst->domain == MSM_VIDC_ENCODER)
  706. rc = msm_venc_subscribe_event(inst, sub);
  707. return rc;
  708. }
  709. EXPORT_SYMBOL(msm_vidc_subscribe_event);
  710. int msm_vidc_unsubscribe_event(void *instance,
  711. const struct v4l2_event_subscription *sub)
  712. {
  713. int rc = 0;
  714. struct msm_vidc_inst *inst = (struct msm_vidc_inst *)instance;
  715. if (!inst || !sub) {
  716. d_vpr_e("%s: invalid params\n", __func__);
  717. return -EINVAL;
  718. }
  719. i_vpr_h(inst, "%s: type %d id %d\n", __func__, sub->type, sub->id);
  720. rc = v4l2_event_unsubscribe(&inst->event_handler, sub);
  721. if (rc)
  722. i_vpr_e(inst, "%s: failed, type %d id %d\n",
  723. __func__, sub->type, sub->id);
  724. return rc;
  725. }
  726. EXPORT_SYMBOL(msm_vidc_unsubscribe_event);
  727. int msm_vidc_dqevent(void *instance, struct v4l2_event *event)
  728. {
  729. int rc = 0;
  730. struct msm_vidc_inst *inst = (struct msm_vidc_inst *)instance;
  731. if (!inst || !event) {
  732. d_vpr_e("%s: invalid params\n", __func__);
  733. return -EINVAL;
  734. }
  735. rc = v4l2_event_dequeue(&inst->event_handler, event, false);
  736. if (rc)
  737. i_vpr_e(inst, "%s: fialed\n", __func__);
  738. return rc;
  739. }
  740. EXPORT_SYMBOL(msm_vidc_dqevent);
  741. void *msm_vidc_open(void *vidc_core, u32 session_type)
  742. {
  743. int rc = 0;
  744. struct msm_vidc_inst *inst = NULL;
  745. struct msm_vidc_core *core;
  746. int i = 0;
  747. d_vpr_h("%s: %s\n", __func__, video_banner);
  748. core = vidc_core;
  749. if (!core) {
  750. d_vpr_e("%s: invalid params\n", __func__);
  751. return NULL;
  752. }
  753. if (session_type != MSM_VIDC_DECODER &&
  754. session_type != MSM_VIDC_ENCODER) {
  755. d_vpr_e("%s: invalid session_type %d\n",
  756. __func__, session_type);
  757. return NULL;
  758. }
  759. rc = msm_vidc_core_init(core);
  760. if (rc)
  761. return NULL;
  762. rc = msm_vidc_core_init_wait(core);
  763. if (rc)
  764. return NULL;
  765. rc = msm_vidc_vmem_alloc(sizeof(*inst), (void **)&inst, "inst memory");
  766. if (rc)
  767. return NULL;
  768. inst->core = core;
  769. inst->domain = session_type;
  770. inst->session_id = hash32_ptr(inst);
  771. msm_vidc_update_state(inst, MSM_VIDC_OPEN, __func__);
  772. inst->sub_state = MSM_VIDC_SUB_STATE_NONE;
  773. strlcpy(inst->sub_state_name, "SUB_STATE_NONE", sizeof(inst->sub_state_name));
  774. inst->active = true;
  775. inst->request = false;
  776. inst->ipsc_properties_set = false;
  777. inst->opsc_properties_set = false;
  778. inst->has_bframe = false;
  779. inst->iframe = false;
  780. inst->auto_framerate = DEFAULT_FPS << 16;
  781. inst->initial_time_us = ktime_get_ns() / 1000;
  782. kref_init(&inst->kref);
  783. mutex_init(&inst->lock);
  784. mutex_init(&inst->request_lock);
  785. mutex_init(&inst->client_lock);
  786. msm_vidc_update_debug_str(inst);
  787. i_vpr_h(inst, "Opening video instance: %d\n", session_type);
  788. rc = msm_vidc_pools_init(inst);
  789. if (rc) {
  790. i_vpr_e(inst, "%s: failed to init pool buffers\n", __func__);
  791. msm_vidc_vmem_free((void **)&inst);
  792. return NULL;
  793. }
  794. INIT_LIST_HEAD(&inst->caps_list);
  795. INIT_LIST_HEAD(&inst->timestamps.list);
  796. INIT_LIST_HEAD(&inst->ts_reorder.list);
  797. INIT_LIST_HEAD(&inst->buffers.input.list);
  798. INIT_LIST_HEAD(&inst->buffers.input_meta.list);
  799. INIT_LIST_HEAD(&inst->buffers.output.list);
  800. INIT_LIST_HEAD(&inst->buffers.output_meta.list);
  801. INIT_LIST_HEAD(&inst->buffers.read_only.list);
  802. INIT_LIST_HEAD(&inst->buffers.bin.list);
  803. INIT_LIST_HEAD(&inst->buffers.arp.list);
  804. INIT_LIST_HEAD(&inst->buffers.comv.list);
  805. INIT_LIST_HEAD(&inst->buffers.non_comv.list);
  806. INIT_LIST_HEAD(&inst->buffers.line.list);
  807. INIT_LIST_HEAD(&inst->buffers.dpb.list);
  808. INIT_LIST_HEAD(&inst->buffers.persist.list);
  809. INIT_LIST_HEAD(&inst->buffers.vpss.list);
  810. INIT_LIST_HEAD(&inst->buffers.partial_data.list);
  811. INIT_LIST_HEAD(&inst->mem_info.bin.list);
  812. INIT_LIST_HEAD(&inst->mem_info.arp.list);
  813. INIT_LIST_HEAD(&inst->mem_info.comv.list);
  814. INIT_LIST_HEAD(&inst->mem_info.non_comv.list);
  815. INIT_LIST_HEAD(&inst->mem_info.line.list);
  816. INIT_LIST_HEAD(&inst->mem_info.dpb.list);
  817. INIT_LIST_HEAD(&inst->mem_info.persist.list);
  818. INIT_LIST_HEAD(&inst->mem_info.vpss.list);
  819. INIT_LIST_HEAD(&inst->mem_info.partial_data.list);
  820. INIT_LIST_HEAD(&inst->children_list);
  821. INIT_LIST_HEAD(&inst->firmware_list);
  822. INIT_LIST_HEAD(&inst->enc_input_crs);
  823. INIT_LIST_HEAD(&inst->dmabuf_tracker);
  824. INIT_LIST_HEAD(&inst->input_timer_list);
  825. INIT_LIST_HEAD(&inst->pending_pkts);
  826. INIT_LIST_HEAD(&inst->fence_list);
  827. INIT_LIST_HEAD(&inst->buffer_stats_list);
  828. for (i = 0; i < MAX_SIGNAL; i++)
  829. init_completion(&inst->completions[i]);
  830. inst->workq = create_singlethread_workqueue("workq");
  831. if (!inst->workq) {
  832. i_vpr_e(inst, "%s: create workq failed\n", __func__);
  833. goto error;
  834. }
  835. INIT_DELAYED_WORK(&inst->stats_work, msm_vidc_stats_handler);
  836. INIT_WORK(&inst->stability_work, msm_vidc_stability_handler);
  837. rc = msm_vidc_vmem_alloc(sizeof(struct msm_vidc_inst_capability),
  838. (void **)&inst->capabilities, "inst capability");
  839. if (rc)
  840. goto error;
  841. rc = msm_vidc_event_queue_init(inst);
  842. if (rc)
  843. goto error;
  844. rc = msm_vidc_vb2_queue_init(inst);
  845. if (rc)
  846. goto error;
  847. if (is_decode_session(inst))
  848. rc = msm_vdec_inst_init(inst);
  849. else if (is_encode_session(inst))
  850. rc = msm_venc_inst_init(inst);
  851. if (rc)
  852. goto error;
  853. rc = msm_vidc_fence_init(inst);
  854. if (rc)
  855. goto error;
  856. rc = msm_vidc_add_session(inst);
  857. if (rc) {
  858. i_vpr_e(inst, "%s: failed to get session id\n", __func__);
  859. goto error;
  860. }
  861. /* reset clock residency stats */
  862. msm_vidc_reset_residency_stats(core);
  863. msm_vidc_scale_power(inst, true);
  864. rc = msm_vidc_session_open(inst);
  865. if (rc) {
  866. msm_vidc_core_deinit(core, true);
  867. goto error;
  868. }
  869. inst->debugfs_root =
  870. msm_vidc_debugfs_init_inst(inst, core->debugfs_root);
  871. if (!inst->debugfs_root)
  872. i_vpr_h(inst, "%s: debugfs not available\n", __func__);
  873. return inst;
  874. error:
  875. msm_vidc_close(inst);
  876. return NULL;
  877. }
  878. EXPORT_SYMBOL(msm_vidc_open);
  879. int msm_vidc_close(void *instance)
  880. {
  881. int rc = 0;
  882. struct msm_vidc_inst *inst = instance;
  883. struct msm_vidc_core *core;
  884. if (!inst) {
  885. d_vpr_e("%s: invalid params\n", __func__);
  886. return -EINVAL;
  887. }
  888. core = inst->core;
  889. i_vpr_h(inst, "%s()\n", __func__);
  890. client_lock(inst, __func__);
  891. inst_lock(inst, __func__);
  892. /* print final stats */
  893. msm_vidc_print_stats(inst);
  894. msm_vidc_print_residency_stats(core);
  895. msm_vidc_session_close(inst);
  896. msm_vidc_event_queue_deinit(inst);
  897. msm_vidc_vb2_queue_deinit(inst);
  898. msm_vidc_remove_session(inst);
  899. msm_vidc_change_state(inst, MSM_VIDC_CLOSE, __func__);
  900. inst->sub_state = MSM_VIDC_SUB_STATE_NONE;
  901. strscpy(inst->sub_state_name, "SUB_STATE_NONE", sizeof(inst->sub_state_name));
  902. inst_unlock(inst, __func__);
  903. client_unlock(inst, __func__);
  904. cancel_stability_work_sync(inst);
  905. cancel_stats_work_sync(inst);
  906. msm_vidc_show_stats(inst);
  907. put_inst(inst);
  908. msm_vidc_schedule_core_deinit(core);
  909. return rc;
  910. }
  911. EXPORT_SYMBOL(msm_vidc_close);