sde_encoder_phys_cmd.c 53 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
  4. */
  5. #define pr_fmt(fmt) "[drm:%s:%d] " fmt, __func__, __LINE__
  6. #include "sde_encoder_phys.h"
  7. #include "sde_hw_interrupts.h"
  8. #include "sde_core_irq.h"
  9. #include "sde_formats.h"
  10. #include "sde_trace.h"
  11. #define SDE_DEBUG_CMDENC(e, fmt, ...) SDE_DEBUG("enc%d intf%d " fmt, \
  12. (e) && (e)->base.parent ? \
  13. (e)->base.parent->base.id : -1, \
  14. (e) ? (e)->base.intf_idx - INTF_0 : -1, ##__VA_ARGS__)
  15. #define SDE_ERROR_CMDENC(e, fmt, ...) SDE_ERROR("enc%d intf%d " fmt, \
  16. (e) && (e)->base.parent ? \
  17. (e)->base.parent->base.id : -1, \
  18. (e) ? (e)->base.intf_idx - INTF_0 : -1, ##__VA_ARGS__)
  19. #define to_sde_encoder_phys_cmd(x) \
  20. container_of(x, struct sde_encoder_phys_cmd, base)
  21. #define PP_TIMEOUT_MAX_TRIALS 4
  22. /*
  23. * Tearcheck sync start and continue thresholds are empirically found
  24. * based on common panels In the future, may want to allow panels to override
  25. * these default values
  26. */
  27. #define DEFAULT_TEARCHECK_SYNC_THRESH_START 4
  28. #define DEFAULT_TEARCHECK_SYNC_THRESH_CONTINUE 4
  29. #define SDE_ENC_WR_PTR_START_TIMEOUT_US 20000
  30. #define SDE_ENC_MAX_POLL_TIMEOUT_US 2000
  31. static inline int _sde_encoder_phys_cmd_get_idle_timeout(
  32. struct sde_encoder_phys_cmd *cmd_enc)
  33. {
  34. return cmd_enc->autorefresh.cfg.frame_count ?
  35. cmd_enc->autorefresh.cfg.frame_count *
  36. KICKOFF_TIMEOUT_MS : KICKOFF_TIMEOUT_MS;
  37. }
  38. static inline bool sde_encoder_phys_cmd_is_master(
  39. struct sde_encoder_phys *phys_enc)
  40. {
  41. return (phys_enc->split_role != ENC_ROLE_SLAVE) ? true : false;
  42. }
  43. static bool sde_encoder_phys_cmd_mode_fixup(
  44. struct sde_encoder_phys *phys_enc,
  45. const struct drm_display_mode *mode,
  46. struct drm_display_mode *adj_mode)
  47. {
  48. if (phys_enc)
  49. SDE_DEBUG_CMDENC(to_sde_encoder_phys_cmd(phys_enc), "\n");
  50. return true;
  51. }
  52. static uint64_t _sde_encoder_phys_cmd_get_autorefresh_property(
  53. struct sde_encoder_phys *phys_enc)
  54. {
  55. struct drm_connector *conn = phys_enc->connector;
  56. if (!conn || !conn->state)
  57. return 0;
  58. return sde_connector_get_property(conn->state,
  59. CONNECTOR_PROP_AUTOREFRESH);
  60. }
  61. static void _sde_encoder_phys_cmd_config_autorefresh(
  62. struct sde_encoder_phys *phys_enc,
  63. u32 new_frame_count)
  64. {
  65. struct sde_encoder_phys_cmd *cmd_enc =
  66. to_sde_encoder_phys_cmd(phys_enc);
  67. struct sde_hw_pingpong *hw_pp = phys_enc->hw_pp;
  68. struct sde_hw_intf *hw_intf = phys_enc->hw_intf;
  69. struct drm_connector *conn = phys_enc->connector;
  70. struct sde_hw_autorefresh *cfg_cur, cfg_nxt;
  71. if (!conn || !conn->state || !hw_pp || !hw_intf)
  72. return;
  73. cfg_cur = &cmd_enc->autorefresh.cfg;
  74. /* autorefresh property value should be validated already */
  75. memset(&cfg_nxt, 0, sizeof(cfg_nxt));
  76. cfg_nxt.frame_count = new_frame_count;
  77. cfg_nxt.enable = (cfg_nxt.frame_count != 0);
  78. SDE_DEBUG_CMDENC(cmd_enc, "autorefresh state %d->%d framecount %d\n",
  79. cfg_cur->enable, cfg_nxt.enable, cfg_nxt.frame_count);
  80. SDE_EVT32(DRMID(phys_enc->parent), hw_pp->idx, hw_intf->idx,
  81. cfg_cur->enable, cfg_nxt.enable, cfg_nxt.frame_count);
  82. /* only proceed on state changes */
  83. if (cfg_nxt.enable == cfg_cur->enable)
  84. return;
  85. memcpy(cfg_cur, &cfg_nxt, sizeof(*cfg_cur));
  86. if (phys_enc->has_intf_te && hw_intf->ops.setup_autorefresh)
  87. hw_intf->ops.setup_autorefresh(hw_intf, cfg_cur);
  88. else if (hw_pp->ops.setup_autorefresh)
  89. hw_pp->ops.setup_autorefresh(hw_pp, cfg_cur);
  90. }
  91. static void _sde_encoder_phys_cmd_update_flush_mask(
  92. struct sde_encoder_phys *phys_enc)
  93. {
  94. struct sde_encoder_phys_cmd *cmd_enc;
  95. struct sde_hw_ctl *ctl;
  96. if (!phys_enc || !phys_enc->hw_intf || !phys_enc->hw_pp)
  97. return;
  98. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  99. ctl = phys_enc->hw_ctl;
  100. if (!ctl)
  101. return;
  102. if (!ctl->ops.update_bitmask_intf ||
  103. (test_bit(SDE_CTL_ACTIVE_CFG, &ctl->caps->features) &&
  104. !ctl->ops.update_bitmask_merge3d)) {
  105. SDE_ERROR("invalid hw_ctl ops %d\n", ctl->idx);
  106. return;
  107. }
  108. ctl->ops.update_bitmask_intf(ctl, phys_enc->intf_idx, 1);
  109. if (ctl->ops.update_bitmask_merge3d && phys_enc->hw_pp->merge_3d)
  110. ctl->ops.update_bitmask_merge3d(ctl,
  111. phys_enc->hw_pp->merge_3d->idx, 1);
  112. SDE_DEBUG_CMDENC(cmd_enc, "update pending flush ctl %d intf_idx %x\n",
  113. ctl->idx - CTL_0, phys_enc->intf_idx);
  114. }
  115. static void _sde_encoder_phys_cmd_update_intf_cfg(
  116. struct sde_encoder_phys *phys_enc)
  117. {
  118. struct sde_encoder_phys_cmd *cmd_enc =
  119. to_sde_encoder_phys_cmd(phys_enc);
  120. struct sde_hw_ctl *ctl;
  121. if (!phys_enc)
  122. return;
  123. ctl = phys_enc->hw_ctl;
  124. if (!ctl)
  125. return;
  126. if (ctl->ops.setup_intf_cfg) {
  127. struct sde_hw_intf_cfg intf_cfg = { 0 };
  128. intf_cfg.intf = phys_enc->intf_idx;
  129. intf_cfg.intf_mode_sel = SDE_CTL_MODE_SEL_CMD;
  130. intf_cfg.stream_sel = cmd_enc->stream_sel;
  131. intf_cfg.mode_3d =
  132. sde_encoder_helper_get_3d_blend_mode(phys_enc);
  133. ctl->ops.setup_intf_cfg(ctl, &intf_cfg);
  134. } else if (test_bit(SDE_CTL_ACTIVE_CFG, &ctl->caps->features)) {
  135. sde_encoder_helper_update_intf_cfg(phys_enc);
  136. }
  137. }
  138. static void sde_encoder_phys_cmd_pp_tx_done_irq(void *arg, int irq_idx)
  139. {
  140. struct sde_encoder_phys *phys_enc = arg;
  141. u32 event = 0;
  142. if (!phys_enc || !phys_enc->hw_pp)
  143. return;
  144. SDE_ATRACE_BEGIN("pp_done_irq");
  145. /* notify all synchronous clients first, then asynchronous clients */
  146. if (phys_enc->parent_ops.handle_frame_done &&
  147. atomic_add_unless(&phys_enc->pending_kickoff_cnt, -1, 0)) {
  148. event = SDE_ENCODER_FRAME_EVENT_DONE |
  149. SDE_ENCODER_FRAME_EVENT_SIGNAL_RELEASE_FENCE;
  150. spin_lock(phys_enc->enc_spinlock);
  151. phys_enc->parent_ops.handle_frame_done(phys_enc->parent,
  152. phys_enc, event);
  153. spin_unlock(phys_enc->enc_spinlock);
  154. }
  155. SDE_EVT32_IRQ(DRMID(phys_enc->parent),
  156. phys_enc->hw_pp->idx - PINGPONG_0, event);
  157. /* Signal any waiting atomic commit thread */
  158. wake_up_all(&phys_enc->pending_kickoff_wq);
  159. SDE_ATRACE_END("pp_done_irq");
  160. }
  161. static void sde_encoder_phys_cmd_autorefresh_done_irq(void *arg, int irq_idx)
  162. {
  163. struct sde_encoder_phys *phys_enc = arg;
  164. struct sde_encoder_phys_cmd *cmd_enc =
  165. to_sde_encoder_phys_cmd(phys_enc);
  166. unsigned long lock_flags;
  167. int new_cnt;
  168. if (!cmd_enc)
  169. return;
  170. phys_enc = &cmd_enc->base;
  171. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  172. new_cnt = atomic_add_unless(&cmd_enc->autorefresh.kickoff_cnt, -1, 0);
  173. spin_unlock_irqrestore(phys_enc->enc_spinlock, lock_flags);
  174. SDE_EVT32_IRQ(DRMID(phys_enc->parent),
  175. phys_enc->hw_pp->idx - PINGPONG_0,
  176. phys_enc->hw_intf->idx - INTF_0,
  177. new_cnt);
  178. /* Signal any waiting atomic commit thread */
  179. wake_up_all(&cmd_enc->autorefresh.kickoff_wq);
  180. }
  181. static void sde_encoder_phys_cmd_te_rd_ptr_irq(void *arg, int irq_idx)
  182. {
  183. struct sde_encoder_phys *phys_enc = arg;
  184. struct sde_encoder_phys_cmd *cmd_enc;
  185. u32 scheduler_status = INVALID_CTL_STATUS;
  186. struct sde_hw_ctl *ctl;
  187. struct sde_hw_pp_vsync_info info[MAX_CHANNELS_PER_ENC] = {{0}};
  188. struct sde_encoder_phys_cmd_te_timestamp *te_timestamp;
  189. unsigned long lock_flags;
  190. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  191. return;
  192. SDE_ATRACE_BEGIN("rd_ptr_irq");
  193. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  194. ctl = phys_enc->hw_ctl;
  195. if (ctl && ctl->ops.get_scheduler_status)
  196. scheduler_status = ctl->ops.get_scheduler_status(ctl);
  197. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  198. te_timestamp = list_first_entry_or_null(&cmd_enc->te_timestamp_list,
  199. struct sde_encoder_phys_cmd_te_timestamp, list);
  200. if (te_timestamp) {
  201. list_del_init(&te_timestamp->list);
  202. te_timestamp->timestamp = ktime_get();
  203. list_add_tail(&te_timestamp->list, &cmd_enc->te_timestamp_list);
  204. }
  205. spin_unlock_irqrestore(phys_enc->enc_spinlock, lock_flags);
  206. sde_encoder_helper_get_pp_line_count(phys_enc->parent, info);
  207. SDE_EVT32_IRQ(DRMID(phys_enc->parent),
  208. info[0].pp_idx, info[0].intf_idx,
  209. info[0].wr_ptr_line_count, info[0].intf_frame_count,
  210. info[1].pp_idx, info[1].intf_idx,
  211. info[1].wr_ptr_line_count, info[1].intf_frame_count,
  212. scheduler_status);
  213. if (phys_enc->parent_ops.handle_vblank_virt)
  214. phys_enc->parent_ops.handle_vblank_virt(phys_enc->parent,
  215. phys_enc);
  216. atomic_add_unless(&cmd_enc->pending_vblank_cnt, -1, 0);
  217. wake_up_all(&cmd_enc->pending_vblank_wq);
  218. SDE_ATRACE_END("rd_ptr_irq");
  219. }
  220. static void sde_encoder_phys_cmd_wr_ptr_irq(void *arg, int irq_idx)
  221. {
  222. struct sde_encoder_phys *phys_enc = arg;
  223. struct sde_hw_ctl *ctl;
  224. u32 event = 0;
  225. struct sde_hw_pp_vsync_info info[MAX_CHANNELS_PER_ENC] = {{0}};
  226. if (!phys_enc || !phys_enc->hw_ctl)
  227. return;
  228. SDE_ATRACE_BEGIN("wr_ptr_irq");
  229. ctl = phys_enc->hw_ctl;
  230. if (atomic_add_unless(&phys_enc->pending_retire_fence_cnt, -1, 0)) {
  231. event = SDE_ENCODER_FRAME_EVENT_SIGNAL_RETIRE_FENCE;
  232. if (phys_enc->parent_ops.handle_frame_done) {
  233. spin_lock(phys_enc->enc_spinlock);
  234. phys_enc->parent_ops.handle_frame_done(
  235. phys_enc->parent, phys_enc, event);
  236. spin_unlock(phys_enc->enc_spinlock);
  237. }
  238. }
  239. sde_encoder_helper_get_pp_line_count(phys_enc->parent, info);
  240. SDE_EVT32_IRQ(DRMID(phys_enc->parent),
  241. ctl->idx - CTL_0, event,
  242. info[0].pp_idx, info[0].intf_idx, info[0].wr_ptr_line_count,
  243. info[1].pp_idx, info[1].intf_idx, info[1].wr_ptr_line_count);
  244. /* Signal any waiting wr_ptr start interrupt */
  245. wake_up_all(&phys_enc->pending_kickoff_wq);
  246. SDE_ATRACE_END("wr_ptr_irq");
  247. }
  248. static void sde_encoder_phys_cmd_underrun_irq(void *arg, int irq_idx)
  249. {
  250. struct sde_encoder_phys *phys_enc = arg;
  251. if (!phys_enc)
  252. return;
  253. if (phys_enc->parent_ops.handle_underrun_virt)
  254. phys_enc->parent_ops.handle_underrun_virt(phys_enc->parent,
  255. phys_enc);
  256. }
  257. static void _sde_encoder_phys_cmd_setup_irq_hw_idx(
  258. struct sde_encoder_phys *phys_enc)
  259. {
  260. struct sde_encoder_irq *irq;
  261. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_ctl) {
  262. SDE_ERROR("invalid args %d %d\n", !phys_enc,
  263. phys_enc ? !phys_enc->hw_pp : 0);
  264. return;
  265. }
  266. if (phys_enc->has_intf_te && !phys_enc->hw_intf) {
  267. SDE_ERROR("invalid intf configuration\n");
  268. return;
  269. }
  270. irq = &phys_enc->irq[INTR_IDX_CTL_START];
  271. irq->hw_idx = phys_enc->hw_ctl->idx;
  272. irq->irq_idx = -EINVAL;
  273. irq = &phys_enc->irq[INTR_IDX_PINGPONG];
  274. irq->hw_idx = phys_enc->hw_pp->idx;
  275. irq->irq_idx = -EINVAL;
  276. irq = &phys_enc->irq[INTR_IDX_RDPTR];
  277. irq->irq_idx = -EINVAL;
  278. if (phys_enc->has_intf_te)
  279. irq->hw_idx = phys_enc->hw_intf->idx;
  280. else
  281. irq->hw_idx = phys_enc->hw_pp->idx;
  282. irq = &phys_enc->irq[INTR_IDX_UNDERRUN];
  283. irq->hw_idx = phys_enc->intf_idx;
  284. irq->irq_idx = -EINVAL;
  285. irq = &phys_enc->irq[INTR_IDX_AUTOREFRESH_DONE];
  286. irq->irq_idx = -EINVAL;
  287. if (phys_enc->has_intf_te)
  288. irq->hw_idx = phys_enc->hw_intf->idx;
  289. else
  290. irq->hw_idx = phys_enc->hw_pp->idx;
  291. irq = &phys_enc->irq[INTR_IDX_WRPTR];
  292. irq->irq_idx = -EINVAL;
  293. if (phys_enc->has_intf_te)
  294. irq->hw_idx = phys_enc->hw_intf->idx;
  295. else
  296. irq->hw_idx = phys_enc->hw_pp->idx;
  297. }
  298. static void sde_encoder_phys_cmd_cont_splash_mode_set(
  299. struct sde_encoder_phys *phys_enc,
  300. struct drm_display_mode *adj_mode)
  301. {
  302. struct sde_hw_intf *hw_intf;
  303. struct sde_hw_pingpong *hw_pp;
  304. struct sde_encoder_phys_cmd *cmd_enc;
  305. if (!phys_enc || !adj_mode) {
  306. SDE_ERROR("invalid args\n");
  307. return;
  308. }
  309. phys_enc->cached_mode = *adj_mode;
  310. phys_enc->enable_state = SDE_ENC_ENABLED;
  311. if (!phys_enc->hw_ctl || !phys_enc->hw_pp) {
  312. SDE_DEBUG("invalid ctl:%d pp:%d\n",
  313. (phys_enc->hw_ctl == NULL),
  314. (phys_enc->hw_pp == NULL));
  315. return;
  316. }
  317. if (sde_encoder_phys_cmd_is_master(phys_enc)) {
  318. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  319. hw_pp = phys_enc->hw_pp;
  320. hw_intf = phys_enc->hw_intf;
  321. if (phys_enc->has_intf_te && hw_intf &&
  322. hw_intf->ops.get_autorefresh) {
  323. hw_intf->ops.get_autorefresh(hw_intf,
  324. &cmd_enc->autorefresh.cfg);
  325. } else if (hw_pp && hw_pp->ops.get_autorefresh) {
  326. hw_pp->ops.get_autorefresh(hw_pp,
  327. &cmd_enc->autorefresh.cfg);
  328. }
  329. }
  330. _sde_encoder_phys_cmd_setup_irq_hw_idx(phys_enc);
  331. }
  332. static void sde_encoder_phys_cmd_mode_set(
  333. struct sde_encoder_phys *phys_enc,
  334. struct drm_display_mode *mode,
  335. struct drm_display_mode *adj_mode)
  336. {
  337. struct sde_encoder_phys_cmd *cmd_enc =
  338. to_sde_encoder_phys_cmd(phys_enc);
  339. struct sde_rm *rm = &phys_enc->sde_kms->rm;
  340. struct sde_rm_hw_iter iter;
  341. int i, instance;
  342. if (!phys_enc || !mode || !adj_mode) {
  343. SDE_ERROR("invalid args\n");
  344. return;
  345. }
  346. phys_enc->cached_mode = *adj_mode;
  347. SDE_DEBUG_CMDENC(cmd_enc, "caching mode:\n");
  348. drm_mode_debug_printmodeline(adj_mode);
  349. instance = phys_enc->split_role == ENC_ROLE_SLAVE ? 1 : 0;
  350. /* Retrieve previously allocated HW Resources. Shouldn't fail */
  351. sde_rm_init_hw_iter(&iter, phys_enc->parent->base.id, SDE_HW_BLK_CTL);
  352. for (i = 0; i <= instance; i++) {
  353. if (sde_rm_get_hw(rm, &iter))
  354. phys_enc->hw_ctl = (struct sde_hw_ctl *)iter.hw;
  355. }
  356. if (IS_ERR_OR_NULL(phys_enc->hw_ctl)) {
  357. SDE_ERROR_CMDENC(cmd_enc, "failed to init ctl: %ld\n",
  358. PTR_ERR(phys_enc->hw_ctl));
  359. phys_enc->hw_ctl = NULL;
  360. return;
  361. }
  362. sde_rm_init_hw_iter(&iter, phys_enc->parent->base.id, SDE_HW_BLK_INTF);
  363. for (i = 0; i <= instance; i++) {
  364. if (sde_rm_get_hw(rm, &iter))
  365. phys_enc->hw_intf = (struct sde_hw_intf *)iter.hw;
  366. }
  367. if (IS_ERR_OR_NULL(phys_enc->hw_intf)) {
  368. SDE_ERROR_CMDENC(cmd_enc, "failed to init intf: %ld\n",
  369. PTR_ERR(phys_enc->hw_intf));
  370. phys_enc->hw_intf = NULL;
  371. return;
  372. }
  373. _sde_encoder_phys_cmd_setup_irq_hw_idx(phys_enc);
  374. }
  375. static int _sde_encoder_phys_cmd_handle_ppdone_timeout(
  376. struct sde_encoder_phys *phys_enc,
  377. bool recovery_events)
  378. {
  379. struct sde_encoder_phys_cmd *cmd_enc =
  380. to_sde_encoder_phys_cmd(phys_enc);
  381. u32 frame_event = SDE_ENCODER_FRAME_EVENT_ERROR
  382. | SDE_ENCODER_FRAME_EVENT_SIGNAL_RELEASE_FENCE;
  383. struct drm_connector *conn;
  384. int event;
  385. u32 pending_kickoff_cnt;
  386. unsigned long lock_flags;
  387. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_ctl)
  388. return -EINVAL;
  389. conn = phys_enc->connector;
  390. /* decrement the kickoff_cnt before checking for ESD status */
  391. if (!atomic_add_unless(&phys_enc->pending_kickoff_cnt, -1, 0))
  392. return 0;
  393. cmd_enc->pp_timeout_report_cnt++;
  394. pending_kickoff_cnt = atomic_read(&phys_enc->pending_kickoff_cnt) + 1;
  395. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->hw_pp->idx - PINGPONG_0,
  396. cmd_enc->pp_timeout_report_cnt,
  397. pending_kickoff_cnt,
  398. frame_event);
  399. /* check if panel is still sending TE signal or not */
  400. if (sde_connector_esd_status(phys_enc->connector))
  401. goto exit;
  402. /* to avoid flooding, only log first time, and "dead" time */
  403. if (cmd_enc->pp_timeout_report_cnt == 1) {
  404. SDE_ERROR_CMDENC(cmd_enc,
  405. "pp:%d kickoff timed out ctl %d koff_cnt %d\n",
  406. phys_enc->hw_pp->idx - PINGPONG_0,
  407. phys_enc->hw_ctl->idx - CTL_0,
  408. pending_kickoff_cnt);
  409. SDE_EVT32(DRMID(phys_enc->parent), SDE_EVTLOG_FATAL);
  410. sde_encoder_helper_unregister_irq(phys_enc, INTR_IDX_RDPTR);
  411. if (sde_kms_is_secure_session_inprogress(phys_enc->sde_kms))
  412. SDE_DBG_DUMP("secure", "all", "dbg_bus");
  413. else
  414. SDE_DBG_DUMP("all", "dbg_bus", "vbif_dbg_bus");
  415. sde_encoder_helper_register_irq(phys_enc, INTR_IDX_RDPTR);
  416. }
  417. /*
  418. * if the recovery event is registered by user, don't panic
  419. * trigger panic on first timeout if no listener registered
  420. */
  421. if (recovery_events) {
  422. event = cmd_enc->pp_timeout_report_cnt > PP_TIMEOUT_MAX_TRIALS ?
  423. SDE_RECOVERY_HARD_RESET : SDE_RECOVERY_CAPTURE;
  424. sde_connector_event_notify(conn, DRM_EVENT_SDE_HW_RECOVERY,
  425. sizeof(uint8_t), event);
  426. } else if (cmd_enc->pp_timeout_report_cnt) {
  427. SDE_DBG_DUMP("dsi_dbg_bus", "panic");
  428. }
  429. /* request a ctl reset before the next kickoff */
  430. phys_enc->enable_state = SDE_ENC_ERR_NEEDS_HW_RESET;
  431. exit:
  432. if (phys_enc->parent_ops.handle_frame_done) {
  433. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  434. phys_enc->parent_ops.handle_frame_done(
  435. phys_enc->parent, phys_enc, frame_event);
  436. spin_unlock_irqrestore(phys_enc->enc_spinlock, lock_flags);
  437. }
  438. return -ETIMEDOUT;
  439. }
  440. static bool _sde_encoder_phys_is_ppsplit_slave(
  441. struct sde_encoder_phys *phys_enc)
  442. {
  443. if (!phys_enc)
  444. return false;
  445. return _sde_encoder_phys_is_ppsplit(phys_enc) &&
  446. phys_enc->split_role == ENC_ROLE_SLAVE;
  447. }
  448. static bool _sde_encoder_phys_is_disabling_ppsplit_slave(
  449. struct sde_encoder_phys *phys_enc)
  450. {
  451. enum sde_rm_topology_name old_top;
  452. if (!phys_enc || !phys_enc->connector ||
  453. phys_enc->split_role != ENC_ROLE_SLAVE)
  454. return false;
  455. old_top = sde_connector_get_old_topology_name(
  456. phys_enc->connector->state);
  457. return old_top == SDE_RM_TOPOLOGY_PPSPLIT;
  458. }
  459. static int _sde_encoder_phys_cmd_poll_write_pointer_started(
  460. struct sde_encoder_phys *phys_enc)
  461. {
  462. struct sde_encoder_phys_cmd *cmd_enc =
  463. to_sde_encoder_phys_cmd(phys_enc);
  464. struct sde_hw_pingpong *hw_pp = phys_enc->hw_pp;
  465. struct sde_hw_intf *hw_intf = phys_enc->hw_intf;
  466. struct sde_hw_pp_vsync_info info;
  467. u32 timeout_us = SDE_ENC_WR_PTR_START_TIMEOUT_US;
  468. int ret = 0;
  469. if (!hw_pp || !hw_intf)
  470. return 0;
  471. if (phys_enc->has_intf_te) {
  472. if (!hw_intf->ops.get_vsync_info ||
  473. !hw_intf->ops.poll_timeout_wr_ptr)
  474. goto end;
  475. } else {
  476. if (!hw_pp->ops.get_vsync_info ||
  477. !hw_pp->ops.poll_timeout_wr_ptr)
  478. goto end;
  479. }
  480. if (phys_enc->has_intf_te)
  481. ret = hw_intf->ops.get_vsync_info(hw_intf, &info);
  482. else
  483. ret = hw_pp->ops.get_vsync_info(hw_pp, &info);
  484. if (ret)
  485. return ret;
  486. SDE_DEBUG_CMDENC(cmd_enc,
  487. "pp:%d intf:%d rd_ptr %d wr_ptr %d\n",
  488. phys_enc->hw_pp->idx - PINGPONG_0,
  489. phys_enc->hw_intf->idx - INTF_0,
  490. info.rd_ptr_line_count,
  491. info.wr_ptr_line_count);
  492. SDE_EVT32_VERBOSE(DRMID(phys_enc->parent),
  493. phys_enc->hw_pp->idx - PINGPONG_0,
  494. phys_enc->hw_intf->idx - INTF_0,
  495. info.wr_ptr_line_count);
  496. if (phys_enc->has_intf_te)
  497. ret = hw_intf->ops.poll_timeout_wr_ptr(hw_intf, timeout_us);
  498. else
  499. ret = hw_pp->ops.poll_timeout_wr_ptr(hw_pp, timeout_us);
  500. if (ret) {
  501. SDE_EVT32(DRMID(phys_enc->parent),
  502. phys_enc->hw_pp->idx - PINGPONG_0,
  503. phys_enc->hw_intf->idx - INTF_0,
  504. timeout_us,
  505. ret);
  506. SDE_DBG_DUMP("all", "dbg_bus", "vbif_dbg_bus", "panic");
  507. }
  508. end:
  509. return ret;
  510. }
  511. static bool _sde_encoder_phys_cmd_is_ongoing_pptx(
  512. struct sde_encoder_phys *phys_enc)
  513. {
  514. struct sde_hw_pingpong *hw_pp;
  515. struct sde_hw_pp_vsync_info info;
  516. struct sde_hw_intf *hw_intf;
  517. if (!phys_enc)
  518. return false;
  519. if (phys_enc->has_intf_te) {
  520. hw_intf = phys_enc->hw_intf;
  521. if (!hw_intf || !hw_intf->ops.get_vsync_info)
  522. return false;
  523. hw_intf->ops.get_vsync_info(hw_intf, &info);
  524. } else {
  525. hw_pp = phys_enc->hw_pp;
  526. if (!hw_pp || !hw_pp->ops.get_vsync_info)
  527. return false;
  528. hw_pp->ops.get_vsync_info(hw_pp, &info);
  529. }
  530. SDE_EVT32(DRMID(phys_enc->parent),
  531. phys_enc->hw_pp->idx - PINGPONG_0,
  532. phys_enc->hw_intf->idx - INTF_0,
  533. atomic_read(&phys_enc->pending_kickoff_cnt),
  534. info.wr_ptr_line_count,
  535. phys_enc->cached_mode.vdisplay);
  536. if (info.wr_ptr_line_count > 0 && info.wr_ptr_line_count <
  537. phys_enc->cached_mode.vdisplay)
  538. return true;
  539. return false;
  540. }
  541. static bool _sde_encoder_phys_cmd_is_scheduler_idle(
  542. struct sde_encoder_phys *phys_enc)
  543. {
  544. bool wr_ptr_wait_success = true;
  545. unsigned long lock_flags;
  546. bool ret = false;
  547. struct sde_encoder_phys_cmd *cmd_enc =
  548. to_sde_encoder_phys_cmd(phys_enc);
  549. struct sde_hw_ctl *ctl = phys_enc->hw_ctl;
  550. if (sde_encoder_phys_cmd_is_master(phys_enc))
  551. wr_ptr_wait_success = cmd_enc->wr_ptr_wait_success;
  552. /*
  553. * Handle cases where a pp-done interrupt is missed
  554. * due to irq latency with POSTED start
  555. */
  556. if (wr_ptr_wait_success &&
  557. (phys_enc->frame_trigger_mode == FRAME_DONE_WAIT_POSTED_START) &&
  558. ctl->ops.get_scheduler_status &&
  559. (ctl->ops.get_scheduler_status(ctl) & BIT(0)) &&
  560. atomic_add_unless(&phys_enc->pending_kickoff_cnt, -1, 0) &&
  561. phys_enc->parent_ops.handle_frame_done) {
  562. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  563. phys_enc->parent_ops.handle_frame_done(
  564. phys_enc->parent, phys_enc,
  565. SDE_ENCODER_FRAME_EVENT_DONE |
  566. SDE_ENCODER_FRAME_EVENT_SIGNAL_RELEASE_FENCE);
  567. spin_unlock_irqrestore(phys_enc->enc_spinlock, lock_flags);
  568. SDE_EVT32(DRMID(phys_enc->parent),
  569. phys_enc->hw_pp->idx - PINGPONG_0,
  570. phys_enc->hw_intf->idx - INTF_0,
  571. atomic_read(&phys_enc->pending_kickoff_cnt));
  572. ret = true;
  573. }
  574. return ret;
  575. }
  576. static int _sde_encoder_phys_cmd_wait_for_idle(
  577. struct sde_encoder_phys *phys_enc)
  578. {
  579. struct sde_encoder_phys_cmd *cmd_enc =
  580. to_sde_encoder_phys_cmd(phys_enc);
  581. struct sde_encoder_wait_info wait_info = {0};
  582. bool recovery_events;
  583. int ret;
  584. if (!phys_enc) {
  585. SDE_ERROR("invalid encoder\n");
  586. return -EINVAL;
  587. }
  588. if (atomic_read(&phys_enc->pending_kickoff_cnt) > 1)
  589. wait_info.count_check = 1;
  590. wait_info.wq = &phys_enc->pending_kickoff_wq;
  591. wait_info.atomic_cnt = &phys_enc->pending_kickoff_cnt;
  592. wait_info.timeout_ms = KICKOFF_TIMEOUT_MS;
  593. recovery_events = sde_encoder_recovery_events_enabled(
  594. phys_enc->parent);
  595. /* slave encoder doesn't enable for ppsplit */
  596. if (_sde_encoder_phys_is_ppsplit_slave(phys_enc))
  597. return 0;
  598. if (_sde_encoder_phys_cmd_is_scheduler_idle(phys_enc))
  599. return 0;
  600. ret = sde_encoder_helper_wait_for_irq(phys_enc, INTR_IDX_PINGPONG,
  601. &wait_info);
  602. if (ret == -ETIMEDOUT) {
  603. if (_sde_encoder_phys_cmd_is_scheduler_idle(phys_enc))
  604. return 0;
  605. _sde_encoder_phys_cmd_handle_ppdone_timeout(phys_enc,
  606. recovery_events);
  607. } else if (!ret) {
  608. if (cmd_enc->pp_timeout_report_cnt && recovery_events) {
  609. struct drm_connector *conn = phys_enc->connector;
  610. sde_connector_event_notify(conn,
  611. DRM_EVENT_SDE_HW_RECOVERY,
  612. sizeof(uint8_t),
  613. SDE_RECOVERY_SUCCESS);
  614. }
  615. cmd_enc->pp_timeout_report_cnt = 0;
  616. }
  617. return ret;
  618. }
  619. static int _sde_encoder_phys_cmd_wait_for_autorefresh_done(
  620. struct sde_encoder_phys *phys_enc)
  621. {
  622. struct sde_encoder_phys_cmd *cmd_enc =
  623. to_sde_encoder_phys_cmd(phys_enc);
  624. struct sde_encoder_wait_info wait_info = {0};
  625. int ret = 0;
  626. if (!phys_enc) {
  627. SDE_ERROR("invalid encoder\n");
  628. return -EINVAL;
  629. }
  630. /* only master deals with autorefresh */
  631. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  632. return 0;
  633. wait_info.wq = &cmd_enc->autorefresh.kickoff_wq;
  634. wait_info.atomic_cnt = &cmd_enc->autorefresh.kickoff_cnt;
  635. wait_info.timeout_ms = _sde_encoder_phys_cmd_get_idle_timeout(cmd_enc);
  636. /* wait for autorefresh kickoff to start */
  637. ret = sde_encoder_helper_wait_for_irq(phys_enc,
  638. INTR_IDX_AUTOREFRESH_DONE, &wait_info);
  639. /* double check that kickoff has started by reading write ptr reg */
  640. if (!ret)
  641. ret = _sde_encoder_phys_cmd_poll_write_pointer_started(
  642. phys_enc);
  643. else
  644. sde_encoder_helper_report_irq_timeout(phys_enc,
  645. INTR_IDX_AUTOREFRESH_DONE);
  646. return ret;
  647. }
  648. static int sde_encoder_phys_cmd_control_vblank_irq(
  649. struct sde_encoder_phys *phys_enc,
  650. bool enable)
  651. {
  652. struct sde_encoder_phys_cmd *cmd_enc =
  653. to_sde_encoder_phys_cmd(phys_enc);
  654. int ret = 0;
  655. int refcount;
  656. if (!phys_enc || !phys_enc->hw_pp) {
  657. SDE_ERROR("invalid encoder\n");
  658. return -EINVAL;
  659. }
  660. mutex_lock(phys_enc->vblank_ctl_lock);
  661. refcount = atomic_read(&phys_enc->vblank_refcount);
  662. /* Slave encoders don't report vblank */
  663. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  664. goto end;
  665. /* protect against negative */
  666. if (!enable && refcount == 0) {
  667. ret = -EINVAL;
  668. goto end;
  669. }
  670. SDE_DEBUG_CMDENC(cmd_enc, "[%pS] enable=%d/%d\n",
  671. __builtin_return_address(0), enable, refcount);
  672. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->hw_pp->idx - PINGPONG_0,
  673. enable, refcount);
  674. if (enable && atomic_inc_return(&phys_enc->vblank_refcount) == 1)
  675. ret = sde_encoder_helper_register_irq(phys_enc, INTR_IDX_RDPTR);
  676. else if (!enable && atomic_dec_return(&phys_enc->vblank_refcount) == 0)
  677. ret = sde_encoder_helper_unregister_irq(phys_enc,
  678. INTR_IDX_RDPTR);
  679. end:
  680. if (ret) {
  681. SDE_ERROR_CMDENC(cmd_enc,
  682. "control vblank irq error %d, enable %d, refcount %d\n",
  683. ret, enable, refcount);
  684. SDE_EVT32(DRMID(phys_enc->parent),
  685. phys_enc->hw_pp->idx - PINGPONG_0,
  686. enable, refcount, SDE_EVTLOG_ERROR);
  687. }
  688. mutex_unlock(phys_enc->vblank_ctl_lock);
  689. return ret;
  690. }
  691. void sde_encoder_phys_cmd_irq_control(struct sde_encoder_phys *phys_enc,
  692. bool enable)
  693. {
  694. struct sde_encoder_phys_cmd *cmd_enc;
  695. if (!phys_enc)
  696. return;
  697. /**
  698. * pingpong split slaves do not register for IRQs
  699. * check old and new topologies
  700. */
  701. if (_sde_encoder_phys_is_ppsplit_slave(phys_enc) ||
  702. _sde_encoder_phys_is_disabling_ppsplit_slave(phys_enc))
  703. return;
  704. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  705. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->hw_pp->idx - PINGPONG_0,
  706. enable, atomic_read(&phys_enc->vblank_refcount));
  707. if (enable) {
  708. sde_encoder_helper_register_irq(phys_enc, INTR_IDX_PINGPONG);
  709. sde_encoder_phys_cmd_control_vblank_irq(phys_enc, true);
  710. if (sde_encoder_phys_cmd_is_master(phys_enc)) {
  711. sde_encoder_helper_register_irq(phys_enc,
  712. INTR_IDX_WRPTR);
  713. sde_encoder_helper_register_irq(phys_enc,
  714. INTR_IDX_AUTOREFRESH_DONE);
  715. }
  716. } else {
  717. if (sde_encoder_phys_cmd_is_master(phys_enc)) {
  718. sde_encoder_helper_unregister_irq(phys_enc,
  719. INTR_IDX_WRPTR);
  720. sde_encoder_helper_unregister_irq(phys_enc,
  721. INTR_IDX_AUTOREFRESH_DONE);
  722. }
  723. sde_encoder_phys_cmd_control_vblank_irq(phys_enc, false);
  724. sde_encoder_helper_unregister_irq(phys_enc, INTR_IDX_PINGPONG);
  725. }
  726. }
  727. static int _get_tearcheck_threshold(struct sde_encoder_phys *phys_enc,
  728. u32 *extra_frame_trigger_time)
  729. {
  730. struct drm_connector *conn = phys_enc->connector;
  731. u32 qsync_mode;
  732. struct drm_display_mode *mode;
  733. u32 threshold_lines = 0;
  734. struct sde_encoder_phys_cmd *cmd_enc =
  735. to_sde_encoder_phys_cmd(phys_enc);
  736. *extra_frame_trigger_time = 0;
  737. if (!conn || !conn->state)
  738. return 0;
  739. mode = &phys_enc->cached_mode;
  740. qsync_mode = sde_connector_get_qsync_mode(conn);
  741. if (mode && (qsync_mode == SDE_RM_QSYNC_CONTINUOUS_MODE)) {
  742. u32 qsync_min_fps = 0;
  743. u32 default_fps = mode->vrefresh;
  744. u32 yres = mode->vtotal;
  745. u32 slow_time_ns;
  746. u32 default_time_ns;
  747. u32 extra_time_ns;
  748. u32 total_extra_lines;
  749. u32 default_line_time_ns;
  750. if (phys_enc->parent_ops.get_qsync_fps)
  751. phys_enc->parent_ops.get_qsync_fps(
  752. phys_enc->parent, &qsync_min_fps);
  753. if (!qsync_min_fps || !default_fps || !yres) {
  754. SDE_ERROR_CMDENC(cmd_enc,
  755. "wrong qsync params %d %d %d\n",
  756. qsync_min_fps, default_fps, yres);
  757. goto exit;
  758. }
  759. if (qsync_min_fps >= default_fps) {
  760. SDE_ERROR_CMDENC(cmd_enc,
  761. "qsync fps:%d must be less than default:%d\n",
  762. qsync_min_fps, default_fps);
  763. goto exit;
  764. }
  765. /* Calculate the number of extra lines*/
  766. slow_time_ns = (1 * 1000000000) / qsync_min_fps;
  767. default_time_ns = (1 * 1000000000) / default_fps;
  768. extra_time_ns = slow_time_ns - default_time_ns;
  769. default_line_time_ns = (1 * 1000000000) / (default_fps * yres);
  770. total_extra_lines = extra_time_ns / default_line_time_ns;
  771. threshold_lines += total_extra_lines;
  772. SDE_DEBUG_CMDENC(cmd_enc, "slow:%d default:%d extra:%d(ns)\n",
  773. slow_time_ns, default_time_ns, extra_time_ns);
  774. SDE_DEBUG_CMDENC(cmd_enc, "extra_lines:%d threshold:%d\n",
  775. total_extra_lines, threshold_lines);
  776. SDE_DEBUG_CMDENC(cmd_enc, "min_fps:%d fps:%d yres:%d\n",
  777. qsync_min_fps, default_fps, yres);
  778. SDE_EVT32(qsync_mode, qsync_min_fps, extra_time_ns, default_fps,
  779. yres, threshold_lines);
  780. *extra_frame_trigger_time = extra_time_ns;
  781. }
  782. exit:
  783. threshold_lines += DEFAULT_TEARCHECK_SYNC_THRESH_START;
  784. return threshold_lines;
  785. }
  786. static void sde_encoder_phys_cmd_tearcheck_config(
  787. struct sde_encoder_phys *phys_enc)
  788. {
  789. struct sde_encoder_phys_cmd *cmd_enc =
  790. to_sde_encoder_phys_cmd(phys_enc);
  791. struct sde_hw_tear_check tc_cfg = { 0 };
  792. struct drm_display_mode *mode;
  793. bool tc_enable = true;
  794. u32 vsync_hz, extra_frame_trigger_time;
  795. struct msm_drm_private *priv;
  796. struct sde_kms *sde_kms;
  797. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf) {
  798. SDE_ERROR("invalid encoder\n");
  799. return;
  800. }
  801. mode = &phys_enc->cached_mode;
  802. SDE_DEBUG_CMDENC(cmd_enc, "pp %d, intf %d\n",
  803. phys_enc->hw_pp->idx - PINGPONG_0,
  804. phys_enc->hw_intf->idx - INTF_0);
  805. if (phys_enc->has_intf_te) {
  806. if (!phys_enc->hw_intf->ops.setup_tearcheck ||
  807. !phys_enc->hw_intf->ops.enable_tearcheck) {
  808. SDE_DEBUG_CMDENC(cmd_enc, "tearcheck not supported\n");
  809. return;
  810. }
  811. } else {
  812. if (!phys_enc->hw_pp->ops.setup_tearcheck ||
  813. !phys_enc->hw_pp->ops.enable_tearcheck) {
  814. SDE_DEBUG_CMDENC(cmd_enc, "tearcheck not supported\n");
  815. return;
  816. }
  817. }
  818. sde_kms = phys_enc->sde_kms;
  819. if (!sde_kms || !sde_kms->dev || !sde_kms->dev->dev_private) {
  820. SDE_ERROR("invalid device\n");
  821. return;
  822. }
  823. priv = sde_kms->dev->dev_private;
  824. /*
  825. * TE default: dsi byte clock calculated base on 70 fps;
  826. * around 14 ms to complete a kickoff cycle if te disabled;
  827. * vclk_line base on 60 fps; write is faster than read;
  828. * init == start == rdptr;
  829. *
  830. * vsync_count is ratio of MDP VSYNC clock frequency to LCD panel
  831. * frequency divided by the no. of rows (lines) in the LCDpanel.
  832. */
  833. vsync_hz = sde_power_clk_get_rate(&priv->phandle, "vsync_clk");
  834. if (!vsync_hz || !mode->vtotal || !mode->vrefresh) {
  835. SDE_DEBUG_CMDENC(cmd_enc,
  836. "invalid params - vsync_hz %u vtot %u vrefresh %u\n",
  837. vsync_hz, mode->vtotal, mode->vrefresh);
  838. return;
  839. }
  840. tc_cfg.vsync_count = vsync_hz / (mode->vtotal * mode->vrefresh);
  841. /* enable external TE after kickoff to avoid premature autorefresh */
  842. tc_cfg.hw_vsync_mode = 0;
  843. /*
  844. * By setting sync_cfg_height to near max register value, we essentially
  845. * disable sde hw generated TE signal, since hw TE will arrive first.
  846. * Only caveat is if due to error, we hit wrap-around.
  847. */
  848. tc_cfg.sync_cfg_height = 0xFFF0;
  849. tc_cfg.vsync_init_val = mode->vdisplay;
  850. tc_cfg.sync_threshold_start = _get_tearcheck_threshold(phys_enc,
  851. &extra_frame_trigger_time);
  852. tc_cfg.sync_threshold_continue = DEFAULT_TEARCHECK_SYNC_THRESH_CONTINUE;
  853. tc_cfg.start_pos = mode->vdisplay;
  854. tc_cfg.rd_ptr_irq = mode->vdisplay + 1;
  855. tc_cfg.wr_ptr_irq = 1;
  856. SDE_DEBUG_CMDENC(cmd_enc,
  857. "tc %d intf %d vsync_clk_speed_hz %u vtotal %u vrefresh %u\n",
  858. phys_enc->hw_pp->idx - PINGPONG_0,
  859. phys_enc->hw_intf->idx - INTF_0,
  860. vsync_hz, mode->vtotal, mode->vrefresh);
  861. SDE_DEBUG_CMDENC(cmd_enc,
  862. "tc %d intf %d enable %u start_pos %u rd_ptr_irq %u wr_ptr_irq %u\n",
  863. phys_enc->hw_pp->idx - PINGPONG_0,
  864. phys_enc->hw_intf->idx - INTF_0,
  865. tc_enable, tc_cfg.start_pos, tc_cfg.rd_ptr_irq,
  866. tc_cfg.wr_ptr_irq);
  867. SDE_DEBUG_CMDENC(cmd_enc,
  868. "tc %d intf %d hw_vsync_mode %u vsync_count %u vsync_init_val %u\n",
  869. phys_enc->hw_pp->idx - PINGPONG_0,
  870. phys_enc->hw_intf->idx - INTF_0,
  871. tc_cfg.hw_vsync_mode, tc_cfg.vsync_count,
  872. tc_cfg.vsync_init_val);
  873. SDE_DEBUG_CMDENC(cmd_enc,
  874. "tc %d intf %d cfgheight %u thresh_start %u thresh_cont %u\n",
  875. phys_enc->hw_pp->idx - PINGPONG_0,
  876. phys_enc->hw_intf->idx - INTF_0,
  877. tc_cfg.sync_cfg_height,
  878. tc_cfg.sync_threshold_start, tc_cfg.sync_threshold_continue);
  879. if (phys_enc->has_intf_te) {
  880. phys_enc->hw_intf->ops.setup_tearcheck(phys_enc->hw_intf,
  881. &tc_cfg);
  882. phys_enc->hw_intf->ops.enable_tearcheck(phys_enc->hw_intf,
  883. tc_enable);
  884. } else {
  885. phys_enc->hw_pp->ops.setup_tearcheck(phys_enc->hw_pp, &tc_cfg);
  886. phys_enc->hw_pp->ops.enable_tearcheck(phys_enc->hw_pp,
  887. tc_enable);
  888. }
  889. }
  890. static void _sde_encoder_phys_cmd_pingpong_config(
  891. struct sde_encoder_phys *phys_enc)
  892. {
  893. struct sde_encoder_phys_cmd *cmd_enc =
  894. to_sde_encoder_phys_cmd(phys_enc);
  895. if (!phys_enc || !phys_enc->hw_ctl || !phys_enc->hw_pp) {
  896. SDE_ERROR("invalid arg(s), enc %d\n", !phys_enc);
  897. return;
  898. }
  899. SDE_DEBUG_CMDENC(cmd_enc, "pp %d, enabling mode:\n",
  900. phys_enc->hw_pp->idx - PINGPONG_0);
  901. drm_mode_debug_printmodeline(&phys_enc->cached_mode);
  902. if (!_sde_encoder_phys_is_ppsplit_slave(phys_enc))
  903. _sde_encoder_phys_cmd_update_intf_cfg(phys_enc);
  904. sde_encoder_phys_cmd_tearcheck_config(phys_enc);
  905. }
  906. static void sde_encoder_phys_cmd_enable_helper(
  907. struct sde_encoder_phys *phys_enc)
  908. {
  909. if (!phys_enc || !phys_enc->hw_ctl || !phys_enc->hw_pp) {
  910. SDE_ERROR("invalid arg(s), encoder %d\n", !phys_enc);
  911. return;
  912. }
  913. sde_encoder_helper_split_config(phys_enc, phys_enc->intf_idx);
  914. _sde_encoder_phys_cmd_pingpong_config(phys_enc);
  915. /*
  916. * For pp-split, skip setting the flush bit for the slave intf, since
  917. * both intfs use same ctl and HW will only flush the master.
  918. */
  919. if (_sde_encoder_phys_is_ppsplit(phys_enc) &&
  920. !sde_encoder_phys_cmd_is_master(phys_enc))
  921. goto skip_flush;
  922. _sde_encoder_phys_cmd_update_flush_mask(phys_enc);
  923. skip_flush:
  924. return;
  925. }
  926. static void sde_encoder_phys_cmd_enable(struct sde_encoder_phys *phys_enc)
  927. {
  928. struct sde_encoder_phys_cmd *cmd_enc =
  929. to_sde_encoder_phys_cmd(phys_enc);
  930. if (!phys_enc || !phys_enc->hw_pp) {
  931. SDE_ERROR("invalid phys encoder\n");
  932. return;
  933. }
  934. SDE_DEBUG_CMDENC(cmd_enc, "pp %d\n", phys_enc->hw_pp->idx - PINGPONG_0);
  935. if (phys_enc->enable_state == SDE_ENC_ENABLED) {
  936. if (!phys_enc->cont_splash_enabled)
  937. SDE_ERROR("already enabled\n");
  938. return;
  939. }
  940. sde_encoder_phys_cmd_enable_helper(phys_enc);
  941. phys_enc->enable_state = SDE_ENC_ENABLED;
  942. }
  943. static bool sde_encoder_phys_cmd_is_autorefresh_enabled(
  944. struct sde_encoder_phys *phys_enc)
  945. {
  946. struct sde_hw_pingpong *hw_pp;
  947. struct sde_hw_intf *hw_intf;
  948. struct sde_hw_autorefresh cfg;
  949. int ret;
  950. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  951. return false;
  952. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  953. return false;
  954. if (phys_enc->has_intf_te) {
  955. hw_intf = phys_enc->hw_intf;
  956. if (!hw_intf->ops.get_autorefresh)
  957. return false;
  958. ret = hw_intf->ops.get_autorefresh(hw_intf, &cfg);
  959. } else {
  960. hw_pp = phys_enc->hw_pp;
  961. if (!hw_pp->ops.get_autorefresh)
  962. return false;
  963. ret = hw_pp->ops.get_autorefresh(hw_pp, &cfg);
  964. }
  965. if (ret)
  966. return false;
  967. return cfg.enable;
  968. }
  969. static void sde_encoder_phys_cmd_connect_te(
  970. struct sde_encoder_phys *phys_enc, bool enable)
  971. {
  972. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  973. return;
  974. if (phys_enc->has_intf_te &&
  975. phys_enc->hw_intf->ops.connect_external_te)
  976. phys_enc->hw_intf->ops.connect_external_te(phys_enc->hw_intf,
  977. enable);
  978. else if (phys_enc->hw_pp->ops.connect_external_te)
  979. phys_enc->hw_pp->ops.connect_external_te(phys_enc->hw_pp,
  980. enable);
  981. else
  982. return;
  983. SDE_EVT32(DRMID(phys_enc->parent), enable);
  984. }
  985. static int sde_encoder_phys_cmd_te_get_line_count(
  986. struct sde_encoder_phys *phys_enc)
  987. {
  988. struct sde_hw_pingpong *hw_pp;
  989. struct sde_hw_intf *hw_intf;
  990. u32 line_count;
  991. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  992. return -EINVAL;
  993. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  994. return -EINVAL;
  995. if (phys_enc->has_intf_te) {
  996. hw_intf = phys_enc->hw_intf;
  997. if (!hw_intf->ops.get_line_count)
  998. return -EINVAL;
  999. line_count = hw_intf->ops.get_line_count(hw_intf);
  1000. } else {
  1001. hw_pp = phys_enc->hw_pp;
  1002. if (!hw_pp->ops.get_line_count)
  1003. return -EINVAL;
  1004. line_count = hw_pp->ops.get_line_count(hw_pp);
  1005. }
  1006. return line_count;
  1007. }
  1008. static int sde_encoder_phys_cmd_get_write_line_count(
  1009. struct sde_encoder_phys *phys_enc)
  1010. {
  1011. struct sde_hw_pingpong *hw_pp;
  1012. struct sde_hw_intf *hw_intf;
  1013. struct sde_hw_pp_vsync_info info;
  1014. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  1015. return -EINVAL;
  1016. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  1017. return -EINVAL;
  1018. if (phys_enc->has_intf_te) {
  1019. hw_intf = phys_enc->hw_intf;
  1020. if (!hw_intf->ops.get_vsync_info)
  1021. return -EINVAL;
  1022. if (hw_intf->ops.get_vsync_info(hw_intf, &info))
  1023. return -EINVAL;
  1024. } else {
  1025. hw_pp = phys_enc->hw_pp;
  1026. if (!hw_pp->ops.get_vsync_info)
  1027. return -EINVAL;
  1028. if (hw_pp->ops.get_vsync_info(hw_pp, &info))
  1029. return -EINVAL;
  1030. }
  1031. return (int)info.wr_ptr_line_count;
  1032. }
  1033. static void sde_encoder_phys_cmd_disable(struct sde_encoder_phys *phys_enc)
  1034. {
  1035. struct sde_encoder_phys_cmd *cmd_enc =
  1036. to_sde_encoder_phys_cmd(phys_enc);
  1037. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf) {
  1038. SDE_ERROR("invalid encoder\n");
  1039. return;
  1040. }
  1041. SDE_DEBUG_CMDENC(cmd_enc, "pp %d intf %d state %d\n",
  1042. phys_enc->hw_pp->idx - PINGPONG_0,
  1043. phys_enc->hw_intf->idx - INTF_0,
  1044. phys_enc->enable_state);
  1045. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->hw_pp->idx - PINGPONG_0,
  1046. phys_enc->hw_intf->idx - INTF_0,
  1047. phys_enc->enable_state);
  1048. if (phys_enc->enable_state == SDE_ENC_DISABLED) {
  1049. SDE_ERROR_CMDENC(cmd_enc, "already disabled\n");
  1050. return;
  1051. }
  1052. if (phys_enc->has_intf_te && phys_enc->hw_intf->ops.enable_tearcheck)
  1053. phys_enc->hw_intf->ops.enable_tearcheck(
  1054. phys_enc->hw_intf,
  1055. false);
  1056. else if (phys_enc->hw_pp->ops.enable_tearcheck)
  1057. phys_enc->hw_pp->ops.enable_tearcheck(phys_enc->hw_pp,
  1058. false);
  1059. phys_enc->enable_state = SDE_ENC_DISABLED;
  1060. }
  1061. static void sde_encoder_phys_cmd_destroy(struct sde_encoder_phys *phys_enc)
  1062. {
  1063. struct sde_encoder_phys_cmd *cmd_enc =
  1064. to_sde_encoder_phys_cmd(phys_enc);
  1065. if (!phys_enc) {
  1066. SDE_ERROR("invalid encoder\n");
  1067. return;
  1068. }
  1069. kfree(cmd_enc);
  1070. }
  1071. static void sde_encoder_phys_cmd_get_hw_resources(
  1072. struct sde_encoder_phys *phys_enc,
  1073. struct sde_encoder_hw_resources *hw_res,
  1074. struct drm_connector_state *conn_state)
  1075. {
  1076. struct sde_encoder_phys_cmd *cmd_enc =
  1077. to_sde_encoder_phys_cmd(phys_enc);
  1078. if (!phys_enc) {
  1079. SDE_ERROR("invalid encoder\n");
  1080. return;
  1081. }
  1082. if ((phys_enc->intf_idx - INTF_0) >= INTF_MAX) {
  1083. SDE_ERROR("invalid intf idx:%d\n", phys_enc->intf_idx);
  1084. return;
  1085. }
  1086. SDE_DEBUG_CMDENC(cmd_enc, "\n");
  1087. hw_res->intfs[phys_enc->intf_idx - INTF_0] = INTF_MODE_CMD;
  1088. }
  1089. static int sde_encoder_phys_cmd_prepare_for_kickoff(
  1090. struct sde_encoder_phys *phys_enc,
  1091. struct sde_encoder_kickoff_params *params)
  1092. {
  1093. struct sde_hw_tear_check tc_cfg = {0};
  1094. struct sde_encoder_phys_cmd *cmd_enc =
  1095. to_sde_encoder_phys_cmd(phys_enc);
  1096. int ret = 0;
  1097. u32 extra_frame_trigger_time;
  1098. if (!phys_enc || !phys_enc->hw_pp) {
  1099. SDE_ERROR("invalid encoder\n");
  1100. return -EINVAL;
  1101. }
  1102. SDE_DEBUG_CMDENC(cmd_enc, "pp %d\n", phys_enc->hw_pp->idx - PINGPONG_0);
  1103. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->hw_pp->idx - PINGPONG_0,
  1104. atomic_read(&phys_enc->pending_kickoff_cnt),
  1105. atomic_read(&cmd_enc->autorefresh.kickoff_cnt));
  1106. phys_enc->frame_trigger_mode = params->frame_trigger_mode;
  1107. if (phys_enc->frame_trigger_mode == FRAME_DONE_WAIT_DEFAULT) {
  1108. /*
  1109. * Mark kickoff request as outstanding. If there are more
  1110. * than one outstanding frame, then we have to wait for the
  1111. * previous frame to complete
  1112. */
  1113. ret = _sde_encoder_phys_cmd_wait_for_idle(phys_enc);
  1114. if (ret) {
  1115. atomic_set(&phys_enc->pending_kickoff_cnt, 0);
  1116. SDE_EVT32(DRMID(phys_enc->parent),
  1117. phys_enc->hw_pp->idx - PINGPONG_0);
  1118. SDE_ERROR("failed wait_for_idle: %d\n", ret);
  1119. }
  1120. }
  1121. if (sde_connector_is_qsync_updated(phys_enc->connector)) {
  1122. tc_cfg.sync_threshold_start =
  1123. _get_tearcheck_threshold(phys_enc,
  1124. &extra_frame_trigger_time);
  1125. if (phys_enc->has_intf_te &&
  1126. phys_enc->hw_intf->ops.update_tearcheck)
  1127. phys_enc->hw_intf->ops.update_tearcheck(
  1128. phys_enc->hw_intf, &tc_cfg);
  1129. else if (phys_enc->hw_pp->ops.update_tearcheck)
  1130. phys_enc->hw_pp->ops.update_tearcheck(
  1131. phys_enc->hw_pp, &tc_cfg);
  1132. SDE_EVT32(DRMID(phys_enc->parent), tc_cfg.sync_threshold_start);
  1133. }
  1134. SDE_DEBUG_CMDENC(cmd_enc, "pp:%d pending_cnt %d\n",
  1135. phys_enc->hw_pp->idx - PINGPONG_0,
  1136. atomic_read(&phys_enc->pending_kickoff_cnt));
  1137. return ret;
  1138. }
  1139. static bool _sde_encoder_phys_cmd_needs_vsync_change(
  1140. struct sde_encoder_phys *phys_enc, ktime_t profile_timestamp)
  1141. {
  1142. struct sde_encoder_phys_cmd *cmd_enc;
  1143. struct sde_encoder_phys_cmd_te_timestamp *cur;
  1144. struct sde_encoder_phys_cmd_te_timestamp *prev = NULL;
  1145. ktime_t time_diff;
  1146. u64 l_bound = 0, u_bound = 0;
  1147. bool ret = false;
  1148. unsigned long lock_flags;
  1149. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1150. sde_encoder_helper_get_jitter_bounds_ns(phys_enc->parent,
  1151. &l_bound, &u_bound);
  1152. if (!l_bound || !u_bound) {
  1153. SDE_ERROR_CMDENC(cmd_enc, "invalid vsync jitter bounds\n");
  1154. return false;
  1155. }
  1156. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  1157. list_for_each_entry_reverse(cur, &cmd_enc->te_timestamp_list, list) {
  1158. if (prev && ktime_after(cur->timestamp, profile_timestamp)) {
  1159. time_diff = ktime_sub(prev->timestamp, cur->timestamp);
  1160. if ((time_diff < l_bound) || (time_diff > u_bound)) {
  1161. ret = true;
  1162. break;
  1163. }
  1164. }
  1165. prev = cur;
  1166. }
  1167. spin_unlock_irqrestore(phys_enc->enc_spinlock, lock_flags);
  1168. if (ret) {
  1169. SDE_DEBUG_CMDENC(cmd_enc,
  1170. "time_diff:%llu, prev:%llu, cur:%llu, jitter:%llu/%llu\n",
  1171. time_diff, prev->timestamp, cur->timestamp,
  1172. l_bound, u_bound);
  1173. SDE_EVT32(DRMID(phys_enc->parent),
  1174. (u32) (l_bound / 1000), (u32) (u_bound / 1000),
  1175. (u32) (time_diff / 1000), SDE_EVTLOG_ERROR);
  1176. }
  1177. return ret;
  1178. }
  1179. static int _sde_encoder_phys_cmd_wait_for_wr_ptr(
  1180. struct sde_encoder_phys *phys_enc)
  1181. {
  1182. struct sde_encoder_phys_cmd *cmd_enc =
  1183. to_sde_encoder_phys_cmd(phys_enc);
  1184. struct sde_encoder_wait_info wait_info = {0};
  1185. int ret;
  1186. bool frame_pending = true;
  1187. struct sde_hw_ctl *ctl;
  1188. if (!phys_enc || !phys_enc->hw_ctl) {
  1189. SDE_ERROR("invalid argument(s)\n");
  1190. return -EINVAL;
  1191. }
  1192. ctl = phys_enc->hw_ctl;
  1193. wait_info.wq = &phys_enc->pending_kickoff_wq;
  1194. wait_info.atomic_cnt = &phys_enc->pending_retire_fence_cnt;
  1195. wait_info.timeout_ms = KICKOFF_TIMEOUT_MS;
  1196. /* slave encoder doesn't enable for ppsplit */
  1197. if (_sde_encoder_phys_is_ppsplit_slave(phys_enc))
  1198. return 0;
  1199. ret = sde_encoder_helper_wait_for_irq(phys_enc, INTR_IDX_WRPTR,
  1200. &wait_info);
  1201. if (ret == -ETIMEDOUT) {
  1202. struct sde_hw_ctl *ctl = phys_enc->hw_ctl;
  1203. if (ctl && ctl->ops.get_start_state)
  1204. frame_pending = ctl->ops.get_start_state(ctl);
  1205. ret = frame_pending ? ret : 0;
  1206. }
  1207. cmd_enc->wr_ptr_wait_success = (ret == 0) ? true : false;
  1208. return ret;
  1209. }
  1210. static int sde_encoder_phys_cmd_wait_for_tx_complete(
  1211. struct sde_encoder_phys *phys_enc)
  1212. {
  1213. int rc;
  1214. struct sde_encoder_phys_cmd *cmd_enc;
  1215. if (!phys_enc)
  1216. return -EINVAL;
  1217. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1218. if (!atomic_read(&phys_enc->pending_kickoff_cnt)) {
  1219. SDE_EVT32(DRMID(phys_enc->parent),
  1220. phys_enc->intf_idx - INTF_0,
  1221. phys_enc->enable_state);
  1222. return 0;
  1223. }
  1224. rc = _sde_encoder_phys_cmd_wait_for_idle(phys_enc);
  1225. if (rc) {
  1226. SDE_EVT32(DRMID(phys_enc->parent),
  1227. phys_enc->intf_idx - INTF_0);
  1228. SDE_ERROR("failed wait_for_idle: %d\n", rc);
  1229. }
  1230. return rc;
  1231. }
  1232. static int _sde_encoder_phys_cmd_handle_wr_ptr_timeout(
  1233. struct sde_encoder_phys *phys_enc,
  1234. ktime_t profile_timestamp)
  1235. {
  1236. struct sde_encoder_phys_cmd *cmd_enc =
  1237. to_sde_encoder_phys_cmd(phys_enc);
  1238. bool switch_te;
  1239. int ret = -ETIMEDOUT;
  1240. unsigned long lock_flags;
  1241. switch_te = _sde_encoder_phys_cmd_needs_vsync_change(
  1242. phys_enc, profile_timestamp);
  1243. SDE_EVT32(DRMID(phys_enc->parent), switch_te, SDE_EVTLOG_FUNC_ENTRY);
  1244. if (switch_te) {
  1245. SDE_DEBUG_CMDENC(cmd_enc,
  1246. "wr_ptr_irq wait failed, retry with WD TE\n");
  1247. /* switch to watchdog TE and wait again */
  1248. sde_encoder_helper_switch_vsync(phys_enc->parent, true);
  1249. ret = _sde_encoder_phys_cmd_wait_for_wr_ptr(phys_enc);
  1250. /* switch back to default TE */
  1251. sde_encoder_helper_switch_vsync(phys_enc->parent, false);
  1252. }
  1253. /*
  1254. * Signaling the retire fence at wr_ptr timeout
  1255. * to allow the next commit and avoid device freeze.
  1256. */
  1257. if (ret == -ETIMEDOUT) {
  1258. SDE_ERROR_CMDENC(cmd_enc,
  1259. "wr_ptr_irq wait failed, switch_te:%d\n", switch_te);
  1260. SDE_EVT32(DRMID(phys_enc->parent), switch_te, SDE_EVTLOG_ERROR);
  1261. if (sde_encoder_phys_cmd_is_master(phys_enc) &&
  1262. atomic_add_unless(
  1263. &phys_enc->pending_retire_fence_cnt, -1, 0)) {
  1264. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  1265. phys_enc->parent_ops.handle_frame_done(
  1266. phys_enc->parent, phys_enc,
  1267. SDE_ENCODER_FRAME_EVENT_SIGNAL_RETIRE_FENCE);
  1268. spin_unlock_irqrestore(phys_enc->enc_spinlock,
  1269. lock_flags);
  1270. }
  1271. }
  1272. cmd_enc->wr_ptr_wait_success = (ret == 0) ? true : false;
  1273. return ret;
  1274. }
  1275. static int sde_encoder_phys_cmd_wait_for_commit_done(
  1276. struct sde_encoder_phys *phys_enc)
  1277. {
  1278. int rc = 0, i, pending_cnt;
  1279. struct sde_encoder_phys_cmd *cmd_enc;
  1280. ktime_t profile_timestamp = ktime_get();
  1281. if (!phys_enc)
  1282. return -EINVAL;
  1283. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1284. /* only required for master controller */
  1285. if (sde_encoder_phys_cmd_is_master(phys_enc)) {
  1286. rc = _sde_encoder_phys_cmd_wait_for_wr_ptr(phys_enc);
  1287. if (rc == -ETIMEDOUT) {
  1288. /*
  1289. * Profile all the TE received after profile_timestamp
  1290. * and if the jitter is more, switch to watchdog TE
  1291. * and wait for wr_ptr again. Finally move back to
  1292. * default TE.
  1293. */
  1294. rc = _sde_encoder_phys_cmd_handle_wr_ptr_timeout(
  1295. phys_enc, profile_timestamp);
  1296. if (rc == -ETIMEDOUT)
  1297. goto wait_for_idle;
  1298. }
  1299. if (cmd_enc->autorefresh.cfg.enable)
  1300. rc = _sde_encoder_phys_cmd_wait_for_autorefresh_done(
  1301. phys_enc);
  1302. }
  1303. /* wait for posted start or serialize trigger */
  1304. if ((atomic_read(&phys_enc->pending_kickoff_cnt) > 1) ||
  1305. (!rc && phys_enc->frame_trigger_mode == FRAME_DONE_WAIT_SERIALIZE))
  1306. goto wait_for_idle;
  1307. return rc;
  1308. wait_for_idle:
  1309. pending_cnt = atomic_read(&phys_enc->pending_kickoff_cnt);
  1310. for (i = 0; i < pending_cnt; i++)
  1311. rc |= sde_encoder_wait_for_event(phys_enc->parent,
  1312. MSM_ENC_TX_COMPLETE);
  1313. if (rc) {
  1314. SDE_EVT32(DRMID(phys_enc->parent),
  1315. phys_enc->hw_pp->idx - PINGPONG_0,
  1316. phys_enc->frame_trigger_mode,
  1317. atomic_read(&phys_enc->pending_kickoff_cnt),
  1318. phys_enc->enable_state, rc);
  1319. SDE_ERROR("pp:%d failed wait_for_idle: %d\n",
  1320. phys_enc->hw_pp->idx - PINGPONG_0, rc);
  1321. if (phys_enc->enable_state == SDE_ENC_ERR_NEEDS_HW_RESET)
  1322. sde_encoder_helper_needs_hw_reset(phys_enc->parent);
  1323. }
  1324. return rc;
  1325. }
  1326. static int sde_encoder_phys_cmd_wait_for_vblank(
  1327. struct sde_encoder_phys *phys_enc)
  1328. {
  1329. int rc = 0;
  1330. struct sde_encoder_phys_cmd *cmd_enc;
  1331. struct sde_encoder_wait_info wait_info = {0};
  1332. if (!phys_enc)
  1333. return -EINVAL;
  1334. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1335. /* only required for master controller */
  1336. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  1337. return rc;
  1338. wait_info.wq = &cmd_enc->pending_vblank_wq;
  1339. wait_info.atomic_cnt = &cmd_enc->pending_vblank_cnt;
  1340. wait_info.timeout_ms = _sde_encoder_phys_cmd_get_idle_timeout(cmd_enc);
  1341. atomic_inc(&cmd_enc->pending_vblank_cnt);
  1342. rc = sde_encoder_helper_wait_for_irq(phys_enc, INTR_IDX_RDPTR,
  1343. &wait_info);
  1344. return rc;
  1345. }
  1346. static void sde_encoder_phys_cmd_update_split_role(
  1347. struct sde_encoder_phys *phys_enc,
  1348. enum sde_enc_split_role role)
  1349. {
  1350. struct sde_encoder_phys_cmd *cmd_enc;
  1351. enum sde_enc_split_role old_role;
  1352. bool is_ppsplit;
  1353. if (!phys_enc)
  1354. return;
  1355. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1356. old_role = phys_enc->split_role;
  1357. is_ppsplit = _sde_encoder_phys_is_ppsplit(phys_enc);
  1358. phys_enc->split_role = role;
  1359. SDE_DEBUG_CMDENC(cmd_enc, "old role %d new role %d\n",
  1360. old_role, role);
  1361. /*
  1362. * ppsplit solo needs to reprogram because intf may have swapped without
  1363. * role changing on left-only, right-only back-to-back commits
  1364. */
  1365. if (!(is_ppsplit && role == ENC_ROLE_SOLO) &&
  1366. (role == old_role || role == ENC_ROLE_SKIP))
  1367. return;
  1368. sde_encoder_helper_split_config(phys_enc, phys_enc->intf_idx);
  1369. _sde_encoder_phys_cmd_pingpong_config(phys_enc);
  1370. _sde_encoder_phys_cmd_update_flush_mask(phys_enc);
  1371. }
  1372. static void sde_encoder_phys_cmd_prepare_commit(
  1373. struct sde_encoder_phys *phys_enc)
  1374. {
  1375. struct sde_encoder_phys_cmd *cmd_enc =
  1376. to_sde_encoder_phys_cmd(phys_enc);
  1377. int trial = 0;
  1378. if (!phys_enc)
  1379. return;
  1380. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  1381. return;
  1382. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->intf_idx - INTF_0,
  1383. cmd_enc->autorefresh.cfg.enable);
  1384. if (!sde_encoder_phys_cmd_is_autorefresh_enabled(phys_enc))
  1385. return;
  1386. /*
  1387. * If autorefresh is enabled, disable it and make sure it is safe to
  1388. * proceed with current frame commit/push. Sequence fallowed is,
  1389. * 1. Disable TE
  1390. * 2. Disable autorefresh config
  1391. * 4. Poll for frame transfer ongoing to be false
  1392. * 5. Enable TE back
  1393. */
  1394. sde_encoder_phys_cmd_connect_te(phys_enc, false);
  1395. _sde_encoder_phys_cmd_config_autorefresh(phys_enc, 0);
  1396. do {
  1397. udelay(SDE_ENC_MAX_POLL_TIMEOUT_US);
  1398. if ((trial * SDE_ENC_MAX_POLL_TIMEOUT_US)
  1399. > (KICKOFF_TIMEOUT_MS * USEC_PER_MSEC)) {
  1400. SDE_ERROR_CMDENC(cmd_enc,
  1401. "disable autorefresh failed\n");
  1402. break;
  1403. }
  1404. trial++;
  1405. } while (_sde_encoder_phys_cmd_is_ongoing_pptx(phys_enc));
  1406. sde_encoder_phys_cmd_connect_te(phys_enc, true);
  1407. SDE_DEBUG_CMDENC(cmd_enc, "disabled autorefresh\n");
  1408. }
  1409. static void sde_encoder_phys_cmd_trigger_start(
  1410. struct sde_encoder_phys *phys_enc)
  1411. {
  1412. struct sde_encoder_phys_cmd *cmd_enc =
  1413. to_sde_encoder_phys_cmd(phys_enc);
  1414. u32 frame_cnt;
  1415. if (!phys_enc)
  1416. return;
  1417. /* we don't issue CTL_START when using autorefresh */
  1418. frame_cnt = _sde_encoder_phys_cmd_get_autorefresh_property(phys_enc);
  1419. if (frame_cnt) {
  1420. _sde_encoder_phys_cmd_config_autorefresh(phys_enc, frame_cnt);
  1421. atomic_inc(&cmd_enc->autorefresh.kickoff_cnt);
  1422. } else {
  1423. sde_encoder_helper_trigger_start(phys_enc);
  1424. }
  1425. }
  1426. static void sde_encoder_phys_cmd_setup_vsync_source(
  1427. struct sde_encoder_phys *phys_enc,
  1428. u32 vsync_source, bool is_dummy)
  1429. {
  1430. if (!phys_enc || !phys_enc->hw_intf)
  1431. return;
  1432. sde_encoder_helper_vsync_config(phys_enc, vsync_source, is_dummy);
  1433. if (phys_enc->has_intf_te && phys_enc->hw_intf->ops.vsync_sel)
  1434. phys_enc->hw_intf->ops.vsync_sel(phys_enc->hw_intf,
  1435. vsync_source);
  1436. }
  1437. static void sde_encoder_phys_cmd_init_ops(struct sde_encoder_phys_ops *ops)
  1438. {
  1439. ops->prepare_commit = sde_encoder_phys_cmd_prepare_commit;
  1440. ops->is_master = sde_encoder_phys_cmd_is_master;
  1441. ops->mode_set = sde_encoder_phys_cmd_mode_set;
  1442. ops->cont_splash_mode_set = sde_encoder_phys_cmd_cont_splash_mode_set;
  1443. ops->mode_fixup = sde_encoder_phys_cmd_mode_fixup;
  1444. ops->enable = sde_encoder_phys_cmd_enable;
  1445. ops->disable = sde_encoder_phys_cmd_disable;
  1446. ops->destroy = sde_encoder_phys_cmd_destroy;
  1447. ops->get_hw_resources = sde_encoder_phys_cmd_get_hw_resources;
  1448. ops->control_vblank_irq = sde_encoder_phys_cmd_control_vblank_irq;
  1449. ops->wait_for_commit_done = sde_encoder_phys_cmd_wait_for_commit_done;
  1450. ops->prepare_for_kickoff = sde_encoder_phys_cmd_prepare_for_kickoff;
  1451. ops->wait_for_tx_complete = sde_encoder_phys_cmd_wait_for_tx_complete;
  1452. ops->wait_for_vblank = sde_encoder_phys_cmd_wait_for_vblank;
  1453. ops->trigger_flush = sde_encoder_helper_trigger_flush;
  1454. ops->trigger_start = sde_encoder_phys_cmd_trigger_start;
  1455. ops->needs_single_flush = sde_encoder_phys_needs_single_flush;
  1456. ops->hw_reset = sde_encoder_helper_hw_reset;
  1457. ops->irq_control = sde_encoder_phys_cmd_irq_control;
  1458. ops->update_split_role = sde_encoder_phys_cmd_update_split_role;
  1459. ops->restore = sde_encoder_phys_cmd_enable_helper;
  1460. ops->control_te = sde_encoder_phys_cmd_connect_te;
  1461. ops->is_autorefresh_enabled =
  1462. sde_encoder_phys_cmd_is_autorefresh_enabled;
  1463. ops->get_line_count = sde_encoder_phys_cmd_te_get_line_count;
  1464. ops->get_wr_line_count = sde_encoder_phys_cmd_get_write_line_count;
  1465. ops->wait_for_active = NULL;
  1466. ops->setup_vsync_source = sde_encoder_phys_cmd_setup_vsync_source;
  1467. ops->setup_misr = sde_encoder_helper_setup_misr;
  1468. ops->collect_misr = sde_encoder_helper_collect_misr;
  1469. }
  1470. struct sde_encoder_phys *sde_encoder_phys_cmd_init(
  1471. struct sde_enc_phys_init_params *p)
  1472. {
  1473. struct sde_encoder_phys *phys_enc = NULL;
  1474. struct sde_encoder_phys_cmd *cmd_enc = NULL;
  1475. struct sde_hw_mdp *hw_mdp;
  1476. struct sde_encoder_irq *irq;
  1477. int i, ret = 0;
  1478. SDE_DEBUG("intf %d\n", p->intf_idx - INTF_0);
  1479. cmd_enc = kzalloc(sizeof(*cmd_enc), GFP_KERNEL);
  1480. if (!cmd_enc) {
  1481. ret = -ENOMEM;
  1482. SDE_ERROR("failed to allocate\n");
  1483. goto fail;
  1484. }
  1485. phys_enc = &cmd_enc->base;
  1486. hw_mdp = sde_rm_get_mdp(&p->sde_kms->rm);
  1487. if (IS_ERR_OR_NULL(hw_mdp)) {
  1488. ret = PTR_ERR(hw_mdp);
  1489. SDE_ERROR("failed to get mdptop\n");
  1490. goto fail_mdp_init;
  1491. }
  1492. phys_enc->hw_mdptop = hw_mdp;
  1493. phys_enc->intf_idx = p->intf_idx;
  1494. phys_enc->parent = p->parent;
  1495. phys_enc->parent_ops = p->parent_ops;
  1496. phys_enc->sde_kms = p->sde_kms;
  1497. phys_enc->split_role = p->split_role;
  1498. phys_enc->intf_mode = INTF_MODE_CMD;
  1499. phys_enc->enc_spinlock = p->enc_spinlock;
  1500. phys_enc->vblank_ctl_lock = p->vblank_ctl_lock;
  1501. cmd_enc->stream_sel = 0;
  1502. phys_enc->enable_state = SDE_ENC_DISABLED;
  1503. sde_encoder_phys_cmd_init_ops(&phys_enc->ops);
  1504. phys_enc->comp_type = p->comp_type;
  1505. if (sde_hw_intf_te_supported(phys_enc->sde_kms->catalog))
  1506. phys_enc->has_intf_te = true;
  1507. else
  1508. phys_enc->has_intf_te = false;
  1509. for (i = 0; i < INTR_IDX_MAX; i++) {
  1510. irq = &phys_enc->irq[i];
  1511. INIT_LIST_HEAD(&irq->cb.list);
  1512. irq->irq_idx = -EINVAL;
  1513. irq->hw_idx = -EINVAL;
  1514. irq->cb.arg = phys_enc;
  1515. }
  1516. irq = &phys_enc->irq[INTR_IDX_CTL_START];
  1517. irq->name = "ctl_start";
  1518. irq->intr_type = SDE_IRQ_TYPE_CTL_START;
  1519. irq->intr_idx = INTR_IDX_CTL_START;
  1520. irq->cb.func = NULL;
  1521. irq = &phys_enc->irq[INTR_IDX_PINGPONG];
  1522. irq->name = "pp_done";
  1523. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_COMP;
  1524. irq->intr_idx = INTR_IDX_PINGPONG;
  1525. irq->cb.func = sde_encoder_phys_cmd_pp_tx_done_irq;
  1526. irq = &phys_enc->irq[INTR_IDX_RDPTR];
  1527. irq->intr_idx = INTR_IDX_RDPTR;
  1528. irq->name = "te_rd_ptr";
  1529. if (phys_enc->has_intf_te)
  1530. irq->intr_type = SDE_IRQ_TYPE_INTF_TEAR_RD_PTR;
  1531. else
  1532. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_RD_PTR;
  1533. irq->cb.func = sde_encoder_phys_cmd_te_rd_ptr_irq;
  1534. irq = &phys_enc->irq[INTR_IDX_UNDERRUN];
  1535. irq->name = "underrun";
  1536. irq->intr_type = SDE_IRQ_TYPE_INTF_UNDER_RUN;
  1537. irq->intr_idx = INTR_IDX_UNDERRUN;
  1538. irq->cb.func = sde_encoder_phys_cmd_underrun_irq;
  1539. irq = &phys_enc->irq[INTR_IDX_AUTOREFRESH_DONE];
  1540. irq->name = "autorefresh_done";
  1541. if (phys_enc->has_intf_te)
  1542. irq->intr_type = SDE_IRQ_TYPE_INTF_TEAR_AUTO_REF;
  1543. else
  1544. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_AUTO_REF;
  1545. irq->intr_idx = INTR_IDX_AUTOREFRESH_DONE;
  1546. irq->cb.func = sde_encoder_phys_cmd_autorefresh_done_irq;
  1547. irq = &phys_enc->irq[INTR_IDX_WRPTR];
  1548. irq->intr_idx = INTR_IDX_WRPTR;
  1549. irq->name = "wr_ptr";
  1550. if (phys_enc->has_intf_te)
  1551. irq->intr_type = SDE_IRQ_TYPE_INTF_TEAR_WR_PTR;
  1552. else
  1553. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_WR_PTR;
  1554. irq->cb.func = sde_encoder_phys_cmd_wr_ptr_irq;
  1555. atomic_set(&phys_enc->vblank_refcount, 0);
  1556. atomic_set(&phys_enc->pending_kickoff_cnt, 0);
  1557. atomic_set(&phys_enc->pending_retire_fence_cnt, 0);
  1558. atomic_set(&cmd_enc->pending_vblank_cnt, 0);
  1559. init_waitqueue_head(&phys_enc->pending_kickoff_wq);
  1560. init_waitqueue_head(&cmd_enc->pending_vblank_wq);
  1561. atomic_set(&cmd_enc->autorefresh.kickoff_cnt, 0);
  1562. init_waitqueue_head(&cmd_enc->autorefresh.kickoff_wq);
  1563. INIT_LIST_HEAD(&cmd_enc->te_timestamp_list);
  1564. for (i = 0; i < MAX_TE_PROFILE_COUNT; i++)
  1565. list_add(&cmd_enc->te_timestamp[i].list,
  1566. &cmd_enc->te_timestamp_list);
  1567. SDE_DEBUG_CMDENC(cmd_enc, "created\n");
  1568. return phys_enc;
  1569. fail_mdp_init:
  1570. kfree(cmd_enc);
  1571. fail:
  1572. return ERR_PTR(ret);
  1573. }