sde_encoder_dce.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2016-2020 The Linux Foundation. All rights reserved.
  4. */
  5. #include <linux/kthread.h>
  6. #include <linux/debugfs.h>
  7. #include <linux/seq_file.h>
  8. #include <linux/sde_rsc.h>
  9. #include "msm_drv.h"
  10. #include "sde_kms.h"
  11. #include <drm/drm_crtc.h>
  12. #include <drm/drm_crtc_helper.h>
  13. #include "sde_hwio.h"
  14. #include "sde_hw_catalog.h"
  15. #include "sde_hw_intf.h"
  16. #include "sde_hw_ctl.h"
  17. #include "sde_formats.h"
  18. #include "sde_encoder_phys.h"
  19. #include "sde_power_handle.h"
  20. #include "sde_hw_dsc.h"
  21. #include "sde_hw_vdc.h"
  22. #include "sde_crtc.h"
  23. #include "sde_trace.h"
  24. #include "sde_core_irq.h"
  25. #include "sde_dsc_helper.h"
  26. #include "sde_vdc_helper.h"
  27. #define SDE_DEBUG_DCE(e, fmt, ...) SDE_DEBUG("enc%d " fmt,\
  28. (e) ? (e)->base.base.id : -1, ##__VA_ARGS__)
  29. #define SDE_ERROR_DCE(e, fmt, ...) SDE_ERROR("enc%d " fmt,\
  30. (e) ? (e)->base.base.id : -1, ##__VA_ARGS__)
  31. bool sde_encoder_is_dsc_merge(struct drm_encoder *drm_enc)
  32. {
  33. enum sde_rm_topology_name topology;
  34. struct sde_encoder_virt *sde_enc;
  35. struct drm_connector *drm_conn;
  36. if (!drm_enc)
  37. return false;
  38. sde_enc = to_sde_encoder_virt(drm_enc);
  39. if (!sde_enc->cur_master)
  40. return false;
  41. drm_conn = sde_enc->cur_master->connector;
  42. if (!drm_conn)
  43. return false;
  44. topology = sde_connector_get_topology_name(drm_conn);
  45. if (topology == SDE_RM_TOPOLOGY_DUALPIPE_DSCMERGE)
  46. return true;
  47. return false;
  48. }
  49. static int _dce_dsc_update_pic_dim(struct msm_display_dsc_info *dsc,
  50. int pic_width, int pic_height)
  51. {
  52. if (!dsc || !pic_width || !pic_height) {
  53. SDE_ERROR("invalid input: pic_width=%d pic_height=%d\n",
  54. pic_width, pic_height);
  55. return -EINVAL;
  56. }
  57. if ((pic_width % dsc->config.slice_width) ||
  58. (pic_height % dsc->config.slice_height)) {
  59. SDE_ERROR("pic_dim=%dx%d has to be multiple of slice=%dx%d\n",
  60. pic_width, pic_height,
  61. dsc->config.slice_width, dsc->config.slice_height);
  62. return -EINVAL;
  63. }
  64. dsc->config.pic_width = pic_width;
  65. dsc->config.pic_height = pic_height;
  66. return 0;
  67. }
  68. static int _dce_vdc_update_pic_dim(struct msm_display_vdc_info *vdc,
  69. int frame_width, int frame_height)
  70. {
  71. if (!vdc || !frame_width || !frame_height) {
  72. SDE_ERROR("invalid input: frame_width=%d frame_height=%d\n",
  73. frame_width, frame_height);
  74. return -EINVAL;
  75. }
  76. if ((frame_width % vdc->slice_width) ||
  77. (frame_height % vdc->slice_height)) {
  78. SDE_ERROR("pic_dim=%dx%d has to be multiple of slice=%dx%d\n",
  79. frame_width, frame_height,
  80. vdc->slice_width, vdc->slice_height);
  81. return -EINVAL;
  82. }
  83. vdc->frame_width = frame_width;
  84. vdc->frame_height = frame_height;
  85. return 0;
  86. }
  87. static int _dce_dsc_initial_line_calc(struct msm_display_dsc_info *dsc,
  88. int enc_ip_width,
  89. int dsc_cmn_mode)
  90. {
  91. int max_ssm_delay, max_se_size, max_muxword_size;
  92. int compress_bpp_group, obuf_latency, input_ssm_out_latency;
  93. int base_hs_latency, chunk_bits, ob_data_width;
  94. int output_rate_extra_budget_bits, multi_hs_extra_budget_bits;
  95. int multi_hs_extra_latency, mux_word_size;
  96. int ob_data_width_4comps, ob_data_width_3comps;
  97. int output_rate_ratio_complement, container_slice_width;
  98. int rtl_num_components, multi_hs_c, multi_hs_d;
  99. int bpc = dsc->config.bits_per_component;
  100. int bpp = DSC_BPP(dsc->config);
  101. int num_of_active_ss = dsc->config.slice_count;
  102. bool native_422 = dsc->config.native_422;
  103. bool native_420 = dsc->config.native_420;
  104. /* Hardent core config */
  105. int multiplex_mode_enable = 0, split_panel_enable = 0;
  106. int rtl_max_bpc = 10, rtl_output_data_width = 64;
  107. int pipeline_latency = 28;
  108. if (dsc_cmn_mode & DSC_MODE_MULTIPLEX)
  109. multiplex_mode_enable = 1;
  110. if (dsc_cmn_mode & DSC_MODE_SPLIT_PANEL)
  111. split_panel_enable = 0;
  112. container_slice_width = (native_422 ?
  113. dsc->config.slice_width / 2 : dsc->config.slice_width);
  114. max_muxword_size = (rtl_max_bpc >= 12) ? 64 : 48;
  115. max_se_size = 4 * (rtl_max_bpc + 1);
  116. max_ssm_delay = max_se_size + max_muxword_size - 1;
  117. mux_word_size = (bpc >= 12) ? 64 : 48;
  118. compress_bpp_group = native_422 ? (2 * bpp) : bpp;
  119. input_ssm_out_latency = pipeline_latency + 3 * (max_ssm_delay + 2)
  120. * num_of_active_ss;
  121. rtl_num_components = (native_420 || native_422) ? 4 : 3;
  122. ob_data_width_4comps = (rtl_output_data_width >= (2 *
  123. max_muxword_size)) ?
  124. rtl_output_data_width :
  125. (2 * rtl_output_data_width);
  126. ob_data_width_3comps = (rtl_output_data_width >= max_muxword_size) ?
  127. rtl_output_data_width : 2 * rtl_output_data_width;
  128. ob_data_width = (rtl_num_components == 4) ?
  129. ob_data_width_4comps : ob_data_width_3comps;
  130. obuf_latency = DIV_ROUND_UP((9 * ob_data_width + mux_word_size),
  131. compress_bpp_group) + 1;
  132. base_hs_latency = dsc->config.initial_xmit_delay +
  133. input_ssm_out_latency + obuf_latency;
  134. chunk_bits = 8 * dsc->config.slice_chunk_size;
  135. output_rate_ratio_complement = ob_data_width - compress_bpp_group;
  136. output_rate_extra_budget_bits =
  137. (output_rate_ratio_complement * chunk_bits) >>
  138. ((ob_data_width == 128) ? 7 : 6);
  139. multi_hs_c = split_panel_enable * multiplex_mode_enable;
  140. multi_hs_d = (num_of_active_ss > 1) * (ob_data_width >
  141. compress_bpp_group);
  142. multi_hs_extra_budget_bits = multi_hs_c ?
  143. chunk_bits : (multi_hs_d ? chunk_bits :
  144. output_rate_extra_budget_bits);
  145. multi_hs_extra_latency = DIV_ROUND_UP(multi_hs_extra_budget_bits,
  146. compress_bpp_group);
  147. dsc->initial_lines = DIV_ROUND_UP((base_hs_latency +
  148. multi_hs_extra_latency),
  149. container_slice_width);
  150. return 0;
  151. }
  152. static bool _dce_dsc_ich_reset_override_needed(bool pu_en,
  153. struct msm_display_dsc_info *dsc)
  154. {
  155. /*
  156. * As per the DSC spec, ICH_RESET can be either end of the slice line
  157. * or at the end of the slice. HW internally generates ich_reset at
  158. * end of the slice line if DSC_MERGE is used or encoder has two
  159. * soft slices. However, if encoder has only 1 soft slice and DSC_MERGE
  160. * is not used then it will generate ich_reset at the end of slice.
  161. *
  162. * Now as per the spec, during one PPS session, position where
  163. * ich_reset is generated should not change. Now if full-screen frame
  164. * has more than 1 soft slice then HW will automatically generate
  165. * ich_reset at the end of slice_line. But for the same panel, if
  166. * partial frame is enabled and only 1 encoder is used with 1 slice,
  167. * then HW will generate ich_reset at end of the slice. This is a
  168. * mismatch. Prevent this by overriding HW's decision.
  169. */
  170. return pu_en && dsc && (dsc->config.slice_count > 1) &&
  171. (dsc->config.slice_width == dsc->config.pic_width);
  172. }
  173. static void _dce_dsc_pipe_cfg(struct sde_hw_dsc *hw_dsc,
  174. struct sde_hw_pingpong *hw_pp, struct msm_display_dsc_info *dsc,
  175. u32 common_mode, bool ich_reset,
  176. struct sde_hw_pingpong *hw_dsc_pp,
  177. enum sde_3d_blend_mode mode_3d,
  178. bool disable_merge_3d, bool enable)
  179. {
  180. if (!enable) {
  181. if (hw_dsc_pp && hw_dsc_pp->ops.disable_dsc)
  182. hw_dsc_pp->ops.disable_dsc(hw_dsc_pp);
  183. if (hw_dsc && hw_dsc->ops.dsc_disable)
  184. hw_dsc->ops.dsc_disable(hw_dsc);
  185. if (hw_dsc && hw_dsc->ops.bind_pingpong_blk)
  186. hw_dsc->ops.bind_pingpong_blk(hw_dsc, false,
  187. PINGPONG_MAX);
  188. if (mode_3d && hw_pp && hw_pp->ops.reset_3d_mode)
  189. hw_pp->ops.reset_3d_mode(hw_pp);
  190. return;
  191. }
  192. if (!dsc || !hw_dsc || !hw_pp) {
  193. SDE_ERROR("invalid params %d %d %d\n", !dsc, !hw_dsc,
  194. !hw_pp);
  195. return;
  196. }
  197. if (hw_dsc->ops.dsc_config)
  198. hw_dsc->ops.dsc_config(hw_dsc, dsc, common_mode, ich_reset);
  199. if (hw_dsc->ops.dsc_config_thresh)
  200. hw_dsc->ops.dsc_config_thresh(hw_dsc, dsc);
  201. if (hw_dsc_pp && hw_dsc_pp->ops.setup_dsc)
  202. hw_dsc_pp->ops.setup_dsc(hw_dsc_pp);
  203. if (mode_3d && disable_merge_3d && hw_pp->ops.reset_3d_mode) {
  204. SDE_DEBUG("disabling 3d mux \n");
  205. hw_pp->ops.reset_3d_mode(hw_pp);
  206. } else if (mode_3d && disable_merge_3d && hw_pp->ops.setup_3d_mode) {
  207. SDE_DEBUG("enabling 3d mux \n");
  208. hw_pp->ops.setup_3d_mode(hw_pp, mode_3d);
  209. }
  210. if (hw_dsc && hw_dsc->ops.bind_pingpong_blk)
  211. hw_dsc->ops.bind_pingpong_blk(hw_dsc, true, hw_pp->idx);
  212. if (hw_dsc_pp && hw_dsc_pp->ops.enable_dsc)
  213. hw_dsc_pp->ops.enable_dsc(hw_dsc_pp);
  214. }
  215. static void _dce_vdc_pipe_cfg(struct sde_hw_vdc *hw_vdc,
  216. struct sde_hw_pingpong *hw_pp,
  217. struct msm_display_vdc_info *vdc,
  218. enum sde_3d_blend_mode mode_3d,
  219. bool disable_merge_3d, bool enable)
  220. {
  221. if (!vdc || !hw_vdc || !hw_pp) {
  222. SDE_ERROR("invalid params %d %d %d\n", !vdc, !hw_vdc,
  223. !hw_pp);
  224. return;
  225. }
  226. if (!enable) {
  227. if (hw_vdc->ops.vdc_disable)
  228. hw_vdc->ops.vdc_disable(hw_vdc);
  229. if (hw_vdc->ops.bind_pingpong_blk)
  230. hw_vdc->ops.bind_pingpong_blk(hw_vdc, false,
  231. PINGPONG_MAX);
  232. if (mode_3d && hw_pp->ops.reset_3d_mode)
  233. hw_pp->ops.reset_3d_mode(hw_pp);
  234. return;
  235. }
  236. if (hw_vdc->ops.vdc_config)
  237. hw_vdc->ops.vdc_config(hw_vdc, vdc);
  238. if (mode_3d && disable_merge_3d && hw_pp->ops.reset_3d_mode) {
  239. SDE_DEBUG("disabling 3d mux\n");
  240. hw_pp->ops.reset_3d_mode(hw_pp);
  241. }
  242. if (mode_3d && !disable_merge_3d && hw_pp->ops.setup_3d_mode) {
  243. SDE_DEBUG("enabling 3d mux\n");
  244. hw_pp->ops.setup_3d_mode(hw_pp, mode_3d);
  245. }
  246. if (hw_vdc->ops.bind_pingpong_blk)
  247. hw_vdc->ops.bind_pingpong_blk(hw_vdc, true, hw_pp->idx);
  248. }
  249. static inline bool _dce_check_half_panel_update(int num_lm,
  250. unsigned long affected_displays)
  251. {
  252. /**
  253. * partial update logic is currently supported only upto dual
  254. * pipe configurations.
  255. */
  256. return (hweight_long(affected_displays) != num_lm);
  257. }
  258. static int _dce_dsc_setup_helper(struct sde_encoder_virt *sde_enc,
  259. unsigned long affected_displays,
  260. enum sde_rm_topology_name topology)
  261. {
  262. struct sde_kms *sde_kms;
  263. struct msm_drm_private *priv;
  264. struct drm_encoder *drm_enc;
  265. struct sde_encoder_phys *enc_master;
  266. struct sde_hw_dsc *hw_dsc[MAX_CHANNELS_PER_ENC];
  267. struct sde_hw_pingpong *hw_pp[MAX_CHANNELS_PER_ENC];
  268. struct sde_hw_pingpong *hw_dsc_pp[MAX_CHANNELS_PER_ENC];
  269. struct msm_display_dsc_info *dsc = NULL;
  270. const struct sde_rm_topology_def *def;
  271. const struct sde_rect *roi;
  272. struct sde_hw_ctl *hw_ctl;
  273. struct sde_hw_intf_cfg_v1 cfg;
  274. enum sde_3d_blend_mode mode_3d;
  275. bool half_panel_partial_update, dsc_merge, merge_3d;
  276. bool disable_merge_3d = false;
  277. int this_frame_slices;
  278. int intf_ip_w, enc_ip_w;
  279. int num_intf, num_dsc, num_lm;
  280. int ich_res;
  281. int dsc_common_mode = 0;
  282. int i;
  283. drm_enc = &sde_enc->base;
  284. priv = drm_enc->dev->dev_private;
  285. sde_kms = to_sde_kms(priv->kms);
  286. def = sde_rm_topology_get_topology_def(&sde_kms->rm, topology);
  287. if (IS_ERR_OR_NULL(def))
  288. return -EINVAL;
  289. enc_master = sde_enc->cur_master;
  290. roi = &sde_enc->cur_conn_roi;
  291. hw_ctl = enc_master->hw_ctl;
  292. dsc = &sde_enc->mode_info.comp_info.dsc_info;
  293. num_dsc = def->num_comp_enc;
  294. num_intf = def->num_intf;
  295. mode_3d = (topology == SDE_RM_TOPOLOGY_DUALPIPE_3DMERGE_DSC) ?
  296. BLEND_3D_H_ROW_INT : BLEND_3D_NONE;
  297. num_lm = def->num_lm;
  298. half_panel_partial_update = _dce_check_half_panel_update(num_lm,
  299. affected_displays);
  300. merge_3d = (mode_3d != BLEND_3D_NONE) ? true : false;
  301. dsc_merge = ((num_dsc > num_intf) && !half_panel_partial_update) ?
  302. true : false;
  303. disable_merge_3d = (merge_3d && half_panel_partial_update) ?
  304. false : true;
  305. /*
  306. * If this encoder is driving more than one DSC encoder, they
  307. * operate in tandem, same pic dimension needs to be used by
  308. * each of them.(pp-split is assumed to be not supported)
  309. */
  310. _dce_dsc_update_pic_dim(dsc, roi->w, roi->h);
  311. this_frame_slices = roi->w / dsc->config.slice_width;
  312. intf_ip_w = this_frame_slices * dsc->config.slice_width;
  313. enc_ip_w = intf_ip_w;
  314. if (!half_panel_partial_update)
  315. intf_ip_w /= def->num_intf;
  316. if (!half_panel_partial_update && (num_dsc > 1))
  317. dsc_common_mode |= DSC_MODE_SPLIT_PANEL;
  318. if (dsc_merge) {
  319. dsc_common_mode |= DSC_MODE_MULTIPLEX;
  320. /*
  321. * in dsc merge case: when using 2 encoders for the same
  322. * stream, no. of slices need to be same on both the
  323. * encoders.
  324. */
  325. enc_ip_w = intf_ip_w / 2;
  326. }
  327. if (enc_master->intf_mode == INTF_MODE_VIDEO)
  328. dsc_common_mode |= DSC_MODE_VIDEO;
  329. sde_dsc_populate_dsc_private_params(dsc, intf_ip_w);
  330. _dce_dsc_initial_line_calc(dsc, enc_ip_w, dsc_common_mode);
  331. /*
  332. * __is_ich_reset_override_needed should be called only after
  333. * updating pic dimension, mdss_panel_dsc_update_pic_dim.
  334. */
  335. ich_res = _dce_dsc_ich_reset_override_needed(
  336. (half_panel_partial_update && !merge_3d), dsc);
  337. SDE_DEBUG_DCE(sde_enc, "pic_w: %d pic_h: %d mode:%d\n",
  338. roi->w, roi->h, dsc_common_mode);
  339. for (i = 0; i < num_dsc; i++) {
  340. bool active = !!((1 << i) & affected_displays);
  341. /*
  342. * in 3d_merge and half_panel partial update dsc should be
  343. * bound to the pp which is driving the update, else in
  344. * 3d_merge dsc should be bound to left side of the pipe
  345. */
  346. if (merge_3d && half_panel_partial_update)
  347. hw_pp[i] = (active) ? sde_enc->hw_pp[0]:
  348. sde_enc->hw_pp[1];
  349. else
  350. hw_pp[i] = sde_enc->hw_pp[i];
  351. hw_dsc[i] = sde_enc->hw_dsc[i];
  352. hw_dsc_pp[i] = sde_enc->hw_dsc_pp[i];
  353. if (!hw_pp[i] || !hw_dsc[i]) {
  354. SDE_ERROR_DCE(sde_enc, "DSC: invalid params %d %d\n",
  355. !!hw_pp[i], !!hw_dsc[i]);
  356. SDE_EVT32(DRMID(&sde_enc->base), !hw_pp[i], !hw_dsc[i],
  357. SDE_EVTLOG_ERROR);
  358. return -EINVAL;
  359. }
  360. SDE_EVT32(DRMID(&sde_enc->base), roi->w, roi->h,
  361. dsc_common_mode, i, active, merge_3d,
  362. disable_merge_3d);
  363. _dce_dsc_pipe_cfg(hw_dsc[i], hw_pp[i], dsc,
  364. dsc_common_mode, ich_res, hw_dsc_pp[i],
  365. mode_3d, disable_merge_3d, active);
  366. memset(&cfg, 0, sizeof(cfg));
  367. cfg.dsc[cfg.dsc_count++] = hw_dsc[i]->idx;
  368. if (hw_ctl->ops.update_intf_cfg)
  369. hw_ctl->ops.update_intf_cfg(hw_ctl,
  370. &cfg,
  371. active);
  372. if (hw_ctl->ops.update_bitmask)
  373. hw_ctl->ops.update_bitmask(hw_ctl,
  374. SDE_HW_FLUSH_DSC,
  375. hw_dsc[i]->idx, active);
  376. SDE_DEBUG_DCE(sde_enc,
  377. "update_intf_cfg hw_ctl[%d], dsc:%d, %s",
  378. hw_ctl->idx,
  379. cfg.dsc[0],
  380. active ? "enabled" : "disabled");
  381. if (mode_3d) {
  382. memset(&cfg, 0, sizeof(cfg));
  383. cfg.merge_3d[cfg.merge_3d_count++] =
  384. hw_pp[i]->merge_3d->idx;
  385. if (hw_ctl->ops.update_intf_cfg)
  386. hw_ctl->ops.update_intf_cfg(hw_ctl,
  387. &cfg,
  388. !disable_merge_3d);
  389. if (hw_ctl->ops.update_bitmask)
  390. hw_ctl->ops.update_bitmask(
  391. hw_ctl, SDE_HW_FLUSH_MERGE_3D,
  392. hw_pp[i]->merge_3d->idx, true);
  393. SDE_DEBUG("mode_3d %s, on CTL_%d PP-%d merge3d:%d\n",
  394. !disable_merge_3d ?
  395. "enabled" : "disabled",
  396. hw_ctl->idx - CTL_0,
  397. hw_pp[i]->idx - PINGPONG_0,
  398. hw_pp[i]->merge_3d ?
  399. hw_pp[i]->merge_3d->idx - MERGE_3D_0 :
  400. -1);
  401. }
  402. }
  403. return 0;
  404. }
  405. static int _dce_dsc_setup(struct sde_encoder_virt *sde_enc,
  406. struct sde_encoder_kickoff_params *params)
  407. {
  408. struct drm_connector *drm_conn;
  409. enum sde_rm_topology_name topology;
  410. if (!sde_enc || !params || !sde_enc->phys_encs[0] ||
  411. !sde_enc->phys_encs[0]->connector)
  412. return -EINVAL;
  413. drm_conn = sde_enc->phys_encs[0]->connector;
  414. topology = sde_connector_get_topology_name(drm_conn);
  415. if (topology == SDE_RM_TOPOLOGY_NONE) {
  416. SDE_ERROR_DCE(sde_enc, "topology not set yet\n");
  417. return -EINVAL;
  418. }
  419. SDE_DEBUG_DCE(sde_enc, "topology:%d\n", topology);
  420. if (sde_kms_rect_is_equal(&sde_enc->cur_conn_roi,
  421. &sde_enc->prv_conn_roi))
  422. return 0;
  423. SDE_EVT32(DRMID(&sde_enc->base), topology,
  424. sde_enc->cur_conn_roi.x, sde_enc->cur_conn_roi.y,
  425. sde_enc->cur_conn_roi.w, sde_enc->cur_conn_roi.h,
  426. sde_enc->prv_conn_roi.x, sde_enc->prv_conn_roi.y,
  427. sde_enc->prv_conn_roi.w, sde_enc->prv_conn_roi.h,
  428. sde_enc->cur_master->cached_mode.hdisplay,
  429. sde_enc->cur_master->cached_mode.vdisplay);
  430. return _dce_dsc_setup_helper(sde_enc, params->affected_displays,
  431. topology);
  432. }
  433. static int _dce_vdc_setup(struct sde_encoder_virt *sde_enc,
  434. struct sde_encoder_kickoff_params *params)
  435. {
  436. struct drm_connector *drm_conn;
  437. struct sde_kms *sde_kms;
  438. struct msm_drm_private *priv;
  439. struct drm_encoder *drm_enc;
  440. struct sde_encoder_phys *enc_master;
  441. struct sde_hw_vdc *hw_vdc[MAX_CHANNELS_PER_ENC];
  442. struct sde_hw_pingpong *hw_pp[MAX_CHANNELS_PER_ENC];
  443. struct msm_display_vdc_info *vdc = NULL;
  444. enum sde_rm_topology_name topology;
  445. const struct sde_rect *roi;
  446. struct sde_hw_ctl *hw_ctl;
  447. struct sde_hw_intf_cfg_v1 cfg;
  448. enum sde_3d_blend_mode mode_3d;
  449. bool half_panel_partial_update, merge_3d;
  450. bool disable_merge_3d = false;
  451. int this_frame_slices;
  452. int intf_ip_w, enc_ip_w;
  453. const struct sde_rm_topology_def *def;
  454. int num_intf, num_vdc, num_lm;
  455. int i;
  456. int ret = 0;
  457. if (!sde_enc || !params || !sde_enc->phys_encs[0] ||
  458. !sde_enc->phys_encs[0]->connector)
  459. return -EINVAL;
  460. drm_conn = sde_enc->phys_encs[0]->connector;
  461. topology = sde_connector_get_topology_name(drm_conn);
  462. if (topology == SDE_RM_TOPOLOGY_NONE) {
  463. SDE_ERROR_DCE(sde_enc, "topology not set yet\n");
  464. return -EINVAL;
  465. }
  466. SDE_DEBUG_DCE(sde_enc, "topology:%d\n", topology);
  467. SDE_EVT32(DRMID(&sde_enc->base), topology,
  468. sde_enc->cur_conn_roi.x,
  469. sde_enc->cur_conn_roi.y,
  470. sde_enc->cur_conn_roi.w,
  471. sde_enc->cur_conn_roi.h,
  472. sde_enc->prv_conn_roi.x,
  473. sde_enc->prv_conn_roi.y,
  474. sde_enc->prv_conn_roi.w,
  475. sde_enc->prv_conn_roi.h,
  476. sde_enc->cur_master->cached_mode.hdisplay,
  477. sde_enc->cur_master->cached_mode.vdisplay);
  478. if (sde_kms_rect_is_equal(&sde_enc->cur_conn_roi,
  479. &sde_enc->prv_conn_roi))
  480. return ret;
  481. enc_master = sde_enc->cur_master;
  482. roi = &sde_enc->cur_conn_roi;
  483. hw_ctl = enc_master->hw_ctl;
  484. vdc = &sde_enc->mode_info.comp_info.vdc_info;
  485. drm_enc = &sde_enc->base;
  486. priv = drm_enc->dev->dev_private;
  487. sde_kms = to_sde_kms(priv->kms);
  488. def = sde_rm_topology_get_topology_def(&sde_kms->rm, topology);
  489. if (IS_ERR_OR_NULL(def))
  490. return -EINVAL;
  491. num_vdc = def->num_comp_enc;
  492. num_intf = def->num_intf;
  493. mode_3d = (topology == SDE_RM_TOPOLOGY_DUALPIPE_3DMERGE_VDC) ?
  494. BLEND_3D_H_ROW_INT : BLEND_3D_NONE;
  495. num_lm = def->num_lm;
  496. /*
  497. * If this encoder is driving more than one VDC encoder, they
  498. * operate in tandem, same pic dimension needs to be used by
  499. * each of them.(pp-split is assumed to be not supported)
  500. */
  501. _dce_vdc_update_pic_dim(vdc, roi->w, roi->h);
  502. merge_3d = (mode_3d != BLEND_3D_NONE) ? true : false;
  503. half_panel_partial_update = _dce_check_half_panel_update(num_lm,
  504. params->affected_displays);
  505. if (half_panel_partial_update && merge_3d)
  506. disable_merge_3d = true;
  507. this_frame_slices = roi->w / vdc->slice_width;
  508. intf_ip_w = this_frame_slices * vdc->slice_width;
  509. sde_vdc_populate_config(vdc, intf_ip_w, vdc->traffic_mode);
  510. enc_ip_w = intf_ip_w;
  511. SDE_DEBUG_DCE(sde_enc, "pic_w: %d pic_h: %d\n",
  512. roi->w, roi->h);
  513. for (i = 0; i < num_vdc; i++) {
  514. bool active = !!((1 << i) & params->affected_displays);
  515. /*
  516. * if half_panel partial update vdc should be bound to the pp
  517. * that is driving the update, in other case when both the
  518. * layer mixers are driving the update, vdc should be bound
  519. * to left side pp
  520. */
  521. if (merge_3d && half_panel_partial_update)
  522. hw_pp[i] = (active) ? sde_enc->hw_pp[0] :
  523. sde_enc->hw_pp[1];
  524. else
  525. hw_pp[i] = sde_enc->hw_pp[i];
  526. hw_vdc[i] = sde_enc->hw_vdc[i];
  527. if (!hw_vdc[i]) {
  528. SDE_ERROR_DCE(sde_enc, "invalid params for VDC\n");
  529. SDE_EVT32(DRMID(&sde_enc->base), roi->w, roi->h,
  530. i, active);
  531. return -EINVAL;
  532. }
  533. _dce_vdc_pipe_cfg(hw_vdc[i], hw_pp[i],
  534. vdc, mode_3d, disable_merge_3d, active);
  535. memset(&cfg, 0, sizeof(cfg));
  536. cfg.vdc[cfg.vdc_count++] = hw_vdc[i]->idx;
  537. if (hw_ctl->ops.update_intf_cfg)
  538. hw_ctl->ops.update_intf_cfg(hw_ctl,
  539. &cfg,
  540. active);
  541. if (hw_ctl->ops.update_bitmask)
  542. hw_ctl->ops.update_bitmask(hw_ctl,
  543. SDE_HW_FLUSH_VDC,
  544. hw_vdc[i]->idx, active);
  545. SDE_DEBUG_DCE(sde_enc,
  546. "update_intf_cfg hw_ctl[%d], vdc:%d, %s",
  547. hw_ctl->idx,
  548. cfg.vdc[0],
  549. active ? "enabled" : "disabled");
  550. if (mode_3d) {
  551. memset(&cfg, 0, sizeof(cfg));
  552. cfg.merge_3d[cfg.merge_3d_count++] =
  553. hw_pp[i]->merge_3d->idx;
  554. if (hw_ctl->ops.update_intf_cfg)
  555. hw_ctl->ops.update_intf_cfg(hw_ctl,
  556. &cfg,
  557. !disable_merge_3d);
  558. if (hw_ctl->ops.update_bitmask)
  559. hw_ctl->ops.update_bitmask(
  560. hw_ctl, SDE_HW_FLUSH_MERGE_3D,
  561. hw_pp[i]->merge_3d->idx, true);
  562. SDE_DEBUG("mode_3d %s, on CTL_%d PP-%d merge3d:%d\n",
  563. disable_merge_3d ?
  564. "disabled" : "enabled",
  565. hw_ctl->idx - CTL_0,
  566. hw_pp[i]->idx - PINGPONG_0,
  567. hw_pp[i]->merge_3d ?
  568. hw_pp[i]->merge_3d->idx - MERGE_3D_0 :
  569. -1);
  570. }
  571. }
  572. return 0;
  573. }
  574. static void _dce_dsc_disable(struct sde_encoder_virt *sde_enc)
  575. {
  576. int i;
  577. struct sde_hw_pingpong *hw_pp = NULL;
  578. struct sde_hw_pingpong *hw_dsc_pp = NULL;
  579. struct sde_hw_dsc *hw_dsc = NULL;
  580. struct sde_hw_ctl *hw_ctl = NULL;
  581. struct sde_hw_intf_cfg_v1 cfg;
  582. if (!sde_enc || !sde_enc->phys_encs[0] ||
  583. !sde_enc->phys_encs[0]->connector) {
  584. SDE_ERROR("invalid params %d %d\n",
  585. !sde_enc, sde_enc ? !sde_enc->phys_encs[0] : -1);
  586. return;
  587. }
  588. if (sde_enc->cur_master)
  589. hw_ctl = sde_enc->cur_master->hw_ctl;
  590. memset(&cfg, 0, sizeof(cfg));
  591. /* Disable DSC for all the pp's present in this topology */
  592. for (i = 0; i < MAX_CHANNELS_PER_ENC; i++) {
  593. hw_pp = sde_enc->hw_pp[i];
  594. hw_dsc = sde_enc->hw_dsc[i];
  595. hw_dsc_pp = sde_enc->hw_dsc_pp[i];
  596. _dce_dsc_pipe_cfg(hw_dsc, hw_pp, NULL,
  597. 0, 0, hw_dsc_pp,
  598. BLEND_3D_NONE, false, false);
  599. if (hw_dsc) {
  600. sde_enc->dirty_dsc_ids[i] = hw_dsc->idx;
  601. cfg.dsc[cfg.dsc_count++] = hw_dsc->idx;
  602. }
  603. }
  604. /* Clear the DSC ACTIVE config for this CTL */
  605. if (hw_ctl && hw_ctl->ops.update_intf_cfg)
  606. hw_ctl->ops.update_intf_cfg(hw_ctl, &cfg, false);
  607. /**
  608. * Since pending flushes from previous commit get cleared
  609. * sometime after this point, setting DSC flush bits now
  610. * will have no effect. Therefore dirty_dsc_ids track which
  611. * DSC blocks must be flushed for the next trigger.
  612. */
  613. }
  614. static void _dce_vdc_disable(struct sde_encoder_virt *sde_enc)
  615. {
  616. int i;
  617. struct sde_hw_pingpong *hw_pp = NULL;
  618. struct sde_hw_vdc *hw_vdc = NULL;
  619. struct sde_hw_ctl *hw_ctl = NULL;
  620. struct sde_hw_intf_cfg_v1 cfg;
  621. if (!sde_enc || !sde_enc->phys_encs[0] ||
  622. !sde_enc->phys_encs[0]->connector) {
  623. SDE_ERROR("invalid params %d %d\n",
  624. !sde_enc, sde_enc ? !sde_enc->phys_encs[0] : -1);
  625. return;
  626. }
  627. if (sde_enc->cur_master)
  628. hw_ctl = sde_enc->cur_master->hw_ctl;
  629. memset(&cfg, 0, sizeof(cfg));
  630. /* Disable VDC for all the pp's present in this topology */
  631. for (i = 0; i < MAX_CHANNELS_PER_ENC; i++) {
  632. hw_pp = sde_enc->hw_pp[i];
  633. hw_vdc = sde_enc->hw_vdc[i];
  634. _dce_vdc_pipe_cfg(hw_vdc, hw_pp, NULL,
  635. BLEND_3D_NONE, false,
  636. false);
  637. if (hw_vdc) {
  638. sde_enc->dirty_vdc_ids[i] = hw_vdc->idx;
  639. cfg.vdc[cfg.vdc_count++] = hw_vdc->idx;
  640. }
  641. }
  642. /* Clear the VDC ACTIVE config for this CTL */
  643. if (hw_ctl && hw_ctl->ops.update_intf_cfg)
  644. hw_ctl->ops.update_intf_cfg(hw_ctl, &cfg, false);
  645. /**
  646. * Since pending flushes from previous commit get cleared
  647. * sometime after this point, setting VDC flush bits now
  648. * will have no effect. Therefore dirty_vdc_ids track which
  649. * VDC blocks must be flushed for the next trigger.
  650. */
  651. }
  652. bool _dce_dsc_is_dirty(struct sde_encoder_virt *sde_enc)
  653. {
  654. int i;
  655. for (i = 0; i < MAX_CHANNELS_PER_ENC; i++) {
  656. /**
  657. * This dirty_dsc_hw field is set during DSC disable to
  658. * indicate which DSC blocks need to be flushed
  659. */
  660. if (sde_enc->dirty_dsc_ids[i])
  661. return true;
  662. }
  663. return false;
  664. }
  665. bool _dce_vdc_is_dirty(struct sde_encoder_virt *sde_enc)
  666. {
  667. int i;
  668. for (i = 0; i < MAX_CHANNELS_PER_ENC; i++) {
  669. /**
  670. * This dirty_vdc_hw field is set during VDC disable to
  671. * indicate which VDC blocks need to be flushed
  672. */
  673. if (sde_enc->dirty_vdc_ids[i])
  674. return true;
  675. }
  676. return false;
  677. }
  678. static void _dce_helper_flush_dsc(struct sde_encoder_virt *sde_enc)
  679. {
  680. int i;
  681. struct sde_hw_ctl *hw_ctl = NULL;
  682. enum sde_dsc dsc_idx;
  683. if (sde_enc->cur_master)
  684. hw_ctl = sde_enc->cur_master->hw_ctl;
  685. for (i = 0; i < MAX_CHANNELS_PER_ENC; i++) {
  686. dsc_idx = sde_enc->dirty_dsc_ids[i];
  687. if (dsc_idx && hw_ctl && hw_ctl->ops.update_bitmask)
  688. hw_ctl->ops.update_bitmask(hw_ctl, SDE_HW_FLUSH_DSC,
  689. dsc_idx, 1);
  690. sde_enc->dirty_dsc_ids[i] = DSC_NONE;
  691. }
  692. }
  693. void _dce_helper_flush_vdc(struct sde_encoder_virt *sde_enc)
  694. {
  695. int i;
  696. struct sde_hw_ctl *hw_ctl = NULL;
  697. enum sde_vdc vdc_idx;
  698. if (sde_enc->cur_master)
  699. hw_ctl = sde_enc->cur_master->hw_ctl;
  700. for (i = 0; i < MAX_CHANNELS_PER_ENC; i++) {
  701. vdc_idx = sde_enc->dirty_vdc_ids[i];
  702. if (vdc_idx && hw_ctl && hw_ctl->ops.update_bitmask)
  703. hw_ctl->ops.update_bitmask(hw_ctl, SDE_HW_FLUSH_VDC,
  704. vdc_idx, 1);
  705. sde_enc->dirty_vdc_ids[i] = VDC_NONE;
  706. }
  707. }
  708. void sde_encoder_dce_disable(struct sde_encoder_virt *sde_enc)
  709. {
  710. enum msm_display_compression_type comp_type;
  711. if (!sde_enc)
  712. return;
  713. comp_type = sde_enc->mode_info.comp_info.comp_type;
  714. if (comp_type == MSM_DISPLAY_COMPRESSION_DSC)
  715. _dce_dsc_disable(sde_enc);
  716. else if (comp_type == MSM_DISPLAY_COMPRESSION_VDC)
  717. _dce_vdc_disable(sde_enc);
  718. }
  719. int sde_encoder_dce_flush(struct sde_encoder_virt *sde_enc)
  720. {
  721. int rc = 0;
  722. if (!sde_enc)
  723. return -EINVAL;
  724. if (_dce_dsc_is_dirty(sde_enc))
  725. _dce_helper_flush_dsc(sde_enc);
  726. else if (_dce_vdc_is_dirty(sde_enc))
  727. _dce_helper_flush_vdc(sde_enc);
  728. return rc;
  729. }
  730. int sde_encoder_dce_setup(struct sde_encoder_virt *sde_enc,
  731. struct sde_encoder_kickoff_params *params)
  732. {
  733. enum msm_display_compression_type comp_type;
  734. int rc = 0;
  735. if (!sde_enc)
  736. return -EINVAL;
  737. comp_type = sde_enc->mode_info.comp_info.comp_type;
  738. if (comp_type == MSM_DISPLAY_COMPRESSION_DSC)
  739. rc = _dce_dsc_setup(sde_enc, params);
  740. else if (comp_type == MSM_DISPLAY_COMPRESSION_VDC)
  741. rc = _dce_vdc_setup(sde_enc, params);
  742. return rc;
  743. }