sde_encoder_phys_cmd.c 54 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2015-2020, 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. struct sde_hw_intf *hw_intf;
  910. if (!phys_enc || !phys_enc->hw_ctl || !phys_enc->hw_pp ||
  911. !phys_enc->hw_intf) {
  912. SDE_ERROR("invalid arg(s), encoder %d\n", !phys_enc);
  913. return;
  914. }
  915. sde_encoder_helper_split_config(phys_enc, phys_enc->intf_idx);
  916. _sde_encoder_phys_cmd_pingpong_config(phys_enc);
  917. hw_intf = phys_enc->hw_intf;
  918. if (hw_intf->ops.enable_compressed_input)
  919. hw_intf->ops.enable_compressed_input(phys_enc->hw_intf,
  920. (phys_enc->comp_type !=
  921. MSM_DISPLAY_COMPRESSION_NONE), false);
  922. /*
  923. * For pp-split, skip setting the flush bit for the slave intf, since
  924. * both intfs use same ctl and HW will only flush the master.
  925. */
  926. if (_sde_encoder_phys_is_ppsplit(phys_enc) &&
  927. !sde_encoder_phys_cmd_is_master(phys_enc))
  928. goto skip_flush;
  929. _sde_encoder_phys_cmd_update_flush_mask(phys_enc);
  930. skip_flush:
  931. return;
  932. }
  933. static void sde_encoder_phys_cmd_enable(struct sde_encoder_phys *phys_enc)
  934. {
  935. struct sde_encoder_phys_cmd *cmd_enc =
  936. to_sde_encoder_phys_cmd(phys_enc);
  937. if (!phys_enc || !phys_enc->hw_pp) {
  938. SDE_ERROR("invalid phys encoder\n");
  939. return;
  940. }
  941. SDE_DEBUG_CMDENC(cmd_enc, "pp %d\n", phys_enc->hw_pp->idx - PINGPONG_0);
  942. if (phys_enc->enable_state == SDE_ENC_ENABLED) {
  943. if (!phys_enc->cont_splash_enabled)
  944. SDE_ERROR("already enabled\n");
  945. return;
  946. }
  947. sde_encoder_phys_cmd_enable_helper(phys_enc);
  948. phys_enc->enable_state = SDE_ENC_ENABLED;
  949. }
  950. static bool sde_encoder_phys_cmd_is_autorefresh_enabled(
  951. struct sde_encoder_phys *phys_enc)
  952. {
  953. struct sde_hw_pingpong *hw_pp;
  954. struct sde_hw_intf *hw_intf;
  955. struct sde_hw_autorefresh cfg;
  956. int ret;
  957. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  958. return false;
  959. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  960. return false;
  961. if (phys_enc->has_intf_te) {
  962. hw_intf = phys_enc->hw_intf;
  963. if (!hw_intf->ops.get_autorefresh)
  964. return false;
  965. ret = hw_intf->ops.get_autorefresh(hw_intf, &cfg);
  966. } else {
  967. hw_pp = phys_enc->hw_pp;
  968. if (!hw_pp->ops.get_autorefresh)
  969. return false;
  970. ret = hw_pp->ops.get_autorefresh(hw_pp, &cfg);
  971. }
  972. if (ret)
  973. return false;
  974. return cfg.enable;
  975. }
  976. static void sde_encoder_phys_cmd_connect_te(
  977. struct sde_encoder_phys *phys_enc, bool enable)
  978. {
  979. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  980. return;
  981. if (phys_enc->has_intf_te &&
  982. phys_enc->hw_intf->ops.connect_external_te)
  983. phys_enc->hw_intf->ops.connect_external_te(phys_enc->hw_intf,
  984. enable);
  985. else if (phys_enc->hw_pp->ops.connect_external_te)
  986. phys_enc->hw_pp->ops.connect_external_te(phys_enc->hw_pp,
  987. enable);
  988. else
  989. return;
  990. SDE_EVT32(DRMID(phys_enc->parent), enable);
  991. }
  992. static int sde_encoder_phys_cmd_te_get_line_count(
  993. struct sde_encoder_phys *phys_enc)
  994. {
  995. struct sde_hw_pingpong *hw_pp;
  996. struct sde_hw_intf *hw_intf;
  997. u32 line_count;
  998. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  999. return -EINVAL;
  1000. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  1001. return -EINVAL;
  1002. if (phys_enc->has_intf_te) {
  1003. hw_intf = phys_enc->hw_intf;
  1004. if (!hw_intf->ops.get_line_count)
  1005. return -EINVAL;
  1006. line_count = hw_intf->ops.get_line_count(hw_intf);
  1007. } else {
  1008. hw_pp = phys_enc->hw_pp;
  1009. if (!hw_pp->ops.get_line_count)
  1010. return -EINVAL;
  1011. line_count = hw_pp->ops.get_line_count(hw_pp);
  1012. }
  1013. return line_count;
  1014. }
  1015. static int sde_encoder_phys_cmd_get_write_line_count(
  1016. struct sde_encoder_phys *phys_enc)
  1017. {
  1018. struct sde_hw_pingpong *hw_pp;
  1019. struct sde_hw_intf *hw_intf;
  1020. struct sde_hw_pp_vsync_info info;
  1021. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf)
  1022. return -EINVAL;
  1023. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  1024. return -EINVAL;
  1025. if (phys_enc->has_intf_te) {
  1026. hw_intf = phys_enc->hw_intf;
  1027. if (!hw_intf->ops.get_vsync_info)
  1028. return -EINVAL;
  1029. if (hw_intf->ops.get_vsync_info(hw_intf, &info))
  1030. return -EINVAL;
  1031. } else {
  1032. hw_pp = phys_enc->hw_pp;
  1033. if (!hw_pp->ops.get_vsync_info)
  1034. return -EINVAL;
  1035. if (hw_pp->ops.get_vsync_info(hw_pp, &info))
  1036. return -EINVAL;
  1037. }
  1038. return (int)info.wr_ptr_line_count;
  1039. }
  1040. static void sde_encoder_phys_cmd_disable(struct sde_encoder_phys *phys_enc)
  1041. {
  1042. struct sde_encoder_phys_cmd *cmd_enc =
  1043. to_sde_encoder_phys_cmd(phys_enc);
  1044. if (!phys_enc || !phys_enc->hw_pp || !phys_enc->hw_intf) {
  1045. SDE_ERROR("invalid encoder\n");
  1046. return;
  1047. }
  1048. SDE_DEBUG_CMDENC(cmd_enc, "pp %d intf %d state %d\n",
  1049. phys_enc->hw_pp->idx - PINGPONG_0,
  1050. phys_enc->hw_intf->idx - INTF_0,
  1051. phys_enc->enable_state);
  1052. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->hw_pp->idx - PINGPONG_0,
  1053. phys_enc->hw_intf->idx - INTF_0,
  1054. phys_enc->enable_state);
  1055. if (phys_enc->enable_state == SDE_ENC_DISABLED) {
  1056. SDE_ERROR_CMDENC(cmd_enc, "already disabled\n");
  1057. return;
  1058. }
  1059. if (phys_enc->has_intf_te && phys_enc->hw_intf->ops.enable_tearcheck)
  1060. phys_enc->hw_intf->ops.enable_tearcheck(
  1061. phys_enc->hw_intf,
  1062. false);
  1063. else if (phys_enc->hw_pp->ops.enable_tearcheck)
  1064. phys_enc->hw_pp->ops.enable_tearcheck(phys_enc->hw_pp,
  1065. false);
  1066. phys_enc->enable_state = SDE_ENC_DISABLED;
  1067. }
  1068. static void sde_encoder_phys_cmd_destroy(struct sde_encoder_phys *phys_enc)
  1069. {
  1070. struct sde_encoder_phys_cmd *cmd_enc =
  1071. to_sde_encoder_phys_cmd(phys_enc);
  1072. if (!phys_enc) {
  1073. SDE_ERROR("invalid encoder\n");
  1074. return;
  1075. }
  1076. kfree(cmd_enc);
  1077. }
  1078. static void sde_encoder_phys_cmd_get_hw_resources(
  1079. struct sde_encoder_phys *phys_enc,
  1080. struct sde_encoder_hw_resources *hw_res,
  1081. struct drm_connector_state *conn_state)
  1082. {
  1083. struct sde_encoder_phys_cmd *cmd_enc =
  1084. to_sde_encoder_phys_cmd(phys_enc);
  1085. if (!phys_enc) {
  1086. SDE_ERROR("invalid encoder\n");
  1087. return;
  1088. }
  1089. if ((phys_enc->intf_idx - INTF_0) >= INTF_MAX) {
  1090. SDE_ERROR("invalid intf idx:%d\n", phys_enc->intf_idx);
  1091. return;
  1092. }
  1093. SDE_DEBUG_CMDENC(cmd_enc, "\n");
  1094. hw_res->intfs[phys_enc->intf_idx - INTF_0] = INTF_MODE_CMD;
  1095. }
  1096. static int sde_encoder_phys_cmd_prepare_for_kickoff(
  1097. struct sde_encoder_phys *phys_enc,
  1098. struct sde_encoder_kickoff_params *params)
  1099. {
  1100. struct sde_hw_tear_check tc_cfg = {0};
  1101. struct sde_encoder_phys_cmd *cmd_enc =
  1102. to_sde_encoder_phys_cmd(phys_enc);
  1103. int ret = 0;
  1104. u32 extra_frame_trigger_time;
  1105. if (!phys_enc || !phys_enc->hw_pp) {
  1106. SDE_ERROR("invalid encoder\n");
  1107. return -EINVAL;
  1108. }
  1109. SDE_DEBUG_CMDENC(cmd_enc, "pp %d\n", phys_enc->hw_pp->idx - PINGPONG_0);
  1110. phys_enc->frame_trigger_mode = params->frame_trigger_mode;
  1111. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->hw_pp->idx - PINGPONG_0,
  1112. atomic_read(&phys_enc->pending_kickoff_cnt),
  1113. atomic_read(&cmd_enc->autorefresh.kickoff_cnt),
  1114. phys_enc->frame_trigger_mode);
  1115. if (phys_enc->frame_trigger_mode == FRAME_DONE_WAIT_DEFAULT) {
  1116. /*
  1117. * Mark kickoff request as outstanding. If there are more
  1118. * than one outstanding frame, then we have to wait for the
  1119. * previous frame to complete
  1120. */
  1121. ret = _sde_encoder_phys_cmd_wait_for_idle(phys_enc);
  1122. if (ret) {
  1123. atomic_set(&phys_enc->pending_kickoff_cnt, 0);
  1124. SDE_EVT32(DRMID(phys_enc->parent),
  1125. phys_enc->hw_pp->idx - PINGPONG_0);
  1126. SDE_ERROR("failed wait_for_idle: %d\n", ret);
  1127. }
  1128. }
  1129. if (sde_connector_is_qsync_updated(phys_enc->connector)) {
  1130. tc_cfg.sync_threshold_start =
  1131. _get_tearcheck_threshold(phys_enc,
  1132. &extra_frame_trigger_time);
  1133. if (phys_enc->has_intf_te &&
  1134. phys_enc->hw_intf->ops.update_tearcheck)
  1135. phys_enc->hw_intf->ops.update_tearcheck(
  1136. phys_enc->hw_intf, &tc_cfg);
  1137. else if (phys_enc->hw_pp->ops.update_tearcheck)
  1138. phys_enc->hw_pp->ops.update_tearcheck(
  1139. phys_enc->hw_pp, &tc_cfg);
  1140. SDE_EVT32(DRMID(phys_enc->parent), tc_cfg.sync_threshold_start);
  1141. }
  1142. SDE_DEBUG_CMDENC(cmd_enc, "pp:%d pending_cnt %d\n",
  1143. phys_enc->hw_pp->idx - PINGPONG_0,
  1144. atomic_read(&phys_enc->pending_kickoff_cnt));
  1145. return ret;
  1146. }
  1147. static bool _sde_encoder_phys_cmd_needs_vsync_change(
  1148. struct sde_encoder_phys *phys_enc, ktime_t profile_timestamp)
  1149. {
  1150. struct sde_encoder_phys_cmd *cmd_enc;
  1151. struct sde_encoder_phys_cmd_te_timestamp *cur;
  1152. struct sde_encoder_phys_cmd_te_timestamp *prev = NULL;
  1153. ktime_t time_diff;
  1154. u64 l_bound = 0, u_bound = 0;
  1155. bool ret = false;
  1156. unsigned long lock_flags;
  1157. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1158. sde_encoder_helper_get_jitter_bounds_ns(phys_enc->parent,
  1159. &l_bound, &u_bound);
  1160. if (!l_bound || !u_bound) {
  1161. SDE_ERROR_CMDENC(cmd_enc, "invalid vsync jitter bounds\n");
  1162. return false;
  1163. }
  1164. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  1165. list_for_each_entry_reverse(cur, &cmd_enc->te_timestamp_list, list) {
  1166. if (prev && ktime_after(cur->timestamp, profile_timestamp)) {
  1167. time_diff = ktime_sub(prev->timestamp, cur->timestamp);
  1168. if ((time_diff < l_bound) || (time_diff > u_bound)) {
  1169. ret = true;
  1170. break;
  1171. }
  1172. }
  1173. prev = cur;
  1174. }
  1175. spin_unlock_irqrestore(phys_enc->enc_spinlock, lock_flags);
  1176. if (ret) {
  1177. SDE_DEBUG_CMDENC(cmd_enc,
  1178. "time_diff:%llu, prev:%llu, cur:%llu, jitter:%llu/%llu\n",
  1179. time_diff, prev->timestamp, cur->timestamp,
  1180. l_bound, u_bound);
  1181. time_diff = div_s64(time_diff, 1000);
  1182. SDE_EVT32(DRMID(phys_enc->parent),
  1183. (u32) (do_div(l_bound, 1000)),
  1184. (u32) (do_div(u_bound, 1000)),
  1185. (u32) (time_diff), SDE_EVTLOG_ERROR);
  1186. }
  1187. return ret;
  1188. }
  1189. static int _sde_encoder_phys_cmd_wait_for_wr_ptr(
  1190. struct sde_encoder_phys *phys_enc)
  1191. {
  1192. struct sde_encoder_phys_cmd *cmd_enc =
  1193. to_sde_encoder_phys_cmd(phys_enc);
  1194. struct sde_encoder_wait_info wait_info = {0};
  1195. int ret;
  1196. bool frame_pending = true;
  1197. struct sde_hw_ctl *ctl;
  1198. if (!phys_enc || !phys_enc->hw_ctl) {
  1199. SDE_ERROR("invalid argument(s)\n");
  1200. return -EINVAL;
  1201. }
  1202. ctl = phys_enc->hw_ctl;
  1203. wait_info.wq = &phys_enc->pending_kickoff_wq;
  1204. wait_info.atomic_cnt = &phys_enc->pending_retire_fence_cnt;
  1205. wait_info.timeout_ms = KICKOFF_TIMEOUT_MS;
  1206. /* slave encoder doesn't enable for ppsplit */
  1207. if (_sde_encoder_phys_is_ppsplit_slave(phys_enc))
  1208. return 0;
  1209. ret = sde_encoder_helper_wait_for_irq(phys_enc, INTR_IDX_WRPTR,
  1210. &wait_info);
  1211. if (ret == -ETIMEDOUT) {
  1212. struct sde_hw_ctl *ctl = phys_enc->hw_ctl;
  1213. if (ctl && ctl->ops.get_start_state)
  1214. frame_pending = ctl->ops.get_start_state(ctl);
  1215. ret = frame_pending ? ret : 0;
  1216. }
  1217. cmd_enc->wr_ptr_wait_success = (ret == 0) ? true : false;
  1218. return ret;
  1219. }
  1220. static int sde_encoder_phys_cmd_wait_for_tx_complete(
  1221. struct sde_encoder_phys *phys_enc)
  1222. {
  1223. int rc;
  1224. struct sde_encoder_phys_cmd *cmd_enc;
  1225. if (!phys_enc)
  1226. return -EINVAL;
  1227. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1228. if (!atomic_read(&phys_enc->pending_kickoff_cnt)) {
  1229. SDE_EVT32(DRMID(phys_enc->parent),
  1230. phys_enc->intf_idx - INTF_0,
  1231. phys_enc->enable_state);
  1232. return 0;
  1233. }
  1234. rc = _sde_encoder_phys_cmd_wait_for_idle(phys_enc);
  1235. if (rc) {
  1236. SDE_EVT32(DRMID(phys_enc->parent),
  1237. phys_enc->intf_idx - INTF_0);
  1238. SDE_ERROR("failed wait_for_idle: %d\n", rc);
  1239. }
  1240. return rc;
  1241. }
  1242. static int _sde_encoder_phys_cmd_handle_wr_ptr_timeout(
  1243. struct sde_encoder_phys *phys_enc,
  1244. ktime_t profile_timestamp)
  1245. {
  1246. struct sde_encoder_phys_cmd *cmd_enc =
  1247. to_sde_encoder_phys_cmd(phys_enc);
  1248. bool switch_te;
  1249. int ret = -ETIMEDOUT;
  1250. unsigned long lock_flags;
  1251. switch_te = _sde_encoder_phys_cmd_needs_vsync_change(
  1252. phys_enc, profile_timestamp);
  1253. SDE_EVT32(DRMID(phys_enc->parent), switch_te, SDE_EVTLOG_FUNC_ENTRY);
  1254. if (switch_te) {
  1255. SDE_DEBUG_CMDENC(cmd_enc,
  1256. "wr_ptr_irq wait failed, retry with WD TE\n");
  1257. /* switch to watchdog TE and wait again */
  1258. sde_encoder_helper_switch_vsync(phys_enc->parent, true);
  1259. ret = _sde_encoder_phys_cmd_wait_for_wr_ptr(phys_enc);
  1260. /* switch back to default TE */
  1261. sde_encoder_helper_switch_vsync(phys_enc->parent, false);
  1262. }
  1263. /*
  1264. * Signaling the retire fence at wr_ptr timeout
  1265. * to allow the next commit and avoid device freeze.
  1266. */
  1267. if (ret == -ETIMEDOUT) {
  1268. SDE_ERROR_CMDENC(cmd_enc,
  1269. "wr_ptr_irq wait failed, switch_te:%d\n", switch_te);
  1270. SDE_EVT32(DRMID(phys_enc->parent), switch_te, SDE_EVTLOG_ERROR);
  1271. if (sde_encoder_phys_cmd_is_master(phys_enc) &&
  1272. atomic_add_unless(
  1273. &phys_enc->pending_retire_fence_cnt, -1, 0)) {
  1274. spin_lock_irqsave(phys_enc->enc_spinlock, lock_flags);
  1275. phys_enc->parent_ops.handle_frame_done(
  1276. phys_enc->parent, phys_enc,
  1277. SDE_ENCODER_FRAME_EVENT_SIGNAL_RETIRE_FENCE);
  1278. spin_unlock_irqrestore(phys_enc->enc_spinlock,
  1279. lock_flags);
  1280. }
  1281. }
  1282. cmd_enc->wr_ptr_wait_success = (ret == 0) ? true : false;
  1283. return ret;
  1284. }
  1285. static int sde_encoder_phys_cmd_wait_for_commit_done(
  1286. struct sde_encoder_phys *phys_enc)
  1287. {
  1288. int rc = 0, i, pending_cnt;
  1289. struct sde_encoder_phys_cmd *cmd_enc;
  1290. ktime_t profile_timestamp = ktime_get();
  1291. u32 scheduler_status = INVALID_CTL_STATUS;
  1292. struct sde_hw_ctl *ctl;
  1293. if (!phys_enc)
  1294. return -EINVAL;
  1295. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1296. /* only required for master controller */
  1297. if (sde_encoder_phys_cmd_is_master(phys_enc)) {
  1298. rc = _sde_encoder_phys_cmd_wait_for_wr_ptr(phys_enc);
  1299. if (rc == -ETIMEDOUT) {
  1300. /*
  1301. * Profile all the TE received after profile_timestamp
  1302. * and if the jitter is more, switch to watchdog TE
  1303. * and wait for wr_ptr again. Finally move back to
  1304. * default TE.
  1305. */
  1306. rc = _sde_encoder_phys_cmd_handle_wr_ptr_timeout(
  1307. phys_enc, profile_timestamp);
  1308. if (rc == -ETIMEDOUT)
  1309. goto wait_for_idle;
  1310. }
  1311. if (cmd_enc->autorefresh.cfg.enable)
  1312. rc = _sde_encoder_phys_cmd_wait_for_autorefresh_done(
  1313. phys_enc);
  1314. ctl = phys_enc->hw_ctl;
  1315. if (ctl && ctl->ops.get_scheduler_status)
  1316. scheduler_status = ctl->ops.get_scheduler_status(ctl);
  1317. }
  1318. /* wait for posted start or serialize trigger */
  1319. pending_cnt = atomic_read(&phys_enc->pending_kickoff_cnt);
  1320. if ((pending_cnt > 1) ||
  1321. (pending_cnt && (scheduler_status & BIT(0))) ||
  1322. (!rc && phys_enc->frame_trigger_mode == FRAME_DONE_WAIT_SERIALIZE))
  1323. goto wait_for_idle;
  1324. return rc;
  1325. wait_for_idle:
  1326. pending_cnt = atomic_read(&phys_enc->pending_kickoff_cnt);
  1327. for (i = 0; i < pending_cnt; i++)
  1328. rc |= sde_encoder_wait_for_event(phys_enc->parent,
  1329. MSM_ENC_TX_COMPLETE);
  1330. if (rc) {
  1331. SDE_EVT32(DRMID(phys_enc->parent),
  1332. phys_enc->hw_pp->idx - PINGPONG_0,
  1333. phys_enc->frame_trigger_mode,
  1334. atomic_read(&phys_enc->pending_kickoff_cnt),
  1335. phys_enc->enable_state,
  1336. cmd_enc->wr_ptr_wait_success, scheduler_status, rc);
  1337. SDE_ERROR("pp:%d failed wait_for_idle: %d\n",
  1338. phys_enc->hw_pp->idx - PINGPONG_0, rc);
  1339. if (phys_enc->enable_state == SDE_ENC_ERR_NEEDS_HW_RESET)
  1340. sde_encoder_helper_needs_hw_reset(phys_enc->parent);
  1341. }
  1342. return rc;
  1343. }
  1344. static int sde_encoder_phys_cmd_wait_for_vblank(
  1345. struct sde_encoder_phys *phys_enc)
  1346. {
  1347. int rc = 0;
  1348. struct sde_encoder_phys_cmd *cmd_enc;
  1349. struct sde_encoder_wait_info wait_info = {0};
  1350. if (!phys_enc)
  1351. return -EINVAL;
  1352. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1353. /* only required for master controller */
  1354. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  1355. return rc;
  1356. wait_info.wq = &cmd_enc->pending_vblank_wq;
  1357. wait_info.atomic_cnt = &cmd_enc->pending_vblank_cnt;
  1358. wait_info.timeout_ms = _sde_encoder_phys_cmd_get_idle_timeout(cmd_enc);
  1359. atomic_inc(&cmd_enc->pending_vblank_cnt);
  1360. rc = sde_encoder_helper_wait_for_irq(phys_enc, INTR_IDX_RDPTR,
  1361. &wait_info);
  1362. return rc;
  1363. }
  1364. static void sde_encoder_phys_cmd_update_split_role(
  1365. struct sde_encoder_phys *phys_enc,
  1366. enum sde_enc_split_role role)
  1367. {
  1368. struct sde_encoder_phys_cmd *cmd_enc;
  1369. enum sde_enc_split_role old_role;
  1370. bool is_ppsplit;
  1371. if (!phys_enc)
  1372. return;
  1373. cmd_enc = to_sde_encoder_phys_cmd(phys_enc);
  1374. old_role = phys_enc->split_role;
  1375. is_ppsplit = _sde_encoder_phys_is_ppsplit(phys_enc);
  1376. phys_enc->split_role = role;
  1377. SDE_DEBUG_CMDENC(cmd_enc, "old role %d new role %d\n",
  1378. old_role, role);
  1379. /*
  1380. * ppsplit solo needs to reprogram because intf may have swapped without
  1381. * role changing on left-only, right-only back-to-back commits
  1382. */
  1383. if (!(is_ppsplit && role == ENC_ROLE_SOLO) &&
  1384. (role == old_role || role == ENC_ROLE_SKIP))
  1385. return;
  1386. sde_encoder_helper_split_config(phys_enc, phys_enc->intf_idx);
  1387. _sde_encoder_phys_cmd_pingpong_config(phys_enc);
  1388. _sde_encoder_phys_cmd_update_flush_mask(phys_enc);
  1389. }
  1390. static void sde_encoder_phys_cmd_prepare_commit(
  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. int trial = 0;
  1396. if (!phys_enc)
  1397. return;
  1398. if (!sde_encoder_phys_cmd_is_master(phys_enc))
  1399. return;
  1400. SDE_EVT32(DRMID(phys_enc->parent), phys_enc->intf_idx - INTF_0,
  1401. cmd_enc->autorefresh.cfg.enable);
  1402. if (!sde_encoder_phys_cmd_is_autorefresh_enabled(phys_enc))
  1403. return;
  1404. /*
  1405. * If autorefresh is enabled, disable it and make sure it is safe to
  1406. * proceed with current frame commit/push. Sequence fallowed is,
  1407. * 1. Disable TE
  1408. * 2. Disable autorefresh config
  1409. * 4. Poll for frame transfer ongoing to be false
  1410. * 5. Enable TE back
  1411. */
  1412. sde_encoder_phys_cmd_connect_te(phys_enc, false);
  1413. _sde_encoder_phys_cmd_config_autorefresh(phys_enc, 0);
  1414. do {
  1415. udelay(SDE_ENC_MAX_POLL_TIMEOUT_US);
  1416. if ((trial * SDE_ENC_MAX_POLL_TIMEOUT_US)
  1417. > (KICKOFF_TIMEOUT_MS * USEC_PER_MSEC)) {
  1418. SDE_ERROR_CMDENC(cmd_enc,
  1419. "disable autorefresh failed\n");
  1420. break;
  1421. }
  1422. trial++;
  1423. } while (_sde_encoder_phys_cmd_is_ongoing_pptx(phys_enc));
  1424. sde_encoder_phys_cmd_connect_te(phys_enc, true);
  1425. SDE_DEBUG_CMDENC(cmd_enc, "disabled autorefresh\n");
  1426. }
  1427. static void sde_encoder_phys_cmd_trigger_start(
  1428. struct sde_encoder_phys *phys_enc)
  1429. {
  1430. struct sde_encoder_phys_cmd *cmd_enc =
  1431. to_sde_encoder_phys_cmd(phys_enc);
  1432. u32 frame_cnt;
  1433. if (!phys_enc)
  1434. return;
  1435. /* we don't issue CTL_START when using autorefresh */
  1436. frame_cnt = _sde_encoder_phys_cmd_get_autorefresh_property(phys_enc);
  1437. if (frame_cnt) {
  1438. _sde_encoder_phys_cmd_config_autorefresh(phys_enc, frame_cnt);
  1439. atomic_inc(&cmd_enc->autorefresh.kickoff_cnt);
  1440. } else {
  1441. sde_encoder_helper_trigger_start(phys_enc);
  1442. }
  1443. }
  1444. static void sde_encoder_phys_cmd_setup_vsync_source(
  1445. struct sde_encoder_phys *phys_enc,
  1446. u32 vsync_source, bool is_dummy)
  1447. {
  1448. if (!phys_enc || !phys_enc->hw_intf)
  1449. return;
  1450. sde_encoder_helper_vsync_config(phys_enc, vsync_source, is_dummy);
  1451. if (phys_enc->has_intf_te && phys_enc->hw_intf->ops.vsync_sel)
  1452. phys_enc->hw_intf->ops.vsync_sel(phys_enc->hw_intf,
  1453. vsync_source);
  1454. }
  1455. static void sde_encoder_phys_cmd_init_ops(struct sde_encoder_phys_ops *ops)
  1456. {
  1457. ops->prepare_commit = sde_encoder_phys_cmd_prepare_commit;
  1458. ops->is_master = sde_encoder_phys_cmd_is_master;
  1459. ops->mode_set = sde_encoder_phys_cmd_mode_set;
  1460. ops->cont_splash_mode_set = sde_encoder_phys_cmd_cont_splash_mode_set;
  1461. ops->mode_fixup = sde_encoder_phys_cmd_mode_fixup;
  1462. ops->enable = sde_encoder_phys_cmd_enable;
  1463. ops->disable = sde_encoder_phys_cmd_disable;
  1464. ops->destroy = sde_encoder_phys_cmd_destroy;
  1465. ops->get_hw_resources = sde_encoder_phys_cmd_get_hw_resources;
  1466. ops->control_vblank_irq = sde_encoder_phys_cmd_control_vblank_irq;
  1467. ops->wait_for_commit_done = sde_encoder_phys_cmd_wait_for_commit_done;
  1468. ops->prepare_for_kickoff = sde_encoder_phys_cmd_prepare_for_kickoff;
  1469. ops->wait_for_tx_complete = sde_encoder_phys_cmd_wait_for_tx_complete;
  1470. ops->wait_for_vblank = sde_encoder_phys_cmd_wait_for_vblank;
  1471. ops->trigger_flush = sde_encoder_helper_trigger_flush;
  1472. ops->trigger_start = sde_encoder_phys_cmd_trigger_start;
  1473. ops->needs_single_flush = sde_encoder_phys_needs_single_flush;
  1474. ops->hw_reset = sde_encoder_helper_hw_reset;
  1475. ops->irq_control = sde_encoder_phys_cmd_irq_control;
  1476. ops->update_split_role = sde_encoder_phys_cmd_update_split_role;
  1477. ops->restore = sde_encoder_phys_cmd_enable_helper;
  1478. ops->control_te = sde_encoder_phys_cmd_connect_te;
  1479. ops->is_autorefresh_enabled =
  1480. sde_encoder_phys_cmd_is_autorefresh_enabled;
  1481. ops->get_line_count = sde_encoder_phys_cmd_te_get_line_count;
  1482. ops->get_wr_line_count = sde_encoder_phys_cmd_get_write_line_count;
  1483. ops->wait_for_active = NULL;
  1484. ops->setup_vsync_source = sde_encoder_phys_cmd_setup_vsync_source;
  1485. ops->setup_misr = sde_encoder_helper_setup_misr;
  1486. ops->collect_misr = sde_encoder_helper_collect_misr;
  1487. }
  1488. static inline bool sde_encoder_phys_cmd_intf_te_supported(
  1489. const struct sde_mdss_cfg *sde_cfg, enum sde_intf idx)
  1490. {
  1491. if (sde_cfg && ((idx - INTF_0) < sde_cfg->intf_count))
  1492. return test_bit(SDE_INTF_TE,
  1493. &(sde_cfg->intf[idx - INTF_0].features));
  1494. return false;
  1495. }
  1496. struct sde_encoder_phys *sde_encoder_phys_cmd_init(
  1497. struct sde_enc_phys_init_params *p)
  1498. {
  1499. struct sde_encoder_phys *phys_enc = NULL;
  1500. struct sde_encoder_phys_cmd *cmd_enc = NULL;
  1501. struct sde_hw_mdp *hw_mdp;
  1502. struct sde_encoder_irq *irq;
  1503. int i, ret = 0;
  1504. SDE_DEBUG("intf %d\n", p->intf_idx - INTF_0);
  1505. cmd_enc = kzalloc(sizeof(*cmd_enc), GFP_KERNEL);
  1506. if (!cmd_enc) {
  1507. ret = -ENOMEM;
  1508. SDE_ERROR("failed to allocate\n");
  1509. goto fail;
  1510. }
  1511. phys_enc = &cmd_enc->base;
  1512. hw_mdp = sde_rm_get_mdp(&p->sde_kms->rm);
  1513. if (IS_ERR_OR_NULL(hw_mdp)) {
  1514. ret = PTR_ERR(hw_mdp);
  1515. SDE_ERROR("failed to get mdptop\n");
  1516. goto fail_mdp_init;
  1517. }
  1518. phys_enc->hw_mdptop = hw_mdp;
  1519. phys_enc->intf_idx = p->intf_idx;
  1520. phys_enc->parent = p->parent;
  1521. phys_enc->parent_ops = p->parent_ops;
  1522. phys_enc->sde_kms = p->sde_kms;
  1523. phys_enc->split_role = p->split_role;
  1524. phys_enc->intf_mode = INTF_MODE_CMD;
  1525. phys_enc->enc_spinlock = p->enc_spinlock;
  1526. phys_enc->vblank_ctl_lock = p->vblank_ctl_lock;
  1527. cmd_enc->stream_sel = 0;
  1528. phys_enc->enable_state = SDE_ENC_DISABLED;
  1529. sde_encoder_phys_cmd_init_ops(&phys_enc->ops);
  1530. phys_enc->comp_type = p->comp_type;
  1531. phys_enc->has_intf_te = sde_encoder_phys_cmd_intf_te_supported(
  1532. phys_enc->sde_kms->catalog, phys_enc->intf_idx);
  1533. for (i = 0; i < INTR_IDX_MAX; i++) {
  1534. irq = &phys_enc->irq[i];
  1535. INIT_LIST_HEAD(&irq->cb.list);
  1536. irq->irq_idx = -EINVAL;
  1537. irq->hw_idx = -EINVAL;
  1538. irq->cb.arg = phys_enc;
  1539. }
  1540. irq = &phys_enc->irq[INTR_IDX_CTL_START];
  1541. irq->name = "ctl_start";
  1542. irq->intr_type = SDE_IRQ_TYPE_CTL_START;
  1543. irq->intr_idx = INTR_IDX_CTL_START;
  1544. irq->cb.func = NULL;
  1545. irq = &phys_enc->irq[INTR_IDX_PINGPONG];
  1546. irq->name = "pp_done";
  1547. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_COMP;
  1548. irq->intr_idx = INTR_IDX_PINGPONG;
  1549. irq->cb.func = sde_encoder_phys_cmd_pp_tx_done_irq;
  1550. irq = &phys_enc->irq[INTR_IDX_RDPTR];
  1551. irq->intr_idx = INTR_IDX_RDPTR;
  1552. irq->name = "te_rd_ptr";
  1553. if (phys_enc->has_intf_te)
  1554. irq->intr_type = SDE_IRQ_TYPE_INTF_TEAR_RD_PTR;
  1555. else
  1556. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_RD_PTR;
  1557. irq->cb.func = sde_encoder_phys_cmd_te_rd_ptr_irq;
  1558. irq = &phys_enc->irq[INTR_IDX_UNDERRUN];
  1559. irq->name = "underrun";
  1560. irq->intr_type = SDE_IRQ_TYPE_INTF_UNDER_RUN;
  1561. irq->intr_idx = INTR_IDX_UNDERRUN;
  1562. irq->cb.func = sde_encoder_phys_cmd_underrun_irq;
  1563. irq = &phys_enc->irq[INTR_IDX_AUTOREFRESH_DONE];
  1564. irq->name = "autorefresh_done";
  1565. if (phys_enc->has_intf_te)
  1566. irq->intr_type = SDE_IRQ_TYPE_INTF_TEAR_AUTO_REF;
  1567. else
  1568. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_AUTO_REF;
  1569. irq->intr_idx = INTR_IDX_AUTOREFRESH_DONE;
  1570. irq->cb.func = sde_encoder_phys_cmd_autorefresh_done_irq;
  1571. irq = &phys_enc->irq[INTR_IDX_WRPTR];
  1572. irq->intr_idx = INTR_IDX_WRPTR;
  1573. irq->name = "wr_ptr";
  1574. if (phys_enc->has_intf_te)
  1575. irq->intr_type = SDE_IRQ_TYPE_INTF_TEAR_WR_PTR;
  1576. else
  1577. irq->intr_type = SDE_IRQ_TYPE_PING_PONG_WR_PTR;
  1578. irq->cb.func = sde_encoder_phys_cmd_wr_ptr_irq;
  1579. atomic_set(&phys_enc->vblank_refcount, 0);
  1580. atomic_set(&phys_enc->pending_kickoff_cnt, 0);
  1581. atomic_set(&phys_enc->pending_retire_fence_cnt, 0);
  1582. atomic_set(&cmd_enc->pending_vblank_cnt, 0);
  1583. init_waitqueue_head(&phys_enc->pending_kickoff_wq);
  1584. init_waitqueue_head(&cmd_enc->pending_vblank_wq);
  1585. atomic_set(&cmd_enc->autorefresh.kickoff_cnt, 0);
  1586. init_waitqueue_head(&cmd_enc->autorefresh.kickoff_wq);
  1587. INIT_LIST_HEAD(&cmd_enc->te_timestamp_list);
  1588. for (i = 0; i < MAX_TE_PROFILE_COUNT; i++)
  1589. list_add(&cmd_enc->te_timestamp[i].list,
  1590. &cmd_enc->te_timestamp_list);
  1591. SDE_DEBUG_CMDENC(cmd_enc, "created\n");
  1592. return phys_enc;
  1593. fail_mdp_init:
  1594. kfree(cmd_enc);
  1595. fail:
  1596. return ERR_PTR(ret);
  1597. }