sde_encoder_phys_cmd.c 54 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935
  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. phys_enc->frame_trigger_mode = params->frame_trigger_mode;
  1104. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->hw_pp->idx - PINGPONG_0,
  1105. atomic_read(&phys_enc->pending_kickoff_cnt),
  1106. atomic_read(&cmd_enc->autorefresh.kickoff_cnt),
  1107. phys_enc->frame_trigger_mode);
  1108. if (phys_enc->frame_trigger_mode == FRAME_DONE_WAIT_DEFAULT) {
  1109. /*
  1110. * Mark kickoff request as outstanding. If there are more
  1111. * than one outstanding frame, then we have to wait for the
  1112. * previous frame to complete
  1113. */
  1114. ret = _sde_encoder_phys_cmd_wait_for_idle(phys_enc);
  1115. if (ret) {
  1116. atomic_set(&phys_enc->pending_kickoff_cnt, 0);
  1117. SDE_EVT32(DRMID(phys_enc->parent),
  1118. phys_enc->hw_pp->idx - PINGPONG_0);
  1119. SDE_ERROR("failed wait_for_idle: %d\n", ret);
  1120. }
  1121. }
  1122. if (sde_connector_is_qsync_updated(phys_enc->connector)) {
  1123. tc_cfg.sync_threshold_start =
  1124. _get_tearcheck_threshold(phys_enc,
  1125. &extra_frame_trigger_time);
  1126. if (phys_enc->has_intf_te &&
  1127. phys_enc->hw_intf->ops.update_tearcheck)
  1128. phys_enc->hw_intf->ops.update_tearcheck(
  1129. phys_enc->hw_intf, &tc_cfg);
  1130. else if (phys_enc->hw_pp->ops.update_tearcheck)
  1131. phys_enc->hw_pp->ops.update_tearcheck(
  1132. phys_enc->hw_pp, &tc_cfg);
  1133. SDE_EVT32(DRMID(phys_enc->parent), tc_cfg.sync_threshold_start);
  1134. }
  1135. SDE_DEBUG_CMDENC(cmd_enc, "pp:%d pending_cnt %d\n",
  1136. phys_enc->hw_pp->idx - PINGPONG_0,
  1137. atomic_read(&phys_enc->pending_kickoff_cnt));
  1138. return ret;
  1139. }
  1140. static bool _sde_encoder_phys_cmd_needs_vsync_change(
  1141. struct sde_encoder_phys *phys_enc, ktime_t profile_timestamp)
  1142. {
  1143. struct sde_encoder_phys_cmd *cmd_enc;
  1144. struct sde_encoder_phys_cmd_te_timestamp *cur;
  1145. struct sde_encoder_phys_cmd_te_timestamp *prev = NULL;
  1146. ktime_t time_diff;
  1147. u64 l_bound = 0, u_bound = 0;
  1148. bool ret = false;
  1149. unsigned long lock_flags;
  1150. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1151. sde_encoder_helper_get_jitter_bounds_ns(phys_enc->parent,
  1152. &l_bound, &u_bound);
  1153. if (!l_bound || !u_bound) {
  1154. SDE_ERROR_CMDENC(cmd_enc, "invalid vsync jitter bounds\n");
  1155. return false;
  1156. }
  1157. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  1158. list_for_each_entry_reverse(cur, &cmd_enc->te_timestamp_list, list) {
  1159. if (prev && ktime_after(cur->timestamp, profile_timestamp)) {
  1160. time_diff = ktime_sub(prev->timestamp, cur->timestamp);
  1161. if ((time_diff < l_bound) || (time_diff > u_bound)) {
  1162. ret = true;
  1163. break;
  1164. }
  1165. }
  1166. prev = cur;
  1167. }
  1168. spin_unlock_irqrestore(phys_enc->enc_spinlock, lock_flags);
  1169. if (ret) {
  1170. SDE_DEBUG_CMDENC(cmd_enc,
  1171. "time_diff:%llu, prev:%llu, cur:%llu, jitter:%llu/%llu\n",
  1172. time_diff, prev->timestamp, cur->timestamp,
  1173. l_bound, u_bound);
  1174. time_diff = div_s64(time_diff, 1000);
  1175. SDE_EVT32(DRMID(phys_enc->parent),
  1176. (u32) (do_div(l_bound, 1000)),
  1177. (u32) (do_div(u_bound, 1000)),
  1178. (u32) (time_diff), SDE_EVTLOG_ERROR);
  1179. }
  1180. return ret;
  1181. }
  1182. static int _sde_encoder_phys_cmd_wait_for_wr_ptr(
  1183. struct sde_encoder_phys *phys_enc)
  1184. {
  1185. struct sde_encoder_phys_cmd *cmd_enc =
  1186. to_sde_encoder_phys_cmd(phys_enc);
  1187. struct sde_encoder_wait_info wait_info = {0};
  1188. int ret;
  1189. bool frame_pending = true;
  1190. struct sde_hw_ctl *ctl;
  1191. if (!phys_enc || !phys_enc->hw_ctl) {
  1192. SDE_ERROR("invalid argument(s)\n");
  1193. return -EINVAL;
  1194. }
  1195. ctl = phys_enc->hw_ctl;
  1196. wait_info.wq = &phys_enc->pending_kickoff_wq;
  1197. wait_info.atomic_cnt = &phys_enc->pending_retire_fence_cnt;
  1198. wait_info.timeout_ms = KICKOFF_TIMEOUT_MS;
  1199. /* slave encoder doesn't enable for ppsplit */
  1200. if (_sde_encoder_phys_is_ppsplit_slave(phys_enc))
  1201. return 0;
  1202. ret = sde_encoder_helper_wait_for_irq(phys_enc, INTR_IDX_WRPTR,
  1203. &wait_info);
  1204. if (ret == -ETIMEDOUT) {
  1205. struct sde_hw_ctl *ctl = phys_enc->hw_ctl;
  1206. if (ctl && ctl->ops.get_start_state)
  1207. frame_pending = ctl->ops.get_start_state(ctl);
  1208. ret = frame_pending ? ret : 0;
  1209. }
  1210. cmd_enc->wr_ptr_wait_success = (ret == 0) ? true : false;
  1211. return ret;
  1212. }
  1213. static int sde_encoder_phys_cmd_wait_for_tx_complete(
  1214. struct sde_encoder_phys *phys_enc)
  1215. {
  1216. int rc;
  1217. struct sde_encoder_phys_cmd *cmd_enc;
  1218. if (!phys_enc)
  1219. return -EINVAL;
  1220. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1221. if (!atomic_read(&phys_enc->pending_kickoff_cnt)) {
  1222. SDE_EVT32(DRMID(phys_enc->parent),
  1223. phys_enc->intf_idx - INTF_0,
  1224. phys_enc->enable_state);
  1225. return 0;
  1226. }
  1227. rc = _sde_encoder_phys_cmd_wait_for_idle(phys_enc);
  1228. if (rc) {
  1229. SDE_EVT32(DRMID(phys_enc->parent),
  1230. phys_enc->intf_idx - INTF_0);
  1231. SDE_ERROR("failed wait_for_idle: %d\n", rc);
  1232. }
  1233. return rc;
  1234. }
  1235. static int _sde_encoder_phys_cmd_handle_wr_ptr_timeout(
  1236. struct sde_encoder_phys *phys_enc,
  1237. ktime_t profile_timestamp)
  1238. {
  1239. struct sde_encoder_phys_cmd *cmd_enc =
  1240. to_sde_encoder_phys_cmd(phys_enc);
  1241. bool switch_te;
  1242. int ret = -ETIMEDOUT;
  1243. unsigned long lock_flags;
  1244. switch_te = _sde_encoder_phys_cmd_needs_vsync_change(
  1245. phys_enc, profile_timestamp);
  1246. SDE_EVT32(DRMID(phys_enc->parent), switch_te, SDE_EVTLOG_FUNC_ENTRY);
  1247. if (switch_te) {
  1248. SDE_DEBUG_CMDENC(cmd_enc,
  1249. "wr_ptr_irq wait failed, retry with WD TE\n");
  1250. /* switch to watchdog TE and wait again */
  1251. sde_encoder_helper_switch_vsync(phys_enc->parent, true);
  1252. ret = _sde_encoder_phys_cmd_wait_for_wr_ptr(phys_enc);
  1253. /* switch back to default TE */
  1254. sde_encoder_helper_switch_vsync(phys_enc->parent, false);
  1255. }
  1256. /*
  1257. * Signaling the retire fence at wr_ptr timeout
  1258. * to allow the next commit and avoid device freeze.
  1259. */
  1260. if (ret == -ETIMEDOUT) {
  1261. SDE_ERROR_CMDENC(cmd_enc,
  1262. "wr_ptr_irq wait failed, switch_te:%d\n", switch_te);
  1263. SDE_EVT32(DRMID(phys_enc->parent), switch_te, SDE_EVTLOG_ERROR);
  1264. if (sde_encoder_phys_cmd_is_master(phys_enc) &&
  1265. atomic_add_unless(
  1266. &phys_enc->pending_retire_fence_cnt, -1, 0)) {
  1267. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  1268. phys_enc->parent_ops.handle_frame_done(
  1269. phys_enc->parent, phys_enc,
  1270. SDE_ENCODER_FRAME_EVENT_SIGNAL_RETIRE_FENCE);
  1271. spin_unlock_irqrestore(phys_enc->enc_spinlock,
  1272. lock_flags);
  1273. }
  1274. }
  1275. cmd_enc->wr_ptr_wait_success = (ret == 0) ? true : false;
  1276. return ret;
  1277. }
  1278. static int sde_encoder_phys_cmd_wait_for_commit_done(
  1279. struct sde_encoder_phys *phys_enc)
  1280. {
  1281. int rc = 0, i, pending_cnt;
  1282. struct sde_encoder_phys_cmd *cmd_enc;
  1283. ktime_t profile_timestamp = ktime_get();
  1284. u32 scheduler_status = INVALID_CTL_STATUS;
  1285. struct sde_hw_ctl *ctl;
  1286. if (!phys_enc)
  1287. return -EINVAL;
  1288. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1289. /* only required for master controller */
  1290. if (sde_encoder_phys_cmd_is_master(phys_enc)) {
  1291. rc = _sde_encoder_phys_cmd_wait_for_wr_ptr(phys_enc);
  1292. if (rc == -ETIMEDOUT) {
  1293. /*
  1294. * Profile all the TE received after profile_timestamp
  1295. * and if the jitter is more, switch to watchdog TE
  1296. * and wait for wr_ptr again. Finally move back to
  1297. * default TE.
  1298. */
  1299. rc = _sde_encoder_phys_cmd_handle_wr_ptr_timeout(
  1300. phys_enc, profile_timestamp);
  1301. if (rc == -ETIMEDOUT)
  1302. goto wait_for_idle;
  1303. }
  1304. if (cmd_enc->autorefresh.cfg.enable)
  1305. rc = _sde_encoder_phys_cmd_wait_for_autorefresh_done(
  1306. phys_enc);
  1307. ctl = phys_enc->hw_ctl;
  1308. if (ctl && ctl->ops.get_scheduler_status)
  1309. scheduler_status = ctl->ops.get_scheduler_status(ctl);
  1310. }
  1311. /* wait for posted start or serialize trigger */
  1312. pending_cnt = atomic_read(&phys_enc->pending_kickoff_cnt);
  1313. if ((pending_cnt > 1) ||
  1314. (pending_cnt && (scheduler_status & BIT(0))) ||
  1315. (!rc && phys_enc->frame_trigger_mode == FRAME_DONE_WAIT_SERIALIZE))
  1316. goto wait_for_idle;
  1317. return rc;
  1318. wait_for_idle:
  1319. pending_cnt = atomic_read(&phys_enc->pending_kickoff_cnt);
  1320. for (i = 0; i < pending_cnt; i++)
  1321. rc |= sde_encoder_wait_for_event(phys_enc->parent,
  1322. MSM_ENC_TX_COMPLETE);
  1323. if (rc) {
  1324. SDE_EVT32(DRMID(phys_enc->parent),
  1325. phys_enc->hw_pp->idx - PINGPONG_0,
  1326. phys_enc->frame_trigger_mode,
  1327. atomic_read(&phys_enc->pending_kickoff_cnt),
  1328. phys_enc->enable_state,
  1329. cmd_enc->wr_ptr_wait_success, scheduler_status, rc);
  1330. SDE_ERROR("pp:%d failed wait_for_idle: %d\n",
  1331. phys_enc->hw_pp->idx - PINGPONG_0, rc);
  1332. if (phys_enc->enable_state == SDE_ENC_ERR_NEEDS_HW_RESET)
  1333. sde_encoder_helper_needs_hw_reset(phys_enc->parent);
  1334. }
  1335. return rc;
  1336. }
  1337. static int sde_encoder_phys_cmd_wait_for_vblank(
  1338. struct sde_encoder_phys *phys_enc)
  1339. {
  1340. int rc = 0;
  1341. struct sde_encoder_phys_cmd *cmd_enc;
  1342. struct sde_encoder_wait_info wait_info = {0};
  1343. if (!phys_enc)
  1344. return -EINVAL;
  1345. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1346. /* only required for master controller */
  1347. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  1348. return rc;
  1349. wait_info.wq = &cmd_enc->pending_vblank_wq;
  1350. wait_info.atomic_cnt = &cmd_enc->pending_vblank_cnt;
  1351. wait_info.timeout_ms = _sde_encoder_phys_cmd_get_idle_timeout(cmd_enc);
  1352. atomic_inc(&cmd_enc->pending_vblank_cnt);
  1353. rc = sde_encoder_helper_wait_for_irq(phys_enc, INTR_IDX_RDPTR,
  1354. &wait_info);
  1355. return rc;
  1356. }
  1357. static void sde_encoder_phys_cmd_update_split_role(
  1358. struct sde_encoder_phys *phys_enc,
  1359. enum sde_enc_split_role role)
  1360. {
  1361. struct sde_encoder_phys_cmd *cmd_enc;
  1362. enum sde_enc_split_role old_role;
  1363. bool is_ppsplit;
  1364. if (!phys_enc)
  1365. return;
  1366. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1367. old_role = phys_enc->split_role;
  1368. is_ppsplit = _sde_encoder_phys_is_ppsplit(phys_enc);
  1369. phys_enc->split_role = role;
  1370. SDE_DEBUG_CMDENC(cmd_enc, "old role %d new role %d\n",
  1371. old_role, role);
  1372. /*
  1373. * ppsplit solo needs to reprogram because intf may have swapped without
  1374. * role changing on left-only, right-only back-to-back commits
  1375. */
  1376. if (!(is_ppsplit && role == ENC_ROLE_SOLO) &&
  1377. (role == old_role || role == ENC_ROLE_SKIP))
  1378. return;
  1379. sde_encoder_helper_split_config(phys_enc, phys_enc->intf_idx);
  1380. _sde_encoder_phys_cmd_pingpong_config(phys_enc);
  1381. _sde_encoder_phys_cmd_update_flush_mask(phys_enc);
  1382. }
  1383. static void sde_encoder_phys_cmd_prepare_commit(
  1384. struct sde_encoder_phys *phys_enc)
  1385. {
  1386. struct sde_encoder_phys_cmd *cmd_enc =
  1387. to_sde_encoder_phys_cmd(phys_enc);
  1388. int trial = 0;
  1389. if (!phys_enc)
  1390. return;
  1391. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  1392. return;
  1393. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->intf_idx - INTF_0,
  1394. cmd_enc->autorefresh.cfg.enable);
  1395. if (!sde_encoder_phys_cmd_is_autorefresh_enabled(phys_enc))
  1396. return;
  1397. /*
  1398. * If autorefresh is enabled, disable it and make sure it is safe to
  1399. * proceed with current frame commit/push. Sequence fallowed is,
  1400. * 1. Disable TE
  1401. * 2. Disable autorefresh config
  1402. * 4. Poll for frame transfer ongoing to be false
  1403. * 5. Enable TE back
  1404. */
  1405. sde_encoder_phys_cmd_connect_te(phys_enc, false);
  1406. _sde_encoder_phys_cmd_config_autorefresh(phys_enc, 0);
  1407. do {
  1408. udelay(SDE_ENC_MAX_POLL_TIMEOUT_US);
  1409. if ((trial * SDE_ENC_MAX_POLL_TIMEOUT_US)
  1410. > (KICKOFF_TIMEOUT_MS * USEC_PER_MSEC)) {
  1411. SDE_ERROR_CMDENC(cmd_enc,
  1412. "disable autorefresh failed\n");
  1413. break;
  1414. }
  1415. trial++;
  1416. } while (_sde_encoder_phys_cmd_is_ongoing_pptx(phys_enc));
  1417. sde_encoder_phys_cmd_connect_te(phys_enc, true);
  1418. SDE_DEBUG_CMDENC(cmd_enc, "disabled autorefresh\n");
  1419. }
  1420. static void sde_encoder_phys_cmd_trigger_start(
  1421. struct sde_encoder_phys *phys_enc)
  1422. {
  1423. struct sde_encoder_phys_cmd *cmd_enc =
  1424. to_sde_encoder_phys_cmd(phys_enc);
  1425. u32 frame_cnt;
  1426. if (!phys_enc)
  1427. return;
  1428. /* we don't issue CTL_START when using autorefresh */
  1429. frame_cnt = _sde_encoder_phys_cmd_get_autorefresh_property(phys_enc);
  1430. if (frame_cnt) {
  1431. _sde_encoder_phys_cmd_config_autorefresh(phys_enc, frame_cnt);
  1432. atomic_inc(&cmd_enc->autorefresh.kickoff_cnt);
  1433. } else {
  1434. sde_encoder_helper_trigger_start(phys_enc);
  1435. }
  1436. }
  1437. static void sde_encoder_phys_cmd_setup_vsync_source(
  1438. struct sde_encoder_phys *phys_enc,
  1439. u32 vsync_source, bool is_dummy)
  1440. {
  1441. if (!phys_enc || !phys_enc->hw_intf)
  1442. return;
  1443. sde_encoder_helper_vsync_config(phys_enc, vsync_source, is_dummy);
  1444. if (phys_enc->has_intf_te && phys_enc->hw_intf->ops.vsync_sel)
  1445. phys_enc->hw_intf->ops.vsync_sel(phys_enc->hw_intf,
  1446. vsync_source);
  1447. }
  1448. static void sde_encoder_phys_cmd_init_ops(struct sde_encoder_phys_ops *ops)
  1449. {
  1450. ops->prepare_commit = sde_encoder_phys_cmd_prepare_commit;
  1451. ops->is_master = sde_encoder_phys_cmd_is_master;
  1452. ops->mode_set = sde_encoder_phys_cmd_mode_set;
  1453. ops->cont_splash_mode_set = sde_encoder_phys_cmd_cont_splash_mode_set;
  1454. ops->mode_fixup = sde_encoder_phys_cmd_mode_fixup;
  1455. ops->enable = sde_encoder_phys_cmd_enable;
  1456. ops->disable = sde_encoder_phys_cmd_disable;
  1457. ops->destroy = sde_encoder_phys_cmd_destroy;
  1458. ops->get_hw_resources = sde_encoder_phys_cmd_get_hw_resources;
  1459. ops->control_vblank_irq = sde_encoder_phys_cmd_control_vblank_irq;
  1460. ops->wait_for_commit_done = sde_encoder_phys_cmd_wait_for_commit_done;
  1461. ops->prepare_for_kickoff = sde_encoder_phys_cmd_prepare_for_kickoff;
  1462. ops->wait_for_tx_complete = sde_encoder_phys_cmd_wait_for_tx_complete;
  1463. ops->wait_for_vblank = sde_encoder_phys_cmd_wait_for_vblank;
  1464. ops->trigger_flush = sde_encoder_helper_trigger_flush;
  1465. ops->trigger_start = sde_encoder_phys_cmd_trigger_start;
  1466. ops->needs_single_flush = sde_encoder_phys_needs_single_flush;
  1467. ops->hw_reset = sde_encoder_helper_hw_reset;
  1468. ops->irq_control = sde_encoder_phys_cmd_irq_control;
  1469. ops->update_split_role = sde_encoder_phys_cmd_update_split_role;
  1470. ops->restore = sde_encoder_phys_cmd_enable_helper;
  1471. ops->control_te = sde_encoder_phys_cmd_connect_te;
  1472. ops->is_autorefresh_enabled =
  1473. sde_encoder_phys_cmd_is_autorefresh_enabled;
  1474. ops->get_line_count = sde_encoder_phys_cmd_te_get_line_count;
  1475. ops->get_wr_line_count = sde_encoder_phys_cmd_get_write_line_count;
  1476. ops->wait_for_active = NULL;
  1477. ops->setup_vsync_source = sde_encoder_phys_cmd_setup_vsync_source;
  1478. ops->setup_misr = sde_encoder_helper_setup_misr;
  1479. ops->collect_misr = sde_encoder_helper_collect_misr;
  1480. }
  1481. static inline bool sde_encoder_phys_cmd_intf_te_supported(
  1482. const struct sde_mdss_cfg *sde_cfg, enum sde_intf idx)
  1483. {
  1484. if (sde_cfg && ((idx - INTF_0) < sde_cfg->intf_count))
  1485. return test_bit(SDE_INTF_TE,
  1486. &(sde_cfg->intf[idx - INTF_0].features));
  1487. return false;
  1488. }
  1489. struct sde_encoder_phys *sde_encoder_phys_cmd_init(
  1490. struct sde_enc_phys_init_params *p)
  1491. {
  1492. struct sde_encoder_phys *phys_enc = NULL;
  1493. struct sde_encoder_phys_cmd *cmd_enc = NULL;
  1494. struct sde_hw_mdp *hw_mdp;
  1495. struct sde_encoder_irq *irq;
  1496. int i, ret = 0;
  1497. SDE_DEBUG("intf %d\n", p->intf_idx - INTF_0);
  1498. cmd_enc = kzalloc(sizeof(*cmd_enc), GFP_KERNEL);
  1499. if (!cmd_enc) {
  1500. ret = -ENOMEM;
  1501. SDE_ERROR("failed to allocate\n");
  1502. goto fail;
  1503. }
  1504. phys_enc = &cmd_enc->base;
  1505. hw_mdp = sde_rm_get_mdp(&p->sde_kms->rm);
  1506. if (IS_ERR_OR_NULL(hw_mdp)) {
  1507. ret = PTR_ERR(hw_mdp);
  1508. SDE_ERROR("failed to get mdptop\n");
  1509. goto fail_mdp_init;
  1510. }
  1511. phys_enc->hw_mdptop = hw_mdp;
  1512. phys_enc->intf_idx = p->intf_idx;
  1513. phys_enc->parent = p->parent;
  1514. phys_enc->parent_ops = p->parent_ops;
  1515. phys_enc->sde_kms = p->sde_kms;
  1516. phys_enc->split_role = p->split_role;
  1517. phys_enc->intf_mode = INTF_MODE_CMD;
  1518. phys_enc->enc_spinlock = p->enc_spinlock;
  1519. phys_enc->vblank_ctl_lock = p->vblank_ctl_lock;
  1520. cmd_enc->stream_sel = 0;
  1521. phys_enc->enable_state = SDE_ENC_DISABLED;
  1522. sde_encoder_phys_cmd_init_ops(&phys_enc->ops);
  1523. phys_enc->comp_type = p->comp_type;
  1524. phys_enc->has_intf_te = sde_encoder_phys_cmd_intf_te_supported(
  1525. phys_enc->sde_kms->catalog, phys_enc->intf_idx);
  1526. for (i = 0; i < INTR_IDX_MAX; i++) {
  1527. irq = &phys_enc->irq[i];
  1528. INIT_LIST_HEAD(&irq->cb.list);
  1529. irq->irq_idx = -EINVAL;
  1530. irq->hw_idx = -EINVAL;
  1531. irq->cb.arg = phys_enc;
  1532. }
  1533. irq = &phys_enc->irq[INTR_IDX_CTL_START];
  1534. irq->name = "ctl_start";
  1535. irq->intr_type = SDE_IRQ_TYPE_CTL_START;
  1536. irq->intr_idx = INTR_IDX_CTL_START;
  1537. irq->cb.func = NULL;
  1538. irq = &phys_enc->irq[INTR_IDX_PINGPONG];
  1539. irq->name = "pp_done";
  1540. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_COMP;
  1541. irq->intr_idx = INTR_IDX_PINGPONG;
  1542. irq->cb.func = sde_encoder_phys_cmd_pp_tx_done_irq;
  1543. irq = &phys_enc->irq[INTR_IDX_RDPTR];
  1544. irq->intr_idx = INTR_IDX_RDPTR;
  1545. irq->name = "te_rd_ptr";
  1546. if (phys_enc->has_intf_te)
  1547. irq->intr_type = SDE_IRQ_TYPE_INTF_TEAR_RD_PTR;
  1548. else
  1549. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_RD_PTR;
  1550. irq->cb.func = sde_encoder_phys_cmd_te_rd_ptr_irq;
  1551. irq = &phys_enc->irq[INTR_IDX_UNDERRUN];
  1552. irq->name = "underrun";
  1553. irq->intr_type = SDE_IRQ_TYPE_INTF_UNDER_RUN;
  1554. irq->intr_idx = INTR_IDX_UNDERRUN;
  1555. irq->cb.func = sde_encoder_phys_cmd_underrun_irq;
  1556. irq = &phys_enc->irq[INTR_IDX_AUTOREFRESH_DONE];
  1557. irq->name = "autorefresh_done";
  1558. if (phys_enc->has_intf_te)
  1559. irq->intr_type = SDE_IRQ_TYPE_INTF_TEAR_AUTO_REF;
  1560. else
  1561. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_AUTO_REF;
  1562. irq->intr_idx = INTR_IDX_AUTOREFRESH_DONE;
  1563. irq->cb.func = sde_encoder_phys_cmd_autorefresh_done_irq;
  1564. irq = &phys_enc->irq[INTR_IDX_WRPTR];
  1565. irq->intr_idx = INTR_IDX_WRPTR;
  1566. irq->name = "wr_ptr";
  1567. if (phys_enc->has_intf_te)
  1568. irq->intr_type = SDE_IRQ_TYPE_INTF_TEAR_WR_PTR;
  1569. else
  1570. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_WR_PTR;
  1571. irq->cb.func = sde_encoder_phys_cmd_wr_ptr_irq;
  1572. atomic_set(&phys_enc->vblank_refcount, 0);
  1573. atomic_set(&phys_enc->pending_kickoff_cnt, 0);
  1574. atomic_set(&phys_enc->pending_retire_fence_cnt, 0);
  1575. atomic_set(&cmd_enc->pending_vblank_cnt, 0);
  1576. init_waitqueue_head(&phys_enc->pending_kickoff_wq);
  1577. init_waitqueue_head(&cmd_enc->pending_vblank_wq);
  1578. atomic_set(&cmd_enc->autorefresh.kickoff_cnt, 0);
  1579. init_waitqueue_head(&cmd_enc->autorefresh.kickoff_wq);
  1580. INIT_LIST_HEAD(&cmd_enc->te_timestamp_list);
  1581. for (i = 0; i < MAX_TE_PROFILE_COUNT; i++)
  1582. list_add(&cmd_enc->te_timestamp[i].list,
  1583. &cmd_enc->te_timestamp_list);
  1584. SDE_DEBUG_CMDENC(cmd_enc, "created\n");
  1585. return phys_enc;
  1586. fail_mdp_init:
  1587. kfree(cmd_enc);
  1588. fail:
  1589. return ERR_PTR(ret);
  1590. }