sde_encoder_phys_cmd.c 52 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891
  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 int _sde_encoder_phys_cmd_wait_for_idle(
  542. struct sde_encoder_phys *phys_enc)
  543. {
  544. struct sde_encoder_phys_cmd *cmd_enc =
  545. to_sde_encoder_phys_cmd(phys_enc);
  546. struct sde_encoder_wait_info wait_info = {0};
  547. bool recovery_events;
  548. int ret;
  549. struct sde_hw_ctl *ctl;
  550. bool wr_ptr_wait_success = true;
  551. unsigned long lock_flags;
  552. if (!phys_enc) {
  553. SDE_ERROR("invalid encoder\n");
  554. return -EINVAL;
  555. }
  556. ctl = phys_enc->hw_ctl;
  557. if (sde_encoder_phys_cmd_is_master(phys_enc))
  558. wr_ptr_wait_success = cmd_enc->wr_ptr_wait_success;
  559. if (wr_ptr_wait_success &&
  560. (phys_enc->frame_trigger_mode == FRAME_DONE_WAIT_POSTED_START) &&
  561. ctl->ops.get_scheduler_status &&
  562. (ctl->ops.get_scheduler_status(ctl) & BIT(0)) &&
  563. atomic_add_unless(&phys_enc->pending_kickoff_cnt, -1, 0) &&
  564. phys_enc->parent_ops.handle_frame_done) {
  565. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  566. phys_enc->parent_ops.handle_frame_done(
  567. phys_enc->parent, phys_enc,
  568. SDE_ENCODER_FRAME_EVENT_DONE |
  569. SDE_ENCODER_FRAME_EVENT_SIGNAL_RELEASE_FENCE);
  570. spin_unlock_irqrestore(phys_enc->enc_spinlock, lock_flags);
  571. return 0;
  572. }
  573. if (atomic_read(&phys_enc->pending_kickoff_cnt) > 1)
  574. wait_info.count_check = 1;
  575. wait_info.wq = &phys_enc->pending_kickoff_wq;
  576. wait_info.atomic_cnt = &phys_enc->pending_kickoff_cnt;
  577. wait_info.timeout_ms = KICKOFF_TIMEOUT_MS;
  578. recovery_events = sde_encoder_recovery_events_enabled(
  579. phys_enc->parent);
  580. /* slave encoder doesn't enable for ppsplit */
  581. if (_sde_encoder_phys_is_ppsplit_slave(phys_enc))
  582. return 0;
  583. ret = sde_encoder_helper_wait_for_irq(phys_enc, INTR_IDX_PINGPONG,
  584. &wait_info);
  585. if (ret == -ETIMEDOUT) {
  586. _sde_encoder_phys_cmd_handle_ppdone_timeout(phys_enc,
  587. recovery_events);
  588. } else if (!ret) {
  589. if (cmd_enc->pp_timeout_report_cnt && recovery_events) {
  590. struct drm_connector *conn = phys_enc->connector;
  591. sde_connector_event_notify(conn,
  592. DRM_EVENT_SDE_HW_RECOVERY,
  593. sizeof(uint8_t),
  594. SDE_RECOVERY_SUCCESS);
  595. }
  596. cmd_enc->pp_timeout_report_cnt = 0;
  597. }
  598. return ret;
  599. }
  600. static int _sde_encoder_phys_cmd_wait_for_autorefresh_done(
  601. struct sde_encoder_phys *phys_enc)
  602. {
  603. struct sde_encoder_phys_cmd *cmd_enc =
  604. to_sde_encoder_phys_cmd(phys_enc);
  605. struct sde_encoder_wait_info wait_info = {0};
  606. int ret = 0;
  607. if (!phys_enc) {
  608. SDE_ERROR("invalid encoder\n");
  609. return -EINVAL;
  610. }
  611. /* only master deals with autorefresh */
  612. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  613. return 0;
  614. wait_info.wq = &cmd_enc->autorefresh.kickoff_wq;
  615. wait_info.atomic_cnt = &cmd_enc->autorefresh.kickoff_cnt;
  616. wait_info.timeout_ms = _sde_encoder_phys_cmd_get_idle_timeout(cmd_enc);
  617. /* wait for autorefresh kickoff to start */
  618. ret = sde_encoder_helper_wait_for_irq(phys_enc,
  619. INTR_IDX_AUTOREFRESH_DONE, &wait_info);
  620. /* double check that kickoff has started by reading write ptr reg */
  621. if (!ret)
  622. ret = _sde_encoder_phys_cmd_poll_write_pointer_started(
  623. phys_enc);
  624. else
  625. sde_encoder_helper_report_irq_timeout(phys_enc,
  626. INTR_IDX_AUTOREFRESH_DONE);
  627. return ret;
  628. }
  629. static int sde_encoder_phys_cmd_control_vblank_irq(
  630. struct sde_encoder_phys *phys_enc,
  631. bool enable)
  632. {
  633. struct sde_encoder_phys_cmd *cmd_enc =
  634. to_sde_encoder_phys_cmd(phys_enc);
  635. int ret = 0;
  636. int refcount;
  637. if (!phys_enc || !phys_enc->hw_pp) {
  638. SDE_ERROR("invalid encoder\n");
  639. return -EINVAL;
  640. }
  641. mutex_lock(phys_enc->vblank_ctl_lock);
  642. refcount = atomic_read(&phys_enc->vblank_refcount);
  643. /* Slave encoders don't report vblank */
  644. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  645. goto end;
  646. /* protect against negative */
  647. if (!enable && refcount == 0) {
  648. ret = -EINVAL;
  649. goto end;
  650. }
  651. SDE_DEBUG_CMDENC(cmd_enc, "[%pS] enable=%d/%d\n",
  652. __builtin_return_address(0), enable, refcount);
  653. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->hw_pp->idx - PINGPONG_0,
  654. enable, refcount);
  655. if (enable && atomic_inc_return(&phys_enc->vblank_refcount) == 1)
  656. ret = sde_encoder_helper_register_irq(phys_enc, INTR_IDX_RDPTR);
  657. else if (!enable && atomic_dec_return(&phys_enc->vblank_refcount) == 0)
  658. ret = sde_encoder_helper_unregister_irq(phys_enc,
  659. INTR_IDX_RDPTR);
  660. end:
  661. if (ret) {
  662. SDE_ERROR_CMDENC(cmd_enc,
  663. "control vblank irq error %d, enable %d, refcount %d\n",
  664. ret, enable, refcount);
  665. SDE_EVT32(DRMID(phys_enc->parent),
  666. phys_enc->hw_pp->idx - PINGPONG_0,
  667. enable, refcount, SDE_EVTLOG_ERROR);
  668. }
  669. mutex_unlock(phys_enc->vblank_ctl_lock);
  670. return ret;
  671. }
  672. void sde_encoder_phys_cmd_irq_control(struct sde_encoder_phys *phys_enc,
  673. bool enable)
  674. {
  675. struct sde_encoder_phys_cmd *cmd_enc;
  676. if (!phys_enc)
  677. return;
  678. /**
  679. * pingpong split slaves do not register for IRQs
  680. * check old and new topologies
  681. */
  682. if (_sde_encoder_phys_is_ppsplit_slave(phys_enc) ||
  683. _sde_encoder_phys_is_disabling_ppsplit_slave(phys_enc))
  684. return;
  685. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  686. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->hw_pp->idx - PINGPONG_0,
  687. enable, atomic_read(&phys_enc->vblank_refcount));
  688. if (enable) {
  689. sde_encoder_helper_register_irq(phys_enc, INTR_IDX_PINGPONG);
  690. sde_encoder_phys_cmd_control_vblank_irq(phys_enc, true);
  691. if (sde_encoder_phys_cmd_is_master(phys_enc)) {
  692. sde_encoder_helper_register_irq(phys_enc,
  693. INTR_IDX_WRPTR);
  694. sde_encoder_helper_register_irq(phys_enc,
  695. INTR_IDX_AUTOREFRESH_DONE);
  696. }
  697. } else {
  698. if (sde_encoder_phys_cmd_is_master(phys_enc)) {
  699. sde_encoder_helper_unregister_irq(phys_enc,
  700. INTR_IDX_WRPTR);
  701. sde_encoder_helper_unregister_irq(phys_enc,
  702. INTR_IDX_AUTOREFRESH_DONE);
  703. }
  704. sde_encoder_phys_cmd_control_vblank_irq(phys_enc, false);
  705. sde_encoder_helper_unregister_irq(phys_enc, INTR_IDX_PINGPONG);
  706. }
  707. }
  708. static int _get_tearcheck_threshold(struct sde_encoder_phys *phys_enc,
  709. u32 *extra_frame_trigger_time)
  710. {
  711. struct drm_connector *conn = phys_enc->connector;
  712. u32 qsync_mode;
  713. struct drm_display_mode *mode;
  714. u32 threshold_lines = 0;
  715. struct sde_encoder_phys_cmd *cmd_enc =
  716. to_sde_encoder_phys_cmd(phys_enc);
  717. *extra_frame_trigger_time = 0;
  718. if (!conn || !conn->state)
  719. return 0;
  720. mode = &phys_enc->cached_mode;
  721. qsync_mode = sde_connector_get_qsync_mode(conn);
  722. if (mode && (qsync_mode == SDE_RM_QSYNC_CONTINUOUS_MODE)) {
  723. u32 qsync_min_fps = 0;
  724. u32 default_fps = mode->vrefresh;
  725. u32 yres = mode->vtotal;
  726. u32 slow_time_ns;
  727. u32 default_time_ns;
  728. u32 extra_time_ns;
  729. u32 total_extra_lines;
  730. u32 default_line_time_ns;
  731. if (phys_enc->parent_ops.get_qsync_fps)
  732. phys_enc->parent_ops.get_qsync_fps(
  733. phys_enc->parent, &qsync_min_fps);
  734. if (!qsync_min_fps || !default_fps || !yres) {
  735. SDE_ERROR_CMDENC(cmd_enc,
  736. "wrong qsync params %d %d %d\n",
  737. qsync_min_fps, default_fps, yres);
  738. goto exit;
  739. }
  740. if (qsync_min_fps >= default_fps) {
  741. SDE_ERROR_CMDENC(cmd_enc,
  742. "qsync fps:%d must be less than default:%d\n",
  743. qsync_min_fps, default_fps);
  744. goto exit;
  745. }
  746. /* Calculate the number of extra lines*/
  747. slow_time_ns = (1 * 1000000000) / qsync_min_fps;
  748. default_time_ns = (1 * 1000000000) / default_fps;
  749. extra_time_ns = slow_time_ns - default_time_ns;
  750. default_line_time_ns = (1 * 1000000000) / (default_fps * yres);
  751. total_extra_lines = extra_time_ns / default_line_time_ns;
  752. threshold_lines += total_extra_lines;
  753. SDE_DEBUG_CMDENC(cmd_enc, "slow:%d default:%d extra:%d(ns)\n",
  754. slow_time_ns, default_time_ns, extra_time_ns);
  755. SDE_DEBUG_CMDENC(cmd_enc, "extra_lines:%d threshold:%d\n",
  756. total_extra_lines, threshold_lines);
  757. SDE_DEBUG_CMDENC(cmd_enc, "min_fps:%d fps:%d yres:%d\n",
  758. qsync_min_fps, default_fps, yres);
  759. SDE_EVT32(qsync_mode, qsync_min_fps, extra_time_ns, default_fps,
  760. yres, threshold_lines);
  761. *extra_frame_trigger_time = extra_time_ns;
  762. }
  763. exit:
  764. threshold_lines += DEFAULT_TEARCHECK_SYNC_THRESH_START;
  765. return threshold_lines;
  766. }
  767. static void sde_encoder_phys_cmd_tearcheck_config(
  768. struct sde_encoder_phys *phys_enc)
  769. {
  770. struct sde_encoder_phys_cmd *cmd_enc =
  771. to_sde_encoder_phys_cmd(phys_enc);
  772. struct sde_hw_tear_check tc_cfg = { 0 };
  773. struct drm_display_mode *mode;
  774. bool tc_enable = true;
  775. u32 vsync_hz, extra_frame_trigger_time;
  776. struct msm_drm_private *priv;
  777. struct sde_kms *sde_kms;
  778. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf) {
  779. SDE_ERROR("invalid encoder\n");
  780. return;
  781. }
  782. mode = &phys_enc->cached_mode;
  783. SDE_DEBUG_CMDENC(cmd_enc, "pp %d, intf %d\n",
  784. phys_enc->hw_pp->idx - PINGPONG_0,
  785. phys_enc->hw_intf->idx - INTF_0);
  786. if (phys_enc->has_intf_te) {
  787. if (!phys_enc->hw_intf->ops.setup_tearcheck ||
  788. !phys_enc->hw_intf->ops.enable_tearcheck) {
  789. SDE_DEBUG_CMDENC(cmd_enc, "tearcheck not supported\n");
  790. return;
  791. }
  792. } else {
  793. if (!phys_enc->hw_pp->ops.setup_tearcheck ||
  794. !phys_enc->hw_pp->ops.enable_tearcheck) {
  795. SDE_DEBUG_CMDENC(cmd_enc, "tearcheck not supported\n");
  796. return;
  797. }
  798. }
  799. sde_kms = phys_enc->sde_kms;
  800. if (!sde_kms || !sde_kms->dev || !sde_kms->dev->dev_private) {
  801. SDE_ERROR("invalid device\n");
  802. return;
  803. }
  804. priv = sde_kms->dev->dev_private;
  805. /*
  806. * TE default: dsi byte clock calculated base on 70 fps;
  807. * around 14 ms to complete a kickoff cycle if te disabled;
  808. * vclk_line base on 60 fps; write is faster than read;
  809. * init == start == rdptr;
  810. *
  811. * vsync_count is ratio of MDP VSYNC clock frequency to LCD panel
  812. * frequency divided by the no. of rows (lines) in the LCDpanel.
  813. */
  814. vsync_hz = sde_power_clk_get_rate(&priv->phandle, "vsync_clk");
  815. if (!vsync_hz || !mode->vtotal || !mode->vrefresh) {
  816. SDE_DEBUG_CMDENC(cmd_enc,
  817. "invalid params - vsync_hz %u vtot %u vrefresh %u\n",
  818. vsync_hz, mode->vtotal, mode->vrefresh);
  819. return;
  820. }
  821. tc_cfg.vsync_count = vsync_hz / (mode->vtotal * mode->vrefresh);
  822. /* enable external TE after kickoff to avoid premature autorefresh */
  823. tc_cfg.hw_vsync_mode = 0;
  824. /*
  825. * By setting sync_cfg_height to near max register value, we essentially
  826. * disable sde hw generated TE signal, since hw TE will arrive first.
  827. * Only caveat is if due to error, we hit wrap-around.
  828. */
  829. tc_cfg.sync_cfg_height = 0xFFF0;
  830. tc_cfg.vsync_init_val = mode->vdisplay;
  831. tc_cfg.sync_threshold_start = _get_tearcheck_threshold(phys_enc,
  832. &extra_frame_trigger_time);
  833. tc_cfg.sync_threshold_continue = DEFAULT_TEARCHECK_SYNC_THRESH_CONTINUE;
  834. tc_cfg.start_pos = mode->vdisplay;
  835. tc_cfg.rd_ptr_irq = mode->vdisplay + 1;
  836. tc_cfg.wr_ptr_irq = 1;
  837. SDE_DEBUG_CMDENC(cmd_enc,
  838. "tc %d intf %d vsync_clk_speed_hz %u vtotal %u vrefresh %u\n",
  839. phys_enc->hw_pp->idx - PINGPONG_0,
  840. phys_enc->hw_intf->idx - INTF_0,
  841. vsync_hz, mode->vtotal, mode->vrefresh);
  842. SDE_DEBUG_CMDENC(cmd_enc,
  843. "tc %d intf %d enable %u start_pos %u rd_ptr_irq %u wr_ptr_irq %u\n",
  844. phys_enc->hw_pp->idx - PINGPONG_0,
  845. phys_enc->hw_intf->idx - INTF_0,
  846. tc_enable, tc_cfg.start_pos, tc_cfg.rd_ptr_irq,
  847. tc_cfg.wr_ptr_irq);
  848. SDE_DEBUG_CMDENC(cmd_enc,
  849. "tc %d intf %d hw_vsync_mode %u vsync_count %u vsync_init_val %u\n",
  850. phys_enc->hw_pp->idx - PINGPONG_0,
  851. phys_enc->hw_intf->idx - INTF_0,
  852. tc_cfg.hw_vsync_mode, tc_cfg.vsync_count,
  853. tc_cfg.vsync_init_val);
  854. SDE_DEBUG_CMDENC(cmd_enc,
  855. "tc %d intf %d cfgheight %u thresh_start %u thresh_cont %u\n",
  856. phys_enc->hw_pp->idx - PINGPONG_0,
  857. phys_enc->hw_intf->idx - INTF_0,
  858. tc_cfg.sync_cfg_height,
  859. tc_cfg.sync_threshold_start, tc_cfg.sync_threshold_continue);
  860. if (phys_enc->has_intf_te) {
  861. phys_enc->hw_intf->ops.setup_tearcheck(phys_enc->hw_intf,
  862. &tc_cfg);
  863. phys_enc->hw_intf->ops.enable_tearcheck(phys_enc->hw_intf,
  864. tc_enable);
  865. } else {
  866. phys_enc->hw_pp->ops.setup_tearcheck(phys_enc->hw_pp, &tc_cfg);
  867. phys_enc->hw_pp->ops.enable_tearcheck(phys_enc->hw_pp,
  868. tc_enable);
  869. }
  870. }
  871. static void _sde_encoder_phys_cmd_pingpong_config(
  872. struct sde_encoder_phys *phys_enc)
  873. {
  874. struct sde_encoder_phys_cmd *cmd_enc =
  875. to_sde_encoder_phys_cmd(phys_enc);
  876. if (!phys_enc || !phys_enc->hw_ctl || !phys_enc->hw_pp) {
  877. SDE_ERROR("invalid arg(s), enc %d\n", !phys_enc);
  878. return;
  879. }
  880. SDE_DEBUG_CMDENC(cmd_enc, "pp %d, enabling mode:\n",
  881. phys_enc->hw_pp->idx - PINGPONG_0);
  882. drm_mode_debug_printmodeline(&phys_enc->cached_mode);
  883. if (!_sde_encoder_phys_is_ppsplit_slave(phys_enc))
  884. _sde_encoder_phys_cmd_update_intf_cfg(phys_enc);
  885. sde_encoder_phys_cmd_tearcheck_config(phys_enc);
  886. }
  887. static void sde_encoder_phys_cmd_enable_helper(
  888. struct sde_encoder_phys *phys_enc)
  889. {
  890. if (!phys_enc || !phys_enc->hw_ctl || !phys_enc->hw_pp) {
  891. SDE_ERROR("invalid arg(s), encoder %d\n", !phys_enc);
  892. return;
  893. }
  894. sde_encoder_helper_split_config(phys_enc, phys_enc->intf_idx);
  895. _sde_encoder_phys_cmd_pingpong_config(phys_enc);
  896. /*
  897. * For pp-split, skip setting the flush bit for the slave intf, since
  898. * both intfs use same ctl and HW will only flush the master.
  899. */
  900. if (_sde_encoder_phys_is_ppsplit(phys_enc) &&
  901. !sde_encoder_phys_cmd_is_master(phys_enc))
  902. goto skip_flush;
  903. _sde_encoder_phys_cmd_update_flush_mask(phys_enc);
  904. skip_flush:
  905. return;
  906. }
  907. static void sde_encoder_phys_cmd_enable(struct sde_encoder_phys *phys_enc)
  908. {
  909. struct sde_encoder_phys_cmd *cmd_enc =
  910. to_sde_encoder_phys_cmd(phys_enc);
  911. if (!phys_enc || !phys_enc->hw_pp) {
  912. SDE_ERROR("invalid phys encoder\n");
  913. return;
  914. }
  915. SDE_DEBUG_CMDENC(cmd_enc, "pp %d\n", phys_enc->hw_pp->idx - PINGPONG_0);
  916. if (phys_enc->enable_state == SDE_ENC_ENABLED) {
  917. if (!phys_enc->cont_splash_enabled)
  918. SDE_ERROR("already enabled\n");
  919. return;
  920. }
  921. sde_encoder_phys_cmd_enable_helper(phys_enc);
  922. phys_enc->enable_state = SDE_ENC_ENABLED;
  923. }
  924. static bool sde_encoder_phys_cmd_is_autorefresh_enabled(
  925. struct sde_encoder_phys *phys_enc)
  926. {
  927. struct sde_hw_pingpong *hw_pp;
  928. struct sde_hw_intf *hw_intf;
  929. struct sde_hw_autorefresh cfg;
  930. int ret;
  931. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  932. return false;
  933. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  934. return false;
  935. if (phys_enc->has_intf_te) {
  936. hw_intf = phys_enc->hw_intf;
  937. if (!hw_intf->ops.get_autorefresh)
  938. return false;
  939. ret = hw_intf->ops.get_autorefresh(hw_intf, &cfg);
  940. } else {
  941. hw_pp = phys_enc->hw_pp;
  942. if (!hw_pp->ops.get_autorefresh)
  943. return false;
  944. ret = hw_pp->ops.get_autorefresh(hw_pp, &cfg);
  945. }
  946. if (ret)
  947. return false;
  948. return cfg.enable;
  949. }
  950. static void sde_encoder_phys_cmd_connect_te(
  951. struct sde_encoder_phys *phys_enc, bool enable)
  952. {
  953. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  954. return;
  955. if (phys_enc->has_intf_te &&
  956. phys_enc->hw_intf->ops.connect_external_te)
  957. phys_enc->hw_intf->ops.connect_external_te(phys_enc->hw_intf,
  958. enable);
  959. else if (phys_enc->hw_pp->ops.connect_external_te)
  960. phys_enc->hw_pp->ops.connect_external_te(phys_enc->hw_pp,
  961. enable);
  962. else
  963. return;
  964. SDE_EVT32(DRMID(phys_enc->parent), enable);
  965. }
  966. static int sde_encoder_phys_cmd_te_get_line_count(
  967. struct sde_encoder_phys *phys_enc)
  968. {
  969. struct sde_hw_pingpong *hw_pp;
  970. struct sde_hw_intf *hw_intf;
  971. u32 line_count;
  972. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  973. return -EINVAL;
  974. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  975. return -EINVAL;
  976. if (phys_enc->has_intf_te) {
  977. hw_intf = phys_enc->hw_intf;
  978. if (!hw_intf->ops.get_line_count)
  979. return -EINVAL;
  980. line_count = hw_intf->ops.get_line_count(hw_intf);
  981. } else {
  982. hw_pp = phys_enc->hw_pp;
  983. if (!hw_pp->ops.get_line_count)
  984. return -EINVAL;
  985. line_count = hw_pp->ops.get_line_count(hw_pp);
  986. }
  987. return line_count;
  988. }
  989. static int sde_encoder_phys_cmd_get_write_line_count(
  990. struct sde_encoder_phys *phys_enc)
  991. {
  992. struct sde_hw_pingpong *hw_pp;
  993. struct sde_hw_intf *hw_intf;
  994. struct sde_hw_pp_vsync_info info;
  995. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  996. return -EINVAL;
  997. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  998. return -EINVAL;
  999. if (phys_enc->has_intf_te) {
  1000. hw_intf = phys_enc->hw_intf;
  1001. if (!hw_intf->ops.get_vsync_info)
  1002. return -EINVAL;
  1003. if (hw_intf->ops.get_vsync_info(hw_intf, &info))
  1004. return -EINVAL;
  1005. } else {
  1006. hw_pp = phys_enc->hw_pp;
  1007. if (!hw_pp->ops.get_vsync_info)
  1008. return -EINVAL;
  1009. if (hw_pp->ops.get_vsync_info(hw_pp, &info))
  1010. return -EINVAL;
  1011. }
  1012. return (int)info.wr_ptr_line_count;
  1013. }
  1014. static void sde_encoder_phys_cmd_disable(struct sde_encoder_phys *phys_enc)
  1015. {
  1016. struct sde_encoder_phys_cmd *cmd_enc =
  1017. to_sde_encoder_phys_cmd(phys_enc);
  1018. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf) {
  1019. SDE_ERROR("invalid encoder\n");
  1020. return;
  1021. }
  1022. SDE_DEBUG_CMDENC(cmd_enc, "pp %d intf %d state %d\n",
  1023. phys_enc->hw_pp->idx - PINGPONG_0,
  1024. phys_enc->hw_intf->idx - INTF_0,
  1025. phys_enc->enable_state);
  1026. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->hw_pp->idx - PINGPONG_0,
  1027. phys_enc->hw_intf->idx - INTF_0,
  1028. phys_enc->enable_state);
  1029. if (phys_enc->enable_state == SDE_ENC_DISABLED) {
  1030. SDE_ERROR_CMDENC(cmd_enc, "already disabled\n");
  1031. return;
  1032. }
  1033. if (phys_enc->has_intf_te && phys_enc->hw_intf->ops.enable_tearcheck)
  1034. phys_enc->hw_intf->ops.enable_tearcheck(
  1035. phys_enc->hw_intf,
  1036. false);
  1037. else if (phys_enc->hw_pp->ops.enable_tearcheck)
  1038. phys_enc->hw_pp->ops.enable_tearcheck(phys_enc->hw_pp,
  1039. false);
  1040. phys_enc->enable_state = SDE_ENC_DISABLED;
  1041. }
  1042. static void sde_encoder_phys_cmd_destroy(struct sde_encoder_phys *phys_enc)
  1043. {
  1044. struct sde_encoder_phys_cmd *cmd_enc =
  1045. to_sde_encoder_phys_cmd(phys_enc);
  1046. if (!phys_enc) {
  1047. SDE_ERROR("invalid encoder\n");
  1048. return;
  1049. }
  1050. kfree(cmd_enc);
  1051. }
  1052. static void sde_encoder_phys_cmd_get_hw_resources(
  1053. struct sde_encoder_phys *phys_enc,
  1054. struct sde_encoder_hw_resources *hw_res,
  1055. struct drm_connector_state *conn_state)
  1056. {
  1057. struct sde_encoder_phys_cmd *cmd_enc =
  1058. to_sde_encoder_phys_cmd(phys_enc);
  1059. if (!phys_enc) {
  1060. SDE_ERROR("invalid encoder\n");
  1061. return;
  1062. }
  1063. if ((phys_enc->intf_idx - INTF_0) >= INTF_MAX) {
  1064. SDE_ERROR("invalid intf idx:%d\n", phys_enc->intf_idx);
  1065. return;
  1066. }
  1067. SDE_DEBUG_CMDENC(cmd_enc, "\n");
  1068. hw_res->intfs[phys_enc->intf_idx - INTF_0] = INTF_MODE_CMD;
  1069. }
  1070. static int sde_encoder_phys_cmd_prepare_for_kickoff(
  1071. struct sde_encoder_phys *phys_enc,
  1072. struct sde_encoder_kickoff_params *params)
  1073. {
  1074. struct sde_hw_tear_check tc_cfg = {0};
  1075. struct sde_encoder_phys_cmd *cmd_enc =
  1076. to_sde_encoder_phys_cmd(phys_enc);
  1077. int ret = 0;
  1078. u32 extra_frame_trigger_time;
  1079. if (!phys_enc || !phys_enc->hw_pp) {
  1080. SDE_ERROR("invalid encoder\n");
  1081. return -EINVAL;
  1082. }
  1083. SDE_DEBUG_CMDENC(cmd_enc, "pp %d\n", phys_enc->hw_pp->idx - PINGPONG_0);
  1084. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->hw_pp->idx - PINGPONG_0,
  1085. atomic_read(&phys_enc->pending_kickoff_cnt),
  1086. atomic_read(&cmd_enc->autorefresh.kickoff_cnt));
  1087. phys_enc->frame_trigger_mode = params->frame_trigger_mode;
  1088. if (phys_enc->frame_trigger_mode == FRAME_DONE_WAIT_DEFAULT) {
  1089. /*
  1090. * Mark kickoff request as outstanding. If there are more
  1091. * than one outstanding frame, then we have to wait for the
  1092. * previous frame to complete
  1093. */
  1094. ret = _sde_encoder_phys_cmd_wait_for_idle(phys_enc);
  1095. if (ret) {
  1096. atomic_set(&phys_enc->pending_kickoff_cnt, 0);
  1097. SDE_EVT32(DRMID(phys_enc->parent),
  1098. phys_enc->hw_pp->idx - PINGPONG_0);
  1099. SDE_ERROR("failed wait_for_idle: %d\n", ret);
  1100. }
  1101. }
  1102. if (sde_connector_is_qsync_updated(phys_enc->connector)) {
  1103. tc_cfg.sync_threshold_start =
  1104. _get_tearcheck_threshold(phys_enc,
  1105. &extra_frame_trigger_time);
  1106. if (phys_enc->has_intf_te &&
  1107. phys_enc->hw_intf->ops.update_tearcheck)
  1108. phys_enc->hw_intf->ops.update_tearcheck(
  1109. phys_enc->hw_intf, &tc_cfg);
  1110. else if (phys_enc->hw_pp->ops.update_tearcheck)
  1111. phys_enc->hw_pp->ops.update_tearcheck(
  1112. phys_enc->hw_pp, &tc_cfg);
  1113. SDE_EVT32(DRMID(phys_enc->parent), tc_cfg.sync_threshold_start);
  1114. }
  1115. SDE_DEBUG_CMDENC(cmd_enc, "pp:%d pending_cnt %d\n",
  1116. phys_enc->hw_pp->idx - PINGPONG_0,
  1117. atomic_read(&phys_enc->pending_kickoff_cnt));
  1118. return ret;
  1119. }
  1120. static bool _sde_encoder_phys_cmd_needs_vsync_change(
  1121. struct sde_encoder_phys *phys_enc, ktime_t profile_timestamp)
  1122. {
  1123. struct sde_encoder_phys_cmd *cmd_enc;
  1124. struct sde_encoder_phys_cmd_te_timestamp *cur;
  1125. struct sde_encoder_phys_cmd_te_timestamp *prev = NULL;
  1126. ktime_t time_diff;
  1127. u64 l_bound = 0, u_bound = 0;
  1128. bool ret = false;
  1129. unsigned long lock_flags;
  1130. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1131. sde_encoder_helper_get_jitter_bounds_ns(phys_enc->parent,
  1132. &l_bound, &u_bound);
  1133. if (!l_bound || !u_bound) {
  1134. SDE_ERROR_CMDENC(cmd_enc, "invalid vsync jitter bounds\n");
  1135. return false;
  1136. }
  1137. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  1138. list_for_each_entry_reverse(cur, &cmd_enc->te_timestamp_list, list) {
  1139. if (prev && ktime_after(cur->timestamp, profile_timestamp)) {
  1140. time_diff = ktime_sub(prev->timestamp, cur->timestamp);
  1141. if ((time_diff < l_bound) || (time_diff > u_bound)) {
  1142. ret = true;
  1143. break;
  1144. }
  1145. }
  1146. prev = cur;
  1147. }
  1148. spin_unlock_irqrestore(phys_enc->enc_spinlock, lock_flags);
  1149. if (ret) {
  1150. SDE_DEBUG_CMDENC(cmd_enc,
  1151. "time_diff:%llu, prev:%llu, cur:%llu, jitter:%llu/%llu\n",
  1152. time_diff, prev->timestamp, cur->timestamp,
  1153. l_bound, u_bound);
  1154. SDE_EVT32(DRMID(phys_enc->parent),
  1155. (u32) (l_bound / 1000), (u32) (u_bound / 1000),
  1156. (u32) (time_diff / 1000), SDE_EVTLOG_ERROR);
  1157. }
  1158. return ret;
  1159. }
  1160. static int _sde_encoder_phys_cmd_wait_for_wr_ptr(
  1161. struct sde_encoder_phys *phys_enc)
  1162. {
  1163. struct sde_encoder_phys_cmd *cmd_enc =
  1164. to_sde_encoder_phys_cmd(phys_enc);
  1165. struct sde_encoder_wait_info wait_info = {0};
  1166. int ret;
  1167. bool frame_pending = true;
  1168. struct sde_hw_ctl *ctl;
  1169. if (!phys_enc || !phys_enc->hw_ctl) {
  1170. SDE_ERROR("invalid argument(s)\n");
  1171. return -EINVAL;
  1172. }
  1173. ctl = phys_enc->hw_ctl;
  1174. wait_info.wq = &phys_enc->pending_kickoff_wq;
  1175. wait_info.atomic_cnt = &phys_enc->pending_retire_fence_cnt;
  1176. wait_info.timeout_ms = KICKOFF_TIMEOUT_MS;
  1177. /* slave encoder doesn't enable for ppsplit */
  1178. if (_sde_encoder_phys_is_ppsplit_slave(phys_enc))
  1179. return 0;
  1180. ret = sde_encoder_helper_wait_for_irq(phys_enc, INTR_IDX_WRPTR,
  1181. &wait_info);
  1182. if (ret == -ETIMEDOUT) {
  1183. struct sde_hw_ctl *ctl = phys_enc->hw_ctl;
  1184. if (ctl && ctl->ops.get_start_state)
  1185. frame_pending = ctl->ops.get_start_state(ctl);
  1186. ret = frame_pending ? ret : 0;
  1187. }
  1188. cmd_enc->wr_ptr_wait_success = (ret == 0) ? true : false;
  1189. return ret;
  1190. }
  1191. static int sde_encoder_phys_cmd_wait_for_tx_complete(
  1192. struct sde_encoder_phys *phys_enc)
  1193. {
  1194. int rc;
  1195. struct sde_encoder_phys_cmd *cmd_enc;
  1196. if (!phys_enc)
  1197. return -EINVAL;
  1198. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1199. if (!atomic_read(&phys_enc->pending_kickoff_cnt)) {
  1200. SDE_EVT32(DRMID(phys_enc->parent),
  1201. phys_enc->intf_idx - INTF_0,
  1202. phys_enc->enable_state);
  1203. return 0;
  1204. }
  1205. rc = _sde_encoder_phys_cmd_wait_for_idle(phys_enc);
  1206. if (rc) {
  1207. SDE_EVT32(DRMID(phys_enc->parent),
  1208. phys_enc->intf_idx - INTF_0);
  1209. SDE_ERROR("failed wait_for_idle: %d\n", rc);
  1210. }
  1211. return rc;
  1212. }
  1213. static int _sde_encoder_phys_cmd_handle_wr_ptr_timeout(
  1214. struct sde_encoder_phys *phys_enc,
  1215. ktime_t profile_timestamp)
  1216. {
  1217. struct sde_encoder_phys_cmd *cmd_enc =
  1218. to_sde_encoder_phys_cmd(phys_enc);
  1219. bool switch_te;
  1220. int ret = -ETIMEDOUT;
  1221. unsigned long lock_flags;
  1222. switch_te = _sde_encoder_phys_cmd_needs_vsync_change(
  1223. phys_enc, profile_timestamp);
  1224. SDE_EVT32(DRMID(phys_enc->parent), switch_te, SDE_EVTLOG_FUNC_ENTRY);
  1225. if (switch_te) {
  1226. SDE_DEBUG_CMDENC(cmd_enc,
  1227. "wr_ptr_irq wait failed, retry with WD TE\n");
  1228. /* switch to watchdog TE and wait again */
  1229. sde_encoder_helper_switch_vsync(phys_enc->parent, true);
  1230. ret = _sde_encoder_phys_cmd_wait_for_wr_ptr(phys_enc);
  1231. /* switch back to default TE */
  1232. sde_encoder_helper_switch_vsync(phys_enc->parent, false);
  1233. }
  1234. /*
  1235. * Signaling the retire fence at wr_ptr timeout
  1236. * to allow the next commit and avoid device freeze.
  1237. */
  1238. if (ret == -ETIMEDOUT) {
  1239. SDE_ERROR_CMDENC(cmd_enc,
  1240. "wr_ptr_irq wait failed, switch_te:%d\n", switch_te);
  1241. SDE_EVT32(DRMID(phys_enc->parent), switch_te, SDE_EVTLOG_ERROR);
  1242. if (sde_encoder_phys_cmd_is_master(phys_enc) &&
  1243. atomic_add_unless(
  1244. &phys_enc->pending_retire_fence_cnt, -1, 0)) {
  1245. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  1246. phys_enc->parent_ops.handle_frame_done(
  1247. phys_enc->parent, phys_enc,
  1248. SDE_ENCODER_FRAME_EVENT_SIGNAL_RETIRE_FENCE);
  1249. spin_unlock_irqrestore(phys_enc->enc_spinlock,
  1250. lock_flags);
  1251. }
  1252. }
  1253. cmd_enc->wr_ptr_wait_success = (ret == 0) ? true : false;
  1254. return ret;
  1255. }
  1256. static int sde_encoder_phys_cmd_wait_for_commit_done(
  1257. struct sde_encoder_phys *phys_enc)
  1258. {
  1259. int rc = 0, i, pending_cnt;
  1260. struct sde_encoder_phys_cmd *cmd_enc;
  1261. ktime_t profile_timestamp = ktime_get();
  1262. if (!phys_enc)
  1263. return -EINVAL;
  1264. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1265. /* only required for master controller */
  1266. if (sde_encoder_phys_cmd_is_master(phys_enc)) {
  1267. rc = _sde_encoder_phys_cmd_wait_for_wr_ptr(phys_enc);
  1268. if (rc == -ETIMEDOUT) {
  1269. /*
  1270. * Profile all the TE received after profile_timestamp
  1271. * and if the jitter is more, switch to watchdog TE
  1272. * and wait for wr_ptr again. Finally move back to
  1273. * default TE.
  1274. */
  1275. rc = _sde_encoder_phys_cmd_handle_wr_ptr_timeout(
  1276. phys_enc, profile_timestamp);
  1277. if (rc == -ETIMEDOUT)
  1278. goto wait_for_idle;
  1279. }
  1280. if (cmd_enc->autorefresh.cfg.enable)
  1281. rc = _sde_encoder_phys_cmd_wait_for_autorefresh_done(
  1282. phys_enc);
  1283. }
  1284. /* wait for posted start or serialize trigger */
  1285. if ((atomic_read(&phys_enc->pending_kickoff_cnt) > 1) ||
  1286. (!rc && phys_enc->frame_trigger_mode == FRAME_DONE_WAIT_SERIALIZE))
  1287. goto wait_for_idle;
  1288. return rc;
  1289. wait_for_idle:
  1290. pending_cnt = atomic_read(&phys_enc->pending_kickoff_cnt);
  1291. for (i = 0; i < pending_cnt; i++)
  1292. rc |= sde_encoder_wait_for_event(phys_enc->parent,
  1293. MSM_ENC_TX_COMPLETE);
  1294. if (rc) {
  1295. SDE_EVT32(DRMID(phys_enc->parent),
  1296. phys_enc->hw_pp->idx - PINGPONG_0,
  1297. phys_enc->frame_trigger_mode,
  1298. atomic_read(&phys_enc->pending_kickoff_cnt),
  1299. phys_enc->enable_state, rc);
  1300. SDE_ERROR("pp:%d failed wait_for_idle: %d\n",
  1301. phys_enc->hw_pp->idx - PINGPONG_0, rc);
  1302. if (phys_enc->enable_state == SDE_ENC_ERR_NEEDS_HW_RESET)
  1303. sde_encoder_helper_needs_hw_reset(phys_enc->parent);
  1304. }
  1305. return rc;
  1306. }
  1307. static int sde_encoder_phys_cmd_wait_for_vblank(
  1308. struct sde_encoder_phys *phys_enc)
  1309. {
  1310. int rc = 0;
  1311. struct sde_encoder_phys_cmd *cmd_enc;
  1312. struct sde_encoder_wait_info wait_info = {0};
  1313. if (!phys_enc)
  1314. return -EINVAL;
  1315. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1316. /* only required for master controller */
  1317. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  1318. return rc;
  1319. wait_info.wq = &cmd_enc->pending_vblank_wq;
  1320. wait_info.atomic_cnt = &cmd_enc->pending_vblank_cnt;
  1321. wait_info.timeout_ms = _sde_encoder_phys_cmd_get_idle_timeout(cmd_enc);
  1322. atomic_inc(&cmd_enc->pending_vblank_cnt);
  1323. rc = sde_encoder_helper_wait_for_irq(phys_enc, INTR_IDX_RDPTR,
  1324. &wait_info);
  1325. return rc;
  1326. }
  1327. static void sde_encoder_phys_cmd_update_split_role(
  1328. struct sde_encoder_phys *phys_enc,
  1329. enum sde_enc_split_role role)
  1330. {
  1331. struct sde_encoder_phys_cmd *cmd_enc;
  1332. enum sde_enc_split_role old_role;
  1333. bool is_ppsplit;
  1334. if (!phys_enc)
  1335. return;
  1336. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1337. old_role = phys_enc->split_role;
  1338. is_ppsplit = _sde_encoder_phys_is_ppsplit(phys_enc);
  1339. phys_enc->split_role = role;
  1340. SDE_DEBUG_CMDENC(cmd_enc, "old role %d new role %d\n",
  1341. old_role, role);
  1342. /*
  1343. * ppsplit solo needs to reprogram because intf may have swapped without
  1344. * role changing on left-only, right-only back-to-back commits
  1345. */
  1346. if (!(is_ppsplit && role == ENC_ROLE_SOLO) &&
  1347. (role == old_role || role == ENC_ROLE_SKIP))
  1348. return;
  1349. sde_encoder_helper_split_config(phys_enc, phys_enc->intf_idx);
  1350. _sde_encoder_phys_cmd_pingpong_config(phys_enc);
  1351. _sde_encoder_phys_cmd_update_flush_mask(phys_enc);
  1352. }
  1353. static void sde_encoder_phys_cmd_prepare_commit(
  1354. struct sde_encoder_phys *phys_enc)
  1355. {
  1356. struct sde_encoder_phys_cmd *cmd_enc =
  1357. to_sde_encoder_phys_cmd(phys_enc);
  1358. int trial = 0;
  1359. if (!phys_enc)
  1360. return;
  1361. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  1362. return;
  1363. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->intf_idx - INTF_0,
  1364. cmd_enc->autorefresh.cfg.enable);
  1365. if (!sde_encoder_phys_cmd_is_autorefresh_enabled(phys_enc))
  1366. return;
  1367. /*
  1368. * If autorefresh is enabled, disable it and make sure it is safe to
  1369. * proceed with current frame commit/push. Sequence fallowed is,
  1370. * 1. Disable TE
  1371. * 2. Disable autorefresh config
  1372. * 4. Poll for frame transfer ongoing to be false
  1373. * 5. Enable TE back
  1374. */
  1375. sde_encoder_phys_cmd_connect_te(phys_enc, false);
  1376. _sde_encoder_phys_cmd_config_autorefresh(phys_enc, 0);
  1377. do {
  1378. udelay(SDE_ENC_MAX_POLL_TIMEOUT_US);
  1379. if ((trial * SDE_ENC_MAX_POLL_TIMEOUT_US)
  1380. > (KICKOFF_TIMEOUT_MS * USEC_PER_MSEC)) {
  1381. SDE_ERROR_CMDENC(cmd_enc,
  1382. "disable autorefresh failed\n");
  1383. break;
  1384. }
  1385. trial++;
  1386. } while (_sde_encoder_phys_cmd_is_ongoing_pptx(phys_enc));
  1387. sde_encoder_phys_cmd_connect_te(phys_enc, true);
  1388. SDE_DEBUG_CMDENC(cmd_enc, "disabled autorefresh\n");
  1389. }
  1390. static void sde_encoder_phys_cmd_trigger_start(
  1391. struct sde_encoder_phys *phys_enc)
  1392. {
  1393. struct sde_encoder_phys_cmd *cmd_enc =
  1394. to_sde_encoder_phys_cmd(phys_enc);
  1395. u32 frame_cnt;
  1396. if (!phys_enc)
  1397. return;
  1398. /* we don't issue CTL_START when using autorefresh */
  1399. frame_cnt = _sde_encoder_phys_cmd_get_autorefresh_property(phys_enc);
  1400. if (frame_cnt) {
  1401. _sde_encoder_phys_cmd_config_autorefresh(phys_enc, frame_cnt);
  1402. atomic_inc(&cmd_enc->autorefresh.kickoff_cnt);
  1403. } else {
  1404. sde_encoder_helper_trigger_start(phys_enc);
  1405. }
  1406. }
  1407. static void sde_encoder_phys_cmd_setup_vsync_source(
  1408. struct sde_encoder_phys *phys_enc,
  1409. u32 vsync_source, bool is_dummy)
  1410. {
  1411. if (!phys_enc || !phys_enc->hw_intf)
  1412. return;
  1413. sde_encoder_helper_vsync_config(phys_enc, vsync_source, is_dummy);
  1414. if (phys_enc->has_intf_te && phys_enc->hw_intf->ops.vsync_sel)
  1415. phys_enc->hw_intf->ops.vsync_sel(phys_enc->hw_intf,
  1416. vsync_source);
  1417. }
  1418. static void sde_encoder_phys_cmd_init_ops(struct sde_encoder_phys_ops *ops)
  1419. {
  1420. ops->prepare_commit = sde_encoder_phys_cmd_prepare_commit;
  1421. ops->is_master = sde_encoder_phys_cmd_is_master;
  1422. ops->mode_set = sde_encoder_phys_cmd_mode_set;
  1423. ops->cont_splash_mode_set = sde_encoder_phys_cmd_cont_splash_mode_set;
  1424. ops->mode_fixup = sde_encoder_phys_cmd_mode_fixup;
  1425. ops->enable = sde_encoder_phys_cmd_enable;
  1426. ops->disable = sde_encoder_phys_cmd_disable;
  1427. ops->destroy = sde_encoder_phys_cmd_destroy;
  1428. ops->get_hw_resources = sde_encoder_phys_cmd_get_hw_resources;
  1429. ops->control_vblank_irq = sde_encoder_phys_cmd_control_vblank_irq;
  1430. ops->wait_for_commit_done = sde_encoder_phys_cmd_wait_for_commit_done;
  1431. ops->prepare_for_kickoff = sde_encoder_phys_cmd_prepare_for_kickoff;
  1432. ops->wait_for_tx_complete = sde_encoder_phys_cmd_wait_for_tx_complete;
  1433. ops->wait_for_vblank = sde_encoder_phys_cmd_wait_for_vblank;
  1434. ops->trigger_flush = sde_encoder_helper_trigger_flush;
  1435. ops->trigger_start = sde_encoder_phys_cmd_trigger_start;
  1436. ops->needs_single_flush = sde_encoder_phys_needs_single_flush;
  1437. ops->hw_reset = sde_encoder_helper_hw_reset;
  1438. ops->irq_control = sde_encoder_phys_cmd_irq_control;
  1439. ops->update_split_role = sde_encoder_phys_cmd_update_split_role;
  1440. ops->restore = sde_encoder_phys_cmd_enable_helper;
  1441. ops->control_te = sde_encoder_phys_cmd_connect_te;
  1442. ops->is_autorefresh_enabled =
  1443. sde_encoder_phys_cmd_is_autorefresh_enabled;
  1444. ops->get_line_count = sde_encoder_phys_cmd_te_get_line_count;
  1445. ops->get_wr_line_count = sde_encoder_phys_cmd_get_write_line_count;
  1446. ops->wait_for_active = NULL;
  1447. ops->setup_vsync_source = sde_encoder_phys_cmd_setup_vsync_source;
  1448. ops->setup_misr = sde_encoder_helper_setup_misr;
  1449. ops->collect_misr = sde_encoder_helper_collect_misr;
  1450. }
  1451. struct sde_encoder_phys *sde_encoder_phys_cmd_init(
  1452. struct sde_enc_phys_init_params *p)
  1453. {
  1454. struct sde_encoder_phys *phys_enc = NULL;
  1455. struct sde_encoder_phys_cmd *cmd_enc = NULL;
  1456. struct sde_hw_mdp *hw_mdp;
  1457. struct sde_encoder_irq *irq;
  1458. int i, ret = 0;
  1459. SDE_DEBUG("intf %d\n", p->intf_idx - INTF_0);
  1460. cmd_enc = kzalloc(sizeof(*cmd_enc), GFP_KERNEL);
  1461. if (!cmd_enc) {
  1462. ret = -ENOMEM;
  1463. SDE_ERROR("failed to allocate\n");
  1464. goto fail;
  1465. }
  1466. phys_enc = &cmd_enc->base;
  1467. hw_mdp = sde_rm_get_mdp(&p->sde_kms->rm);
  1468. if (IS_ERR_OR_NULL(hw_mdp)) {
  1469. ret = PTR_ERR(hw_mdp);
  1470. SDE_ERROR("failed to get mdptop\n");
  1471. goto fail_mdp_init;
  1472. }
  1473. phys_enc->hw_mdptop = hw_mdp;
  1474. phys_enc->intf_idx = p->intf_idx;
  1475. phys_enc->parent = p->parent;
  1476. phys_enc->parent_ops = p->parent_ops;
  1477. phys_enc->sde_kms = p->sde_kms;
  1478. phys_enc->split_role = p->split_role;
  1479. phys_enc->intf_mode = INTF_MODE_CMD;
  1480. phys_enc->enc_spinlock = p->enc_spinlock;
  1481. phys_enc->vblank_ctl_lock = p->vblank_ctl_lock;
  1482. cmd_enc->stream_sel = 0;
  1483. phys_enc->enable_state = SDE_ENC_DISABLED;
  1484. sde_encoder_phys_cmd_init_ops(&phys_enc->ops);
  1485. phys_enc->comp_type = p->comp_type;
  1486. if (sde_hw_intf_te_supported(phys_enc->sde_kms->catalog))
  1487. phys_enc->has_intf_te = true;
  1488. else
  1489. phys_enc->has_intf_te = false;
  1490. for (i = 0; i < INTR_IDX_MAX; i++) {
  1491. irq = &phys_enc->irq[i];
  1492. INIT_LIST_HEAD(&irq->cb.list);
  1493. irq->irq_idx = -EINVAL;
  1494. irq->hw_idx = -EINVAL;
  1495. irq->cb.arg = phys_enc;
  1496. }
  1497. irq = &phys_enc->irq[INTR_IDX_CTL_START];
  1498. irq->name = "ctl_start";
  1499. irq->intr_type = SDE_IRQ_TYPE_CTL_START;
  1500. irq->intr_idx = INTR_IDX_CTL_START;
  1501. irq->cb.func = NULL;
  1502. irq = &phys_enc->irq[INTR_IDX_PINGPONG];
  1503. irq->name = "pp_done";
  1504. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_COMP;
  1505. irq->intr_idx = INTR_IDX_PINGPONG;
  1506. irq->cb.func = sde_encoder_phys_cmd_pp_tx_done_irq;
  1507. irq = &phys_enc->irq[INTR_IDX_RDPTR];
  1508. irq->intr_idx = INTR_IDX_RDPTR;
  1509. irq->name = "te_rd_ptr";
  1510. if (phys_enc->has_intf_te)
  1511. irq->intr_type = SDE_IRQ_TYPE_INTF_TEAR_RD_PTR;
  1512. else
  1513. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_RD_PTR;
  1514. irq->cb.func = sde_encoder_phys_cmd_te_rd_ptr_irq;
  1515. irq = &phys_enc->irq[INTR_IDX_UNDERRUN];
  1516. irq->name = "underrun";
  1517. irq->intr_type = SDE_IRQ_TYPE_INTF_UNDER_RUN;
  1518. irq->intr_idx = INTR_IDX_UNDERRUN;
  1519. irq->cb.func = sde_encoder_phys_cmd_underrun_irq;
  1520. irq = &phys_enc->irq[INTR_IDX_AUTOREFRESH_DONE];
  1521. irq->name = "autorefresh_done";
  1522. if (phys_enc->has_intf_te)
  1523. irq->intr_type = SDE_IRQ_TYPE_INTF_TEAR_AUTO_REF;
  1524. else
  1525. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_AUTO_REF;
  1526. irq->intr_idx = INTR_IDX_AUTOREFRESH_DONE;
  1527. irq->cb.func = sde_encoder_phys_cmd_autorefresh_done_irq;
  1528. irq = &phys_enc->irq[INTR_IDX_WRPTR];
  1529. irq->intr_idx = INTR_IDX_WRPTR;
  1530. irq->name = "wr_ptr";
  1531. if (phys_enc->has_intf_te)
  1532. irq->intr_type = SDE_IRQ_TYPE_INTF_TEAR_WR_PTR;
  1533. else
  1534. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_WR_PTR;
  1535. irq->cb.func = sde_encoder_phys_cmd_wr_ptr_irq;
  1536. atomic_set(&phys_enc->vblank_refcount, 0);
  1537. atomic_set(&phys_enc->pending_kickoff_cnt, 0);
  1538. atomic_set(&phys_enc->pending_retire_fence_cnt, 0);
  1539. atomic_set(&cmd_enc->pending_vblank_cnt, 0);
  1540. init_waitqueue_head(&phys_enc->pending_kickoff_wq);
  1541. init_waitqueue_head(&cmd_enc->pending_vblank_wq);
  1542. atomic_set(&cmd_enc->autorefresh.kickoff_cnt, 0);
  1543. init_waitqueue_head(&cmd_enc->autorefresh.kickoff_wq);
  1544. INIT_LIST_HEAD(&cmd_enc->te_timestamp_list);
  1545. for (i = 0; i < MAX_TE_PROFILE_COUNT; i++)
  1546. list_add(&cmd_enc->te_timestamp[i].list,
  1547. &cmd_enc->te_timestamp_list);
  1548. SDE_DEBUG_CMDENC(cmd_enc, "created\n");
  1549. return phys_enc;
  1550. fail_mdp_init:
  1551. kfree(cmd_enc);
  1552. fail:
  1553. return ERR_PTR(ret);
  1554. }