msm_vidc_iris33.c 35 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2020-2022, The Linux Foundation. All rights reserved.
  4. * Copyright (c) 2022-2023, Qualcomm Innovation Center, Inc. All rights reserved.
  5. */
  6. #include <linux/reset.h>
  7. #include "msm_vidc_iris33.h"
  8. #include "msm_vidc_buffer_iris33.h"
  9. #include "msm_vidc_power_iris33.h"
  10. #include "msm_vidc_inst.h"
  11. #include "msm_vidc_core.h"
  12. #include "msm_vidc_driver.h"
  13. #include "msm_vidc_platform.h"
  14. #include "msm_vidc_internal.h"
  15. #include "msm_vidc_buffer.h"
  16. #include "msm_vidc_state.h"
  17. #include "msm_vidc_debug.h"
  18. #include "msm_vidc_variant.h"
  19. #include "venus_hfi.h"
  20. #define VIDEO_ARCH_LX 1
  21. #define VCODEC_BASE_OFFS_IRIS33 0x00000000
  22. #define VCODEC_CPU_CS_IRIS33 0x000A0000
  23. #define AON_BASE_OFFS 0x000E0000
  24. #define VCODEC_VPU_CPU_CS_VCICMDARG0_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x24)
  25. #define VCODEC_VPU_CPU_CS_VCICMDARG1_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x28)
  26. #define VCODEC_VPU_CPU_CS_SCIACMD_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x48)
  27. #define VCODEC_VPU_CPU_CS_SCIACMDARG0_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x4C)
  28. #define VCODEC_VPU_CPU_CS_SCIACMDARG1_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x50)
  29. #define VCODEC_VPU_CPU_CS_SCIACMDARG2_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x54)
  30. #define VCODEC_VPU_CPU_CS_SCIBCMD_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x5C)
  31. #define VCODEC_VPU_CPU_CS_SCIBCMDARG0_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x60)
  32. #define VCODEC_VPU_CPU_CS_SCIBARG1_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x64)
  33. #define VCODEC_VPU_CPU_CS_SCIBARG2_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x68)
  34. #define HFI_CTRL_INIT_IRIS33 VCODEC_VPU_CPU_CS_SCIACMD_IRIS33
  35. #define HFI_CTRL_STATUS_IRIS33 VCODEC_VPU_CPU_CS_SCIACMDARG0_IRIS33
  36. typedef enum
  37. {
  38. HFI_CTRL_NOT_INIT = 0x0,
  39. HFI_CTRL_READY = 0x1,
  40. HFI_CTRL_ERROR_FATAL = 0x2,
  41. HFI_CTRL_ERROR_UC_REGION_NOT_SET = 0x4,
  42. HFI_CTRL_PC_READY = 0x100,
  43. HFI_CTRL_VCODEC_IDLE = 0x40000000
  44. } hfi_ctrl_status_type;
  45. #define HFI_QTBL_INFO_IRIS33 VCODEC_VPU_CPU_CS_SCIACMDARG1_IRIS33
  46. typedef enum
  47. {
  48. HFI_QTBL_DISABLED = 0x00,
  49. HFI_QTBL_ENABLED = 0x01,
  50. } hfi_qtbl_status_type;
  51. #define HFI_QTBL_ADDR_IRIS33 VCODEC_VPU_CPU_CS_SCIACMDARG2_IRIS33
  52. #define HFI_MMAP_ADDR_IRIS33 VCODEC_VPU_CPU_CS_SCIBCMDARG0_IRIS33
  53. #define HFI_UC_REGION_ADDR_IRIS33 VCODEC_VPU_CPU_CS_SCIBARG1_IRIS33
  54. #define HFI_UC_REGION_SIZE_IRIS33 VCODEC_VPU_CPU_CS_SCIBARG2_IRIS33
  55. #define HFI_DEVICE_REGION_ADDR_IRIS33 VCODEC_VPU_CPU_CS_VCICMDARG0_IRIS33
  56. #define HFI_DEVICE_REGION_SIZE_IRIS33 VCODEC_VPU_CPU_CS_VCICMDARG1_IRIS33
  57. #define HFI_SFR_ADDR_IRIS33 VCODEC_VPU_CPU_CS_SCIBCMD_IRIS33
  58. #define CPU_CS_A2HSOFTINTCLR_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x1C)
  59. #define CPU_CS_H2XSOFTINTEN_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x148)
  60. #define CPU_CS_AHB_BRIDGE_SYNC_RESET (VCODEC_CPU_CS_IRIS33 + 0x160)
  61. /* FAL10 Feature Control */
  62. #define CPU_CS_X2RPMh_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x168)
  63. #define CPU_IC_SOFTINT_IRIS33 (VCODEC_CPU_CS_IRIS33 + 0x150)
  64. #define CPU_IC_SOFTINT_H2A_SHFT_IRIS33 0x0
  65. /*
  66. * --------------------------------------------------------------------------
  67. * MODULE: wrapper
  68. * --------------------------------------------------------------------------
  69. */
  70. #define WRAPPER_BASE_OFFS_IRIS33 0x000B0000
  71. #define WRAPPER_INTR_STATUS_IRIS33 (WRAPPER_BASE_OFFS_IRIS33 + 0x0C)
  72. #define WRAPPER_INTR_STATUS_A2HWD_BMSK_IRIS33 0x8
  73. #define WRAPPER_INTR_STATUS_A2H_BMSK_IRIS33 0x4
  74. #define WRAPPER_INTR_MASK_IRIS33 (WRAPPER_BASE_OFFS_IRIS33 + 0x10)
  75. #define WRAPPER_INTR_MASK_A2HWD_BMSK_IRIS33 0x8
  76. #define WRAPPER_INTR_MASK_A2HCPU_BMSK_IRIS33 0x4
  77. #define WRAPPER_DEBUG_BRIDGE_LPI_CONTROL_IRIS33 (WRAPPER_BASE_OFFS_IRIS33 + 0x54)
  78. #define WRAPPER_DEBUG_BRIDGE_LPI_STATUS_IRIS33 (WRAPPER_BASE_OFFS_IRIS33 + 0x58)
  79. #define WRAPPER_IRIS_CPU_NOC_LPI_CONTROL (WRAPPER_BASE_OFFS_IRIS33 + 0x5C)
  80. #define WRAPPER_IRIS_CPU_NOC_LPI_STATUS (WRAPPER_BASE_OFFS_IRIS33 + 0x60)
  81. #define WRAPPER_CORE_POWER_STATUS (WRAPPER_BASE_OFFS_IRIS33 + 0x80)
  82. #define WRAPPER_CORE_CLOCK_CONFIG_IRIS33 (WRAPPER_BASE_OFFS_IRIS33 + 0x88)
  83. /*
  84. * --------------------------------------------------------------------------
  85. * MODULE: tz_wrapper
  86. * --------------------------------------------------------------------------
  87. */
  88. #define WRAPPER_TZ_BASE_OFFS 0x000C0000
  89. #define WRAPPER_TZ_CPU_STATUS (WRAPPER_TZ_BASE_OFFS + 0x10)
  90. #define WRAPPER_TZ_CTL_AXI_CLOCK_CONFIG (WRAPPER_TZ_BASE_OFFS + 0x14)
  91. #define WRAPPER_TZ_QNS4PDXFIFO_RESET (WRAPPER_TZ_BASE_OFFS + 0x18)
  92. #define AON_WRAPPER_MVP_NOC_LPI_CONTROL (AON_BASE_OFFS)
  93. #define AON_WRAPPER_MVP_NOC_LPI_STATUS (AON_BASE_OFFS + 0x4)
  94. #define AON_WRAPPER_MVP_NOC_CORE_SW_RESET (AON_BASE_OFFS + 0x18)
  95. #define AON_WRAPPER_MVP_NOC_CORE_CLK_CONTROL (AON_BASE_OFFS + 0x20)
  96. #define AON_WRAPPER_SPARE (AON_BASE_OFFS + 0x28)
  97. /*
  98. * --------------------------------------------------------------------------
  99. * MODULE: VCODEC_SS registers
  100. * --------------------------------------------------------------------------
  101. */
  102. #define VCODEC_SS_IDLE_STATUSn (VCODEC_BASE_OFFS_IRIS33 + 0x70)
  103. static int __interrupt_init_iris33(struct msm_vidc_core *vidc_core)
  104. {
  105. struct msm_vidc_core *core = vidc_core;
  106. u32 mask_val = 0;
  107. int rc = 0;
  108. if (!core) {
  109. d_vpr_e("%s: invalid params\n", __func__);
  110. return -EINVAL;
  111. }
  112. /* All interrupts should be disabled initially 0x1F6 : Reset value */
  113. rc = __read_register(core, WRAPPER_INTR_MASK_IRIS33, &mask_val);
  114. if (rc)
  115. return rc;
  116. /* Write 0 to unmask CPU and WD interrupts */
  117. mask_val &= ~(WRAPPER_INTR_MASK_A2HWD_BMSK_IRIS33|
  118. WRAPPER_INTR_MASK_A2HCPU_BMSK_IRIS33);
  119. rc = __write_register(core, WRAPPER_INTR_MASK_IRIS33, mask_val);
  120. if (rc)
  121. return rc;
  122. return 0;
  123. }
  124. static int __get_device_region_info(struct msm_vidc_core *core,
  125. u32 *min_dev_addr, u32 *dev_reg_size)
  126. {
  127. struct device_region_set *dev_set;
  128. u32 min_addr, max_addr, count = 0;
  129. int rc = 0;
  130. if (!core || !core->resource) {
  131. d_vpr_e("%s: invalid params\n", __func__);
  132. return -EINVAL;
  133. }
  134. dev_set = &core->resource->device_region_set;
  135. if (!dev_set->count) {
  136. d_vpr_h("%s: device region not available\n", __func__);
  137. return 0;
  138. }
  139. min_addr = 0xFFFFFFFF;
  140. max_addr = 0x0;
  141. for (count = 0; count < dev_set->count; count++) {
  142. if (dev_set->device_region_tbl[count].dev_addr > max_addr)
  143. max_addr = dev_set->device_region_tbl[count].dev_addr +
  144. dev_set->device_region_tbl[count].size;
  145. if (dev_set->device_region_tbl[count].dev_addr < min_addr)
  146. min_addr = dev_set->device_region_tbl[count].dev_addr;
  147. }
  148. if (min_addr == 0xFFFFFFFF || max_addr == 0x0) {
  149. d_vpr_e("%s: invalid device region\n", __func__);
  150. return -EINVAL;
  151. }
  152. *min_dev_addr = min_addr;
  153. *dev_reg_size = max_addr - min_addr;
  154. return rc;
  155. }
  156. static int __program_bootup_registers_iris33(struct msm_vidc_core *vidc_core)
  157. {
  158. struct msm_vidc_core *core = vidc_core;
  159. u32 min_dev_reg_addr = 0, dev_reg_size = 0;
  160. u32 value;
  161. int rc = 0;
  162. if (!core) {
  163. d_vpr_e("%s: invalid params\n", __func__);
  164. return -EINVAL;
  165. }
  166. value = (u32)core->iface_q_table.align_device_addr;
  167. rc = __write_register(core, HFI_UC_REGION_ADDR_IRIS33, value);
  168. if (rc)
  169. return rc;
  170. value = SHARED_QSIZE;
  171. rc = __write_register(core, HFI_UC_REGION_SIZE_IRIS33, value);
  172. if (rc)
  173. return rc;
  174. value = (u32)core->iface_q_table.align_device_addr;
  175. rc = __write_register(core, HFI_QTBL_ADDR_IRIS33, value);
  176. if (rc)
  177. return rc;
  178. rc = __write_register(core, HFI_QTBL_INFO_IRIS33, HFI_QTBL_ENABLED);
  179. if (rc)
  180. return rc;
  181. if (core->mmap_buf.align_device_addr) {
  182. value = (u32)core->mmap_buf.align_device_addr;
  183. rc = __write_register(core, HFI_MMAP_ADDR_IRIS33, value);
  184. if (rc)
  185. return rc;
  186. } else {
  187. d_vpr_e("%s: skip mmap buffer programming\n", __func__);
  188. /* ignore the error for now for backward compatibility */
  189. /* return -EINVAL; */
  190. }
  191. rc = __get_device_region_info(core, &min_dev_reg_addr, &dev_reg_size);
  192. if (rc)
  193. return rc;
  194. if (min_dev_reg_addr && dev_reg_size) {
  195. rc = __write_register(core, HFI_DEVICE_REGION_ADDR_IRIS33, min_dev_reg_addr);
  196. if (rc)
  197. return rc;
  198. rc = __write_register(core, HFI_DEVICE_REGION_SIZE_IRIS33, dev_reg_size);
  199. if (rc)
  200. return rc;
  201. } else {
  202. d_vpr_e("%s: skip device region programming\n", __func__);
  203. /* ignore the error for now for backward compatibility */
  204. /* return -EINVAL; */
  205. }
  206. if (core->sfr.align_device_addr) {
  207. value = (u32)core->sfr.align_device_addr + VIDEO_ARCH_LX;
  208. rc = __write_register(core, HFI_SFR_ADDR_IRIS33, value);
  209. if (rc)
  210. return rc;
  211. }
  212. return 0;
  213. }
  214. static bool is_iris33_hw_power_collapsed(struct msm_vidc_core *core)
  215. {
  216. int rc = 0;
  217. u32 value = 0, pwr_status = 0;
  218. rc = __read_register(core, WRAPPER_CORE_POWER_STATUS, &value);
  219. if (rc)
  220. return false;
  221. /* if BIT(1) is 1 then video hw power is on else off */
  222. pwr_status = value & BIT(1);
  223. return pwr_status ? false : true;
  224. }
  225. static int __power_off_iris33_hardware(struct msm_vidc_core *core)
  226. {
  227. int rc = 0, i;
  228. u32 value = 0;
  229. bool pwr_collapsed = false;
  230. /*
  231. * Incase hw power control is enabled, for both CPU WD, video
  232. * hw unresponsive cases, check for power status to decide on
  233. * executing NOC reset sequence before disabling power. If there
  234. * is no CPU WD and hw power control is enabled, fw is expected
  235. * to power collapse video hw always.
  236. */
  237. if (is_core_sub_state(core, CORE_SUBSTATE_FW_PWR_CTRL)) {
  238. pwr_collapsed = is_iris33_hw_power_collapsed(core);
  239. if (is_core_sub_state(core, CORE_SUBSTATE_CPU_WATCHDOG) ||
  240. is_core_sub_state(core, CORE_SUBSTATE_VIDEO_UNRESPONSIVE)) {
  241. if (pwr_collapsed) {
  242. d_vpr_e("%s: video hw power collapsed %s\n",
  243. __func__, core->sub_state_name);
  244. goto disable_power;
  245. } else {
  246. d_vpr_e("%s: video hw is power ON %s\n",
  247. __func__, core->sub_state_name);
  248. }
  249. } else {
  250. if (!pwr_collapsed)
  251. d_vpr_e("%s: video hw is not power collapsed\n", __func__);
  252. d_vpr_h("%s: disabling hw power\n", __func__);
  253. goto disable_power;
  254. }
  255. }
  256. /*
  257. * check to make sure core clock branch enabled else
  258. * we cannot read vcodec top idle register
  259. */
  260. rc = __read_register(core, WRAPPER_CORE_CLOCK_CONFIG_IRIS33, &value);
  261. if (rc)
  262. return rc;
  263. if (value) {
  264. d_vpr_h("%s: core clock config not enabled, enabling it to read vcodec registers\n",
  265. __func__);
  266. rc = __write_register(core, WRAPPER_CORE_CLOCK_CONFIG_IRIS33, 0);
  267. if (rc)
  268. return rc;
  269. }
  270. /*
  271. * add MNoC idle check before collapsing MVS0 per HPG update
  272. * poll for NoC DMA idle -> HPG 6.1.1
  273. */
  274. for (i = 0; i < core->capabilities[NUM_VPP_PIPE].value; i++) {
  275. rc = __read_register_with_poll_timeout(core, VCODEC_SS_IDLE_STATUSn + 4*i,
  276. 0x400000, 0x400000, 2000, 20000);
  277. if (rc)
  278. d_vpr_h("%s: VCODEC_SS_IDLE_STATUSn (%d) is not idle (%#x)\n",
  279. __func__, i, value);
  280. }
  281. /* set MNoC to low power, set PD_NOC_QREQ (bit 0) */
  282. rc = __write_register_masked(core, AON_WRAPPER_MVP_NOC_LPI_CONTROL,
  283. 0x1, BIT(0));
  284. if (rc)
  285. return rc;
  286. rc = __read_register_with_poll_timeout(core, AON_WRAPPER_MVP_NOC_LPI_STATUS,
  287. 0x1, 0x1, 200, 2000);
  288. if (rc)
  289. d_vpr_h("%s: AON_WRAPPER_MVP_NOC_LPI_CONTROL failed\n", __func__);
  290. rc = __write_register_masked(core, AON_WRAPPER_MVP_NOC_LPI_CONTROL,
  291. 0x0, BIT(0));
  292. if (rc)
  293. return rc;
  294. /*
  295. * Reset both sides of 2 ahb2ahb_bridges (TZ and non-TZ)
  296. * do we need to check status register here?
  297. */
  298. rc = __write_register(core, CPU_CS_AHB_BRIDGE_SYNC_RESET, 0x3);
  299. if (rc)
  300. return rc;
  301. rc = __write_register(core, CPU_CS_AHB_BRIDGE_SYNC_RESET, 0x2);
  302. if (rc)
  303. return rc;
  304. rc = __write_register(core, CPU_CS_AHB_BRIDGE_SYNC_RESET, 0x0);
  305. if (rc)
  306. return rc;
  307. disable_power:
  308. /* power down process */
  309. rc = call_res_op(core, gdsc_off, core, "vcodec");
  310. if (rc) {
  311. d_vpr_e("%s: disable regulator vcodec failed\n", __func__);
  312. rc = 0;
  313. }
  314. rc = call_res_op(core, clk_disable, core, "video_cc_mvs0_clk");
  315. if (rc) {
  316. d_vpr_e("%s: disable unprepare video_cc_mvs0_clk failed\n", __func__);
  317. rc = 0;
  318. }
  319. return rc;
  320. }
  321. static int __power_off_iris33_controller(struct msm_vidc_core *core)
  322. {
  323. int rc = 0;
  324. int value = 0;
  325. u32 count = 0;
  326. /*
  327. * mask fal10_veto QLPAC error since fal10_veto can go 1
  328. * when pwwait == 0 and clamped to 0 -> HPG 6.1.2
  329. */
  330. rc = __write_register(core, CPU_CS_X2RPMh_IRIS33, 0x3);
  331. if (rc)
  332. return rc;
  333. /* Set Iris CPU NoC to Low power */
  334. rc = __write_register_masked(core, WRAPPER_IRIS_CPU_NOC_LPI_CONTROL,
  335. 0x1, BIT(0));
  336. if (rc)
  337. return rc;
  338. rc = __read_register_with_poll_timeout(core, WRAPPER_IRIS_CPU_NOC_LPI_STATUS,
  339. 0x1, 0x1, 200, 2000);
  340. if (rc)
  341. d_vpr_e("%s: WRAPPER_IRIS_CPU_NOC_LPI_CONTROL failed\n", __func__);
  342. /* Debug bridge LPI release */
  343. rc = __write_register(core, WRAPPER_DEBUG_BRIDGE_LPI_CONTROL_IRIS33, 0x0);
  344. if (rc)
  345. return rc;
  346. rc = __read_register_with_poll_timeout(core, WRAPPER_DEBUG_BRIDGE_LPI_STATUS_IRIS33,
  347. 0xffffffff, 0x0, 200, 2000);
  348. if (rc)
  349. d_vpr_e("%s: debug bridge release failed\n", __func__);
  350. /* Reset MVP QNS4PDXFIFO */
  351. rc = __write_register(core, WRAPPER_TZ_CTL_AXI_CLOCK_CONFIG, 0x3);
  352. if (rc)
  353. return rc;
  354. rc = __write_register(core, WRAPPER_TZ_QNS4PDXFIFO_RESET, 0x1);
  355. if (rc)
  356. return rc;
  357. rc = __write_register(core, WRAPPER_TZ_QNS4PDXFIFO_RESET, 0x0);
  358. if (rc)
  359. return rc;
  360. rc = __write_register(core, WRAPPER_TZ_CTL_AXI_CLOCK_CONFIG, 0x0);
  361. if (rc)
  362. return rc;
  363. /* assert and deassert axi and mvs0c resets */
  364. rc = call_res_op(core, reset_control_assert, core, "video_axi_reset");
  365. if (rc)
  366. d_vpr_e("%s: assert video_axi_reset failed\n", __func__);
  367. /* set retain mem and peripheral before asset mvs0c reset */
  368. rc = call_res_op(core, clk_set_flag, core,
  369. "video_cc_mvs0c_clk", CLKFLAG_RETAIN_MEM);
  370. if (rc)
  371. d_vpr_e("%s: set retain mem failed\n", __func__);
  372. rc = call_res_op(core, clk_set_flag, core,
  373. "video_cc_mvs0c_clk", CLKFLAG_RETAIN_PERIPH);
  374. if (rc)
  375. d_vpr_e("%s: set retain peripheral failed\n", __func__);
  376. rc = call_res_op(core, reset_control_assert, core, "video_mvs0c_reset");
  377. if (rc)
  378. d_vpr_e("%s: assert video_mvs0c_reset failed\n", __func__);
  379. usleep_range(400, 500);
  380. rc = call_res_op(core, reset_control_deassert, core, "video_axi_reset");
  381. if (rc)
  382. d_vpr_e("%s: de-assert video_axi_reset failed\n", __func__);
  383. rc = call_res_op(core, reset_control_deassert, core, "video_mvs0c_reset");
  384. if (rc)
  385. d_vpr_e("%s: de-assert video_mvs0c_reset failed\n", __func__);
  386. /* Disable MVP NoC clock */
  387. rc = __write_register_masked(core, AON_WRAPPER_MVP_NOC_CORE_CLK_CONTROL,
  388. 0x1, BIT(0));
  389. if (rc)
  390. return rc;
  391. /* enable MVP NoC reset */
  392. rc = __write_register_masked(core, AON_WRAPPER_MVP_NOC_CORE_SW_RESET,
  393. 0x1, BIT(0));
  394. if (rc)
  395. return rc;
  396. /*
  397. * need to acquire "video_xo_reset" before assert and release
  398. * after de-assert "video_xo_reset" reset clock to avoid other
  399. * drivers (eva driver) operating on this shared reset clock
  400. * and AON_WRAPPER_SPARE register in parallel.
  401. */
  402. count = 0;
  403. do {
  404. rc = call_res_op(core, reset_control_acquire, core, "video_xo_reset");
  405. if (rc) {
  406. d_vpr_e("%s: failed to acquire video_xo_reset control\n", __func__);
  407. } else {
  408. count++;
  409. usleep_range(1000, 1000);
  410. }
  411. } while (rc && count < 100);
  412. if (count >= 100) {
  413. d_vpr_e("%s: timeout acquiring video_xo_reset\n", __func__);
  414. goto skip_video_xo_reset;
  415. }
  416. /* poll AON spare register bit0 to become zero with 50ms timeout */
  417. rc = __read_register_with_poll_timeout(core, AON_WRAPPER_SPARE,
  418. 0x1, 0x0, 1000, 50 * 1000);
  419. if (rc)
  420. d_vpr_e("%s: AON spare register is not zero\n", __func__);
  421. /* enable bit(1) to avoid cvp noc xo reset */
  422. rc = __write_register(core, AON_WRAPPER_SPARE, value|0x2);
  423. if (rc)
  424. return rc;
  425. /* assert video_cc XO reset */
  426. rc = call_res_op(core, reset_control_assert, core, "video_xo_reset");
  427. if (rc)
  428. d_vpr_e("%s: assert video_xo_reset failed\n", __func__);
  429. /* De-assert MVP NoC reset */
  430. rc = __write_register_masked(core, AON_WRAPPER_MVP_NOC_CORE_SW_RESET,
  431. 0x0, BIT(0));
  432. if (rc)
  433. d_vpr_e("%s: MVP_NOC_CORE_SW_RESET failed\n", __func__);
  434. /* De-assert video_cc XO reset */
  435. usleep_range(80, 100);
  436. rc = call_res_op(core, reset_control_deassert, core, "video_xo_reset");
  437. if (rc)
  438. d_vpr_e("%s: deassert video_xo_reset failed\n", __func__);
  439. /* reset AON spare register */
  440. rc = __write_register(core, AON_WRAPPER_SPARE, 0x0);
  441. if (rc)
  442. return rc;
  443. /* release reset control for other consumers */
  444. rc = call_res_op(core, reset_control_release, core, "video_xo_reset");
  445. if (rc)
  446. d_vpr_e("%s: failed to release video_xo_reset reset\n", __func__);
  447. skip_video_xo_reset:
  448. /* Enable MVP NoC clock */
  449. rc = __write_register_masked(core, AON_WRAPPER_MVP_NOC_CORE_CLK_CONTROL,
  450. 0x0, BIT(0));
  451. if (rc)
  452. return rc;
  453. /* remove retain mem and retain peripheral */
  454. rc = call_res_op(core, clk_set_flag, core,
  455. "video_cc_mvs0c_clk", CLKFLAG_NORETAIN_PERIPH);
  456. if (rc)
  457. d_vpr_e("%s: set noretain peripheral failed\n", __func__);
  458. rc = call_res_op(core, clk_set_flag, core,
  459. "video_cc_mvs0c_clk", CLKFLAG_NORETAIN_MEM);
  460. if (rc)
  461. d_vpr_e("%s: set noretain mem failed\n", __func__);
  462. /* Turn off MVP MVS0C core clock */
  463. rc = call_res_op(core, clk_disable, core, "video_cc_mvs0c_clk");
  464. if (rc) {
  465. d_vpr_e("%s: disable unprepare video_cc_mvs0c_clk failed\n", __func__);
  466. rc = 0;
  467. }
  468. /* power down process */
  469. rc = call_res_op(core, gdsc_off, core, "iris-ctl");
  470. if (rc) {
  471. d_vpr_e("%s: disable regulator iris-ctl failed\n", __func__);
  472. rc = 0;
  473. }
  474. /* Turn off GCC AXI clock */
  475. rc = call_res_op(core, clk_disable, core, "gcc_video_axi0_clk");
  476. if (rc) {
  477. d_vpr_e("%s: disable unprepare gcc_video_axi0_clk failed\n", __func__);
  478. rc = 0;
  479. }
  480. return rc;
  481. }
  482. static int __power_off_iris33(struct msm_vidc_core *core)
  483. {
  484. int rc = 0;
  485. if (!core || !core->capabilities) {
  486. d_vpr_e("%s: invalid params\n", __func__);
  487. return -EINVAL;
  488. }
  489. if (!is_core_sub_state(core, CORE_SUBSTATE_POWER_ENABLE))
  490. return 0;
  491. /**
  492. * Reset video_cc_mvs0_clk_src value to resolve MMRM high video
  493. * clock projection issue.
  494. */
  495. rc = call_res_op(core, set_clks, core, 0);
  496. if (rc)
  497. d_vpr_e("%s: resetting clocks failed\n", __func__);
  498. if (__power_off_iris33_hardware(core))
  499. d_vpr_e("%s: failed to power off hardware\n", __func__);
  500. if (__power_off_iris33_controller(core))
  501. d_vpr_e("%s: failed to power off controller\n", __func__);
  502. rc = call_res_op(core, set_bw, core, 0, 0);
  503. if (rc)
  504. d_vpr_e("%s: failed to unvote buses\n", __func__);
  505. if (!call_venus_op(core, watchdog, core, core->intr_status))
  506. disable_irq_nosync(core->resource->irq);
  507. msm_vidc_change_core_sub_state(core, CORE_SUBSTATE_POWER_ENABLE, 0, __func__);
  508. return rc;
  509. }
  510. static int __power_on_iris33_controller(struct msm_vidc_core *core)
  511. {
  512. int rc = 0;
  513. rc = call_res_op(core, gdsc_on, core, "iris-ctl");
  514. if (rc)
  515. goto fail_regulator;
  516. rc = call_res_op(core, reset_control_assert, core, "video_axi_reset");
  517. if (rc)
  518. goto fail_reset_assert_axi;
  519. rc = call_res_op(core, reset_control_assert, core, "video_mvs0c_reset");
  520. if (rc)
  521. goto fail_reset_assert_mvs0c;
  522. /* add usleep between assert and deassert */
  523. usleep_range(1000, 1100);
  524. rc = call_res_op(core, reset_control_deassert, core, "video_axi_reset");
  525. if (rc)
  526. goto fail_reset_deassert_axi;
  527. rc = call_res_op(core, reset_control_deassert, core, "video_mvs0c_reset");
  528. if (rc)
  529. goto fail_reset_deassert_mvs0c;
  530. rc = call_res_op(core, clk_enable, core, "gcc_video_axi0_clk");
  531. if (rc)
  532. goto fail_clk_axi;
  533. rc = call_res_op(core, clk_enable, core, "video_cc_mvs0c_clk");
  534. if (rc)
  535. goto fail_clk_controller;
  536. return 0;
  537. fail_clk_controller:
  538. call_res_op(core, clk_disable, core, "gcc_video_axi0_clk");
  539. fail_clk_axi:
  540. fail_reset_deassert_mvs0c:
  541. fail_reset_deassert_axi:
  542. call_res_op(core, reset_control_deassert, core, "video_mvs0c_reset");
  543. fail_reset_assert_mvs0c:
  544. call_res_op(core, reset_control_deassert, core, "video_axi_reset");
  545. fail_reset_assert_axi:
  546. call_res_op(core, gdsc_off, core, "iris-ctl");
  547. fail_regulator:
  548. return rc;
  549. }
  550. static int __power_on_iris33_hardware(struct msm_vidc_core *core)
  551. {
  552. int rc = 0;
  553. rc = call_res_op(core, gdsc_on, core, "vcodec");
  554. if (rc)
  555. goto fail_regulator;
  556. rc = call_res_op(core, clk_enable, core, "video_cc_mvs0_clk");
  557. if (rc)
  558. goto fail_clk_controller;
  559. return 0;
  560. fail_clk_controller:
  561. call_res_op(core, gdsc_off, core, "vcodec");
  562. fail_regulator:
  563. return rc;
  564. }
  565. static int __power_on_iris33(struct msm_vidc_core *core)
  566. {
  567. struct frequency_table *freq_tbl;
  568. u32 freq = 0;
  569. int rc = 0;
  570. if (is_core_sub_state(core, CORE_SUBSTATE_POWER_ENABLE))
  571. return 0;
  572. if (!core_in_valid_state(core)) {
  573. d_vpr_e("%s: invalid core state %s\n",
  574. __func__, core_state_name(core->state));
  575. return -EINVAL;
  576. }
  577. /* Vote for all hardware resources */
  578. rc = call_res_op(core, set_bw, core, INT_MAX, INT_MAX);
  579. if (rc) {
  580. d_vpr_e("%s: failed to vote buses, rc %d\n", __func__, rc);
  581. goto fail_vote_buses;
  582. }
  583. rc = __power_on_iris33_controller(core);
  584. if (rc) {
  585. d_vpr_e("%s: failed to power on iris33 controller\n", __func__);
  586. goto fail_power_on_controller;
  587. }
  588. rc = __power_on_iris33_hardware(core);
  589. if (rc) {
  590. d_vpr_e("%s: failed to power on iris33 hardware\n", __func__);
  591. goto fail_power_on_hardware;
  592. }
  593. /* video controller and hardware powered on successfully */
  594. rc = msm_vidc_change_core_sub_state(core, 0, CORE_SUBSTATE_POWER_ENABLE, __func__);
  595. if (rc)
  596. goto fail_power_on_substate;
  597. freq_tbl = core->resource->freq_set.freq_tbl;
  598. freq = core->power.clk_freq ? core->power.clk_freq :
  599. freq_tbl[0].freq;
  600. rc = call_res_op(core, set_clks, core, freq);
  601. if (rc) {
  602. d_vpr_e("%s: failed to scale clocks\n", __func__);
  603. rc = 0;
  604. }
  605. /*
  606. * Re-program all of the registers that get reset as a result of
  607. * regulator_disable() and _enable()
  608. */
  609. __set_registers(core);
  610. __interrupt_init_iris33(core);
  611. core->intr_status = 0;
  612. enable_irq(core->resource->irq);
  613. return rc;
  614. fail_power_on_substate:
  615. __power_off_iris33_hardware(core);
  616. fail_power_on_hardware:
  617. __power_off_iris33_controller(core);
  618. fail_power_on_controller:
  619. call_res_op(core, set_bw, core, 0, 0);
  620. fail_vote_buses:
  621. msm_vidc_change_core_sub_state(core, CORE_SUBSTATE_POWER_ENABLE, 0, __func__);
  622. return rc;
  623. }
  624. static int __prepare_pc_iris33(struct msm_vidc_core *vidc_core)
  625. {
  626. int rc = 0;
  627. u32 wfi_status = 0, idle_status = 0, pc_ready = 0;
  628. u32 ctrl_status = 0;
  629. struct msm_vidc_core *core = vidc_core;
  630. if (!core) {
  631. d_vpr_e("%s: invalid params\n", __func__);
  632. return -EINVAL;
  633. }
  634. rc = __read_register(core, HFI_CTRL_STATUS_IRIS33, &ctrl_status);
  635. if (rc)
  636. return rc;
  637. pc_ready = ctrl_status & HFI_CTRL_PC_READY;
  638. idle_status = ctrl_status & BIT(30);
  639. if (pc_ready) {
  640. d_vpr_h("Already in pc_ready state\n");
  641. return 0;
  642. }
  643. rc = __read_register(core, WRAPPER_TZ_CPU_STATUS, &wfi_status);
  644. if (rc)
  645. return rc;
  646. wfi_status &= BIT(0);
  647. if (!wfi_status || !idle_status) {
  648. d_vpr_e("Skipping PC, wfi status not set\n");
  649. goto skip_power_off;
  650. }
  651. rc = __prepare_pc(core);
  652. if (rc) {
  653. d_vpr_e("Failed __prepare_pc %d\n", rc);
  654. goto skip_power_off;
  655. }
  656. rc = __read_register_with_poll_timeout(core, HFI_CTRL_STATUS_IRIS33,
  657. HFI_CTRL_PC_READY, HFI_CTRL_PC_READY, 250, 2500);
  658. if (rc) {
  659. d_vpr_e("%s: Skip PC. Ctrl status not set\n", __func__);
  660. goto skip_power_off;
  661. }
  662. rc = __read_register_with_poll_timeout(core, WRAPPER_TZ_CPU_STATUS,
  663. BIT(0), 0x1, 250, 2500);
  664. if (rc) {
  665. d_vpr_e("%s: Skip PC. Wfi status not set\n", __func__);
  666. goto skip_power_off;
  667. }
  668. return rc;
  669. skip_power_off:
  670. rc = __read_register(core, HFI_CTRL_STATUS_IRIS33, &ctrl_status);
  671. if (rc)
  672. return rc;
  673. rc = __read_register(core, WRAPPER_TZ_CPU_STATUS, &wfi_status);
  674. if (rc)
  675. return rc;
  676. wfi_status &= BIT(0);
  677. d_vpr_e("Skip PC, wfi=%#x, idle=%#x, pcr=%#x, ctrl=%#x)\n",
  678. wfi_status, idle_status, pc_ready, ctrl_status);
  679. return -EAGAIN;
  680. }
  681. static int __raise_interrupt_iris33(struct msm_vidc_core *vidc_core)
  682. {
  683. struct msm_vidc_core *core = vidc_core;
  684. int rc = 0;
  685. if (!core) {
  686. d_vpr_e("%s: invalid params\n", __func__);
  687. return -EINVAL;
  688. }
  689. rc = __write_register(core, CPU_IC_SOFTINT_IRIS33, 1 << CPU_IC_SOFTINT_H2A_SHFT_IRIS33);
  690. if (rc)
  691. return rc;
  692. return 0;
  693. }
  694. static int __watchdog_iris33(struct msm_vidc_core *vidc_core, u32 intr_status)
  695. {
  696. int rc = 0;
  697. struct msm_vidc_core *core = vidc_core;
  698. if (!core) {
  699. d_vpr_e("%s: invalid params\n", __func__);
  700. return -EINVAL;
  701. }
  702. if (intr_status & WRAPPER_INTR_STATUS_A2HWD_BMSK_IRIS33) {
  703. d_vpr_e("%s: received watchdog interrupt\n", __func__);
  704. rc = 1;
  705. }
  706. return rc;
  707. }
  708. static int __noc_error_info_iris33(struct msm_vidc_core *vidc_core)
  709. {
  710. struct msm_vidc_core *core = vidc_core;
  711. if (!core) {
  712. d_vpr_e("%s: invalid params\n", __func__);
  713. return -EINVAL;
  714. }
  715. /*
  716. * we are not supposed to access vcodec subsystem registers
  717. * unless vcodec core clock WRAPPER_CORE_CLOCK_CONFIG_IRIS33 is enabled.
  718. * core clock might have been disabled by video firmware as part of
  719. * inter frame power collapse (power plane control feature).
  720. */
  721. /*
  722. val = __read_register(core, VCODEC_NOC_ERL_MAIN_SWID_LOW);
  723. d_vpr_e("VCODEC_NOC_ERL_MAIN_SWID_LOW: %#x\n", val);
  724. val = __read_register(core, VCODEC_NOC_ERL_MAIN_SWID_HIGH);
  725. d_vpr_e("VCODEC_NOC_ERL_MAIN_SWID_HIGH: %#x\n", val);
  726. val = __read_register(core, VCODEC_NOC_ERL_MAIN_MAINCTL_LOW);
  727. d_vpr_e("VCODEC_NOC_ERL_MAIN_MAINCTL_LOW: %#x\n", val);
  728. val = __read_register(core, VCODEC_NOC_ERL_MAIN_ERRVLD_LOW);
  729. d_vpr_e("VCODEC_NOC_ERL_MAIN_ERRVLD_LOW: %#x\n", val);
  730. val = __read_register(core, VCODEC_NOC_ERL_MAIN_ERRCLR_LOW);
  731. d_vpr_e("VCODEC_NOC_ERL_MAIN_ERRCLR_LOW: %#x\n", val);
  732. val = __read_register(core, VCODEC_NOC_ERL_MAIN_ERRLOG0_LOW);
  733. d_vpr_e("VCODEC_NOC_ERL_MAIN_ERRLOG0_LOW: %#x\n", val);
  734. val = __read_register(core, VCODEC_NOC_ERL_MAIN_ERRLOG0_HIGH);
  735. d_vpr_e("VCODEC_NOC_ERL_MAIN_ERRLOG0_HIGH: %#x\n", val);
  736. val = __read_register(core, VCODEC_NOC_ERL_MAIN_ERRLOG1_LOW);
  737. d_vpr_e("VCODEC_NOC_ERL_MAIN_ERRLOG1_LOW: %#x\n", val);
  738. val = __read_register(core, VCODEC_NOC_ERL_MAIN_ERRLOG1_HIGH);
  739. d_vpr_e("VCODEC_NOC_ERL_MAIN_ERRLOG1_HIGH: %#x\n", val);
  740. val = __read_register(core, VCODEC_NOC_ERL_MAIN_ERRLOG2_LOW);
  741. d_vpr_e("VCODEC_NOC_ERL_MAIN_ERRLOG2_LOW: %#x\n", val);
  742. val = __read_register(core, VCODEC_NOC_ERL_MAIN_ERRLOG2_HIGH);
  743. d_vpr_e("VCODEC_NOC_ERL_MAIN_ERRLOG2_HIGH: %#x\n", val);
  744. val = __read_register(core, VCODEC_NOC_ERL_MAIN_ERRLOG3_LOW);
  745. d_vpr_e("VCODEC_NOC_ERL_MAIN_ERRLOG3_LOW: %#x\n", val);
  746. val = __read_register(core, VCODEC_NOC_ERL_MAIN_ERRLOG3_HIGH);
  747. d_vpr_e("VCODEC_NOC_ERL_MAIN_ERRLOG3_HIGH: %#x\n", val);
  748. */
  749. return 0;
  750. }
  751. static int __clear_interrupt_iris33(struct msm_vidc_core *vidc_core)
  752. {
  753. struct msm_vidc_core *core = vidc_core;
  754. u32 intr_status = 0, mask = 0;
  755. int rc = 0;
  756. if (!core) {
  757. d_vpr_e("%s: NULL core\n", __func__);
  758. return 0;
  759. }
  760. rc = __read_register(core, WRAPPER_INTR_STATUS_IRIS33, &intr_status);
  761. if (rc)
  762. return rc;
  763. mask = (WRAPPER_INTR_STATUS_A2H_BMSK_IRIS33|
  764. WRAPPER_INTR_STATUS_A2HWD_BMSK_IRIS33|
  765. HFI_CTRL_VCODEC_IDLE);
  766. if (intr_status & mask) {
  767. core->intr_status |= intr_status;
  768. core->reg_count++;
  769. d_vpr_l("INTERRUPT: times: %d interrupt_status: %d\n",
  770. core->reg_count, intr_status);
  771. } else {
  772. core->spur_count++;
  773. }
  774. rc = __write_register(core, CPU_CS_A2HSOFTINTCLR_IRIS33, 1);
  775. if (rc)
  776. return rc;
  777. return 0;
  778. }
  779. static int __boot_firmware_iris33(struct msm_vidc_core *vidc_core)
  780. {
  781. int rc = 0;
  782. u32 ctrl_init_val = 0, ctrl_status = 0, count = 0, max_tries = 1000;
  783. struct msm_vidc_core *core = vidc_core;
  784. if (!core) {
  785. d_vpr_e("%s: NULL core\n", __func__);
  786. return 0;
  787. }
  788. rc = __program_bootup_registers_iris33(core);
  789. if (rc)
  790. return rc;
  791. ctrl_init_val = BIT(0);
  792. rc = __write_register(core, HFI_CTRL_INIT_IRIS33, ctrl_init_val);
  793. if (rc)
  794. return rc;
  795. while (count < max_tries) {
  796. rc = __read_register(core, HFI_CTRL_STATUS_IRIS33, &ctrl_status);
  797. if (rc)
  798. return rc;
  799. if ((ctrl_status & HFI_CTRL_ERROR_FATAL) ||
  800. (ctrl_status & HFI_CTRL_ERROR_UC_REGION_NOT_SET)) {
  801. d_vpr_e("%s: boot firmware failed, ctrl status %#x\n",
  802. __func__, ctrl_status);
  803. return -EINVAL;
  804. } else if (ctrl_status & HFI_CTRL_READY) {
  805. d_vpr_h("%s: boot firmware is successful, ctrl status %#x\n",
  806. __func__, ctrl_status);
  807. break;
  808. }
  809. usleep_range(50, 100);
  810. count++;
  811. }
  812. if (count >= max_tries) {
  813. d_vpr_e("Error booting up vidc firmware, ctrl status %#x\n", ctrl_status);
  814. return -ETIME;
  815. }
  816. /* Enable interrupt before sending commands to venus */
  817. rc = __write_register(core, CPU_CS_H2XSOFTINTEN_IRIS33, 0x1);
  818. if (rc)
  819. return rc;
  820. rc = __write_register(core, CPU_CS_X2RPMh_IRIS33, 0x0);
  821. if (rc)
  822. return rc;
  823. return rc;
  824. }
  825. int msm_vidc_decide_work_mode_iris33(struct msm_vidc_inst* inst)
  826. {
  827. u32 work_mode;
  828. struct v4l2_format *inp_f;
  829. u32 width, height;
  830. bool res_ok = false;
  831. if (!inst || !inst->capabilities) {
  832. d_vpr_e("%s: invalid params\n", __func__);
  833. return -EINVAL;
  834. }
  835. work_mode = MSM_VIDC_STAGE_2;
  836. inp_f = &inst->fmts[INPUT_PORT];
  837. if (is_image_decode_session(inst))
  838. work_mode = MSM_VIDC_STAGE_1;
  839. if (is_image_session(inst))
  840. goto exit;
  841. if (is_decode_session(inst)) {
  842. height = inp_f->fmt.pix_mp.height;
  843. width = inp_f->fmt.pix_mp.width;
  844. res_ok = res_is_less_than(width, height, 1280, 720);
  845. if (inst->capabilities->cap[CODED_FRAMES].value ==
  846. CODED_FRAMES_INTERLACE ||
  847. inst->capabilities->cap[LOWLATENCY_MODE].value ||
  848. res_ok) {
  849. work_mode = MSM_VIDC_STAGE_1;
  850. }
  851. } else if (is_encode_session(inst)) {
  852. height = inst->crop.height;
  853. width = inst->crop.width;
  854. res_ok = !res_is_greater_than(width, height, 4096, 2160);
  855. if (res_ok &&
  856. (inst->capabilities->cap[LOWLATENCY_MODE].value)) {
  857. work_mode = MSM_VIDC_STAGE_1;
  858. }
  859. if (inst->capabilities->cap[SLICE_MODE].value ==
  860. V4L2_MPEG_VIDEO_MULTI_SLICE_MODE_MAX_BYTES) {
  861. work_mode = MSM_VIDC_STAGE_1;
  862. }
  863. if (inst->capabilities->cap[LOSSLESS].value)
  864. work_mode = MSM_VIDC_STAGE_2;
  865. if (!inst->capabilities->cap[GOP_SIZE].value)
  866. work_mode = MSM_VIDC_STAGE_2;
  867. } else {
  868. i_vpr_e(inst, "%s: invalid session type\n", __func__);
  869. return -EINVAL;
  870. }
  871. exit:
  872. i_vpr_h(inst, "Configuring work mode = %u low latency = %u, gop size = %u\n",
  873. work_mode, inst->capabilities->cap[LOWLATENCY_MODE].value,
  874. inst->capabilities->cap[GOP_SIZE].value);
  875. msm_vidc_update_cap_value(inst, STAGE, work_mode, __func__);
  876. return 0;
  877. }
  878. int msm_vidc_decide_work_route_iris33(struct msm_vidc_inst* inst)
  879. {
  880. u32 work_route;
  881. struct msm_vidc_core* core;
  882. if (!inst || !inst->core) {
  883. d_vpr_e("%s: invalid params\n", __func__);
  884. return -EINVAL;
  885. }
  886. core = inst->core;
  887. work_route = core->capabilities[NUM_VPP_PIPE].value;
  888. if (is_image_session(inst))
  889. goto exit;
  890. if (is_decode_session(inst)) {
  891. if (inst->capabilities->cap[CODED_FRAMES].value ==
  892. CODED_FRAMES_INTERLACE)
  893. work_route = MSM_VIDC_PIPE_1;
  894. } else if (is_encode_session(inst)) {
  895. u32 slice_mode;
  896. slice_mode = inst->capabilities->cap[SLICE_MODE].value;
  897. /*TODO Pipe=1 for legacy CBR*/
  898. if (slice_mode == V4L2_MPEG_VIDEO_MULTI_SLICE_MODE_MAX_BYTES)
  899. work_route = MSM_VIDC_PIPE_1;
  900. } else {
  901. i_vpr_e(inst, "%s: invalid session type\n", __func__);
  902. return -EINVAL;
  903. }
  904. exit:
  905. i_vpr_h(inst, "Configuring work route = %u", work_route);
  906. msm_vidc_update_cap_value(inst, PIPE, work_route, __func__);
  907. return 0;
  908. }
  909. int msm_vidc_decide_quality_mode_iris33(struct msm_vidc_inst* inst)
  910. {
  911. struct msm_vidc_inst_capability* capability = NULL;
  912. struct msm_vidc_core *core;
  913. u32 mbpf, mbps, max_hq_mbpf, max_hq_mbps;
  914. u32 mode = MSM_VIDC_POWER_SAVE_MODE;
  915. if (!inst || !inst->capabilities) {
  916. d_vpr_e("%s: invalid params\n", __func__);
  917. return -EINVAL;
  918. }
  919. capability = inst->capabilities;
  920. if (!is_encode_session(inst))
  921. return 0;
  922. /* image or lossless or all intra runs at quality mode */
  923. if (is_image_session(inst) || capability->cap[LOSSLESS].value ||
  924. capability->cap[ALL_INTRA].value) {
  925. mode = MSM_VIDC_MAX_QUALITY_MODE;
  926. goto decision_done;
  927. }
  928. /* for lesser complexity, make LP for all resolution */
  929. if (capability->cap[COMPLEXITY].value < DEFAULT_COMPLEXITY) {
  930. mode = MSM_VIDC_POWER_SAVE_MODE;
  931. goto decision_done;
  932. }
  933. mbpf = msm_vidc_get_mbs_per_frame(inst);
  934. mbps = mbpf * msm_vidc_get_fps(inst);
  935. core = inst->core;
  936. max_hq_mbpf = core->capabilities[MAX_MBPF_HQ].value;;
  937. max_hq_mbps = core->capabilities[MAX_MBPS_HQ].value;;
  938. if (!is_realtime_session(inst)) {
  939. if (((capability->cap[COMPLEXITY].flags & CAP_FLAG_CLIENT_SET) &&
  940. (capability->cap[COMPLEXITY].value >= DEFAULT_COMPLEXITY)) ||
  941. mbpf <= max_hq_mbpf) {
  942. mode = MSM_VIDC_MAX_QUALITY_MODE;
  943. goto decision_done;
  944. }
  945. }
  946. if (mbpf <= max_hq_mbpf && mbps <= max_hq_mbps)
  947. mode = MSM_VIDC_MAX_QUALITY_MODE;
  948. decision_done:
  949. msm_vidc_update_cap_value(inst, QUALITY_MODE, mode, __func__);
  950. return 0;
  951. }
  952. int msm_vidc_adjust_bitrate_boost_iris33(void* instance, struct v4l2_ctrl *ctrl)
  953. {
  954. struct msm_vidc_inst_capability* capability = NULL;
  955. s32 adjusted_value;
  956. struct msm_vidc_inst *inst = (struct msm_vidc_inst *) instance;
  957. s32 rc_type = -1;
  958. u32 width, height, frame_rate;
  959. struct v4l2_format *f;
  960. u32 max_bitrate = 0, bitrate = 0;
  961. if (!inst || !inst->capabilities) {
  962. d_vpr_e("%s: invalid params\n", __func__);
  963. return -EINVAL;
  964. }
  965. capability = inst->capabilities;
  966. adjusted_value = ctrl ? ctrl->val :
  967. capability->cap[BITRATE_BOOST].value;
  968. if (inst->bufq[OUTPUT_PORT].vb2q->streaming)
  969. return 0;
  970. if (msm_vidc_get_parent_value(inst, BITRATE_BOOST,
  971. BITRATE_MODE, &rc_type, __func__))
  972. return -EINVAL;
  973. /*
  974. * Bitrate Boost are supported only for VBR rc type.
  975. * Hence, do not adjust or set to firmware for non VBR rc's
  976. */
  977. if (rc_type != HFI_RC_VBR_CFR) {
  978. adjusted_value = 0;
  979. goto adjust;
  980. }
  981. frame_rate = inst->capabilities->cap[FRAME_RATE].value >> 16;
  982. f= &inst->fmts[OUTPUT_PORT];
  983. width = f->fmt.pix_mp.width;
  984. height = f->fmt.pix_mp.height;
  985. /*
  986. * honor client set bitrate boost
  987. * if client did not set, keep max bitrate boost upto 4k@60fps
  988. * and remove bitrate boost after 4k@60fps
  989. */
  990. if (capability->cap[BITRATE_BOOST].flags & CAP_FLAG_CLIENT_SET) {
  991. /* accept client set bitrate boost value as is */
  992. } else {
  993. if (res_is_less_than_or_equal_to(width, height, 4096, 2176) &&
  994. frame_rate <= 60)
  995. adjusted_value = MAX_BITRATE_BOOST;
  996. else
  997. adjusted_value = 0;
  998. }
  999. max_bitrate = msm_vidc_get_max_bitrate(inst);
  1000. bitrate = inst->capabilities->cap[BIT_RATE].value;
  1001. if (adjusted_value) {
  1002. if ((bitrate + bitrate / (100 / adjusted_value)) > max_bitrate) {
  1003. i_vpr_h(inst,
  1004. "%s: bitrate %d is beyond max bitrate %d, remove bitrate boost\n",
  1005. __func__, max_bitrate, bitrate);
  1006. adjusted_value = 0;
  1007. }
  1008. }
  1009. adjust:
  1010. msm_vidc_update_cap_value(inst, BITRATE_BOOST, adjusted_value, __func__);
  1011. return 0;
  1012. }
  1013. static struct msm_vidc_venus_ops iris33_ops = {
  1014. .boot_firmware = __boot_firmware_iris33,
  1015. .raise_interrupt = __raise_interrupt_iris33,
  1016. .clear_interrupt = __clear_interrupt_iris33,
  1017. .power_on = __power_on_iris33,
  1018. .power_off = __power_off_iris33,
  1019. .prepare_pc = __prepare_pc_iris33,
  1020. .watchdog = __watchdog_iris33,
  1021. .noc_error_info = __noc_error_info_iris33,
  1022. };
  1023. static struct msm_vidc_session_ops msm_session_ops = {
  1024. .buffer_size = msm_buffer_size_iris33,
  1025. .min_count = msm_buffer_min_count_iris33,
  1026. .extra_count = msm_buffer_extra_count_iris33,
  1027. .calc_freq = msm_vidc_calc_freq_iris33,
  1028. .calc_bw = msm_vidc_calc_bw_iris33,
  1029. .decide_work_route = msm_vidc_decide_work_route_iris33,
  1030. .decide_work_mode = msm_vidc_decide_work_mode_iris33,
  1031. .decide_quality_mode = msm_vidc_decide_quality_mode_iris33,
  1032. };
  1033. int msm_vidc_init_iris33(struct msm_vidc_core *core)
  1034. {
  1035. if (!core) {
  1036. d_vpr_e("%s: invalid params\n", __func__);
  1037. return -EINVAL;
  1038. }
  1039. d_vpr_h("%s()\n", __func__);
  1040. core->venus_ops = &iris33_ops;
  1041. core->session_ops = &msm_session_ops;
  1042. return 0;
  1043. }
  1044. int msm_vidc_deinit_iris33(struct msm_vidc_core *core)
  1045. {
  1046. /* do nothing */
  1047. return 0;
  1048. }