mdp4_crtc.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659
  1. /*
  2. * Copyright (C) 2013 Red Hat
  3. * Author: Rob Clark <robdclark@gmail.com>
  4. *
  5. * This program is free software; you can redistribute it and/or modify it
  6. * under the terms of the GNU General Public License version 2 as published by
  7. * the Free Software Foundation.
  8. *
  9. * This program is distributed in the hope that it will be useful, but WITHOUT
  10. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12. * more details.
  13. *
  14. * You should have received a copy of the GNU General Public License along with
  15. * this program. If not, see <http://www.gnu.org/licenses/>.
  16. */
  17. #include "mdp4_kms.h"
  18. #include <drm/drm_mode.h>
  19. #include "drm_crtc.h"
  20. #include "drm_crtc_helper.h"
  21. #include "drm_flip_work.h"
  22. struct mdp4_crtc {
  23. struct drm_crtc base;
  24. char name[8];
  25. int id;
  26. int ovlp;
  27. enum mdp4_dma dma;
  28. bool enabled;
  29. /* which mixer/encoder we route output to: */
  30. int mixer;
  31. struct {
  32. spinlock_t lock;
  33. bool stale;
  34. uint32_t width, height;
  35. uint32_t x, y;
  36. /* next cursor to scan-out: */
  37. uint32_t next_iova;
  38. struct drm_gem_object *next_bo;
  39. /* current cursor being scanned out: */
  40. struct drm_gem_object *scanout_bo;
  41. } cursor;
  42. /* if there is a pending flip, these will be non-null: */
  43. struct drm_pending_vblank_event *event;
  44. /* Bits have been flushed at the last commit,
  45. * used to decide if a vsync has happened since last commit.
  46. */
  47. u32 flushed_mask;
  48. #define PENDING_CURSOR 0x1
  49. #define PENDING_FLIP 0x2
  50. atomic_t pending;
  51. /* for unref'ing cursor bo's after scanout completes: */
  52. struct drm_flip_work unref_cursor_work;
  53. struct mdp_irq vblank;
  54. struct mdp_irq err;
  55. };
  56. #define to_mdp4_crtc(x) container_of(x, struct mdp4_crtc, base)
  57. static struct mdp4_kms *get_kms(struct drm_crtc *crtc)
  58. {
  59. struct msm_drm_private *priv = crtc->dev->dev_private;
  60. return to_mdp4_kms(to_mdp_kms(priv->kms));
  61. }
  62. static void request_pending(struct drm_crtc *crtc, uint32_t pending)
  63. {
  64. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  65. atomic_or(pending, &mdp4_crtc->pending);
  66. mdp_irq_register(&get_kms(crtc)->base, &mdp4_crtc->vblank);
  67. }
  68. static void crtc_flush(struct drm_crtc *crtc)
  69. {
  70. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  71. struct mdp4_kms *mdp4_kms = get_kms(crtc);
  72. struct drm_plane *plane;
  73. uint32_t flush = 0;
  74. drm_atomic_crtc_for_each_plane(plane, crtc) {
  75. enum mdp4_pipe pipe_id = mdp4_plane_pipe(plane);
  76. flush |= pipe2flush(pipe_id);
  77. }
  78. flush |= ovlp2flush(mdp4_crtc->ovlp);
  79. DBG("%s: flush=%08x", mdp4_crtc->name, flush);
  80. mdp4_crtc->flushed_mask = flush;
  81. mdp4_write(mdp4_kms, REG_MDP4_OVERLAY_FLUSH, flush);
  82. }
  83. /* if file!=NULL, this is preclose potential cancel-flip path */
  84. static void complete_flip(struct drm_crtc *crtc, struct drm_file *file)
  85. {
  86. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  87. struct drm_device *dev = crtc->dev;
  88. struct drm_pending_vblank_event *event;
  89. unsigned long flags;
  90. spin_lock_irqsave(&dev->event_lock, flags);
  91. event = mdp4_crtc->event;
  92. if (event) {
  93. mdp4_crtc->event = NULL;
  94. DBG("%s: send event: %p", mdp4_crtc->name, event);
  95. drm_crtc_send_vblank_event(crtc, event);
  96. }
  97. spin_unlock_irqrestore(&dev->event_lock, flags);
  98. }
  99. static void unref_cursor_worker(struct drm_flip_work *work, void *val)
  100. {
  101. struct mdp4_crtc *mdp4_crtc =
  102. container_of(work, struct mdp4_crtc, unref_cursor_work);
  103. struct mdp4_kms *mdp4_kms = get_kms(&mdp4_crtc->base);
  104. msm_gem_put_iova(val, mdp4_kms->id);
  105. drm_gem_object_unreference_unlocked(val);
  106. }
  107. static void mdp4_crtc_destroy(struct drm_crtc *crtc)
  108. {
  109. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  110. drm_crtc_cleanup(crtc);
  111. drm_flip_work_cleanup(&mdp4_crtc->unref_cursor_work);
  112. kfree(mdp4_crtc);
  113. }
  114. /* statically (for now) map planes to mixer stage (z-order): */
  115. static const int idxs[] = {
  116. [VG1] = 1,
  117. [VG2] = 2,
  118. [RGB1] = 0,
  119. [RGB2] = 0,
  120. [RGB3] = 0,
  121. [VG3] = 3,
  122. [VG4] = 4,
  123. };
  124. /* setup mixer config, for which we need to consider all crtc's and
  125. * the planes attached to them
  126. *
  127. * TODO may possibly need some extra locking here
  128. */
  129. static void setup_mixer(struct mdp4_kms *mdp4_kms)
  130. {
  131. struct drm_mode_config *config = &mdp4_kms->dev->mode_config;
  132. struct drm_crtc *crtc;
  133. uint32_t mixer_cfg = 0;
  134. static const enum mdp_mixer_stage_id stages[] = {
  135. STAGE_BASE, STAGE0, STAGE1, STAGE2, STAGE3,
  136. };
  137. list_for_each_entry(crtc, &config->crtc_list, head) {
  138. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  139. struct drm_plane *plane;
  140. drm_atomic_crtc_for_each_plane(plane, crtc) {
  141. enum mdp4_pipe pipe_id = mdp4_plane_pipe(plane);
  142. int idx = idxs[pipe_id];
  143. mixer_cfg = mixercfg(mixer_cfg, mdp4_crtc->mixer,
  144. pipe_id, stages[idx]);
  145. }
  146. }
  147. mdp4_write(mdp4_kms, REG_MDP4_LAYERMIXER_IN_CFG, mixer_cfg);
  148. }
  149. static void blend_setup(struct drm_crtc *crtc)
  150. {
  151. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  152. struct mdp4_kms *mdp4_kms = get_kms(crtc);
  153. struct drm_plane *plane;
  154. int i, ovlp = mdp4_crtc->ovlp;
  155. bool alpha[4]= { false, false, false, false };
  156. mdp4_write(mdp4_kms, REG_MDP4_OVLP_TRANSP_LOW0(ovlp), 0);
  157. mdp4_write(mdp4_kms, REG_MDP4_OVLP_TRANSP_LOW1(ovlp), 0);
  158. mdp4_write(mdp4_kms, REG_MDP4_OVLP_TRANSP_HIGH0(ovlp), 0);
  159. mdp4_write(mdp4_kms, REG_MDP4_OVLP_TRANSP_HIGH1(ovlp), 0);
  160. drm_atomic_crtc_for_each_plane(plane, crtc) {
  161. enum mdp4_pipe pipe_id = mdp4_plane_pipe(plane);
  162. int idx = idxs[pipe_id];
  163. if (idx > 0) {
  164. const struct mdp_format *format =
  165. to_mdp_format(msm_framebuffer_format(plane->fb));
  166. alpha[idx-1] = format->alpha_enable;
  167. }
  168. }
  169. for (i = 0; i < 4; i++) {
  170. uint32_t op;
  171. if (alpha[i]) {
  172. op = MDP4_OVLP_STAGE_OP_FG_ALPHA(FG_PIXEL) |
  173. MDP4_OVLP_STAGE_OP_BG_ALPHA(FG_PIXEL) |
  174. MDP4_OVLP_STAGE_OP_BG_INV_ALPHA;
  175. } else {
  176. op = MDP4_OVLP_STAGE_OP_FG_ALPHA(FG_CONST) |
  177. MDP4_OVLP_STAGE_OP_BG_ALPHA(BG_CONST);
  178. }
  179. mdp4_write(mdp4_kms, REG_MDP4_OVLP_STAGE_FG_ALPHA(ovlp, i), 0xff);
  180. mdp4_write(mdp4_kms, REG_MDP4_OVLP_STAGE_BG_ALPHA(ovlp, i), 0x00);
  181. mdp4_write(mdp4_kms, REG_MDP4_OVLP_STAGE_OP(ovlp, i), op);
  182. mdp4_write(mdp4_kms, REG_MDP4_OVLP_STAGE_CO3(ovlp, i), 1);
  183. mdp4_write(mdp4_kms, REG_MDP4_OVLP_STAGE_TRANSP_LOW0(ovlp, i), 0);
  184. mdp4_write(mdp4_kms, REG_MDP4_OVLP_STAGE_TRANSP_LOW1(ovlp, i), 0);
  185. mdp4_write(mdp4_kms, REG_MDP4_OVLP_STAGE_TRANSP_HIGH0(ovlp, i), 0);
  186. mdp4_write(mdp4_kms, REG_MDP4_OVLP_STAGE_TRANSP_HIGH1(ovlp, i), 0);
  187. }
  188. setup_mixer(mdp4_kms);
  189. }
  190. static void mdp4_crtc_mode_set_nofb(struct drm_crtc *crtc)
  191. {
  192. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  193. struct mdp4_kms *mdp4_kms = get_kms(crtc);
  194. enum mdp4_dma dma = mdp4_crtc->dma;
  195. int ovlp = mdp4_crtc->ovlp;
  196. struct drm_display_mode *mode;
  197. if (WARN_ON(!crtc->state))
  198. return;
  199. mode = &crtc->state->adjusted_mode;
  200. DBG("%s: set mode: %d:\"%s\" %d %d %d %d %d %d %d %d %d %d 0x%x 0x%x",
  201. mdp4_crtc->name, mode->base.id, mode->name,
  202. mode->vrefresh, mode->clock,
  203. mode->hdisplay, mode->hsync_start,
  204. mode->hsync_end, mode->htotal,
  205. mode->vdisplay, mode->vsync_start,
  206. mode->vsync_end, mode->vtotal,
  207. mode->type, mode->flags);
  208. mdp4_write(mdp4_kms, REG_MDP4_DMA_SRC_SIZE(dma),
  209. MDP4_DMA_SRC_SIZE_WIDTH(mode->hdisplay) |
  210. MDP4_DMA_SRC_SIZE_HEIGHT(mode->vdisplay));
  211. /* take data from pipe: */
  212. mdp4_write(mdp4_kms, REG_MDP4_DMA_SRC_BASE(dma), 0);
  213. mdp4_write(mdp4_kms, REG_MDP4_DMA_SRC_STRIDE(dma), 0);
  214. mdp4_write(mdp4_kms, REG_MDP4_DMA_DST_SIZE(dma),
  215. MDP4_DMA_DST_SIZE_WIDTH(0) |
  216. MDP4_DMA_DST_SIZE_HEIGHT(0));
  217. mdp4_write(mdp4_kms, REG_MDP4_OVLP_BASE(ovlp), 0);
  218. mdp4_write(mdp4_kms, REG_MDP4_OVLP_SIZE(ovlp),
  219. MDP4_OVLP_SIZE_WIDTH(mode->hdisplay) |
  220. MDP4_OVLP_SIZE_HEIGHT(mode->vdisplay));
  221. mdp4_write(mdp4_kms, REG_MDP4_OVLP_STRIDE(ovlp), 0);
  222. mdp4_write(mdp4_kms, REG_MDP4_OVLP_CFG(ovlp), 1);
  223. if (dma == DMA_E) {
  224. mdp4_write(mdp4_kms, REG_MDP4_DMA_E_QUANT(0), 0x00ff0000);
  225. mdp4_write(mdp4_kms, REG_MDP4_DMA_E_QUANT(1), 0x00ff0000);
  226. mdp4_write(mdp4_kms, REG_MDP4_DMA_E_QUANT(2), 0x00ff0000);
  227. }
  228. }
  229. static void mdp4_crtc_disable(struct drm_crtc *crtc)
  230. {
  231. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  232. struct mdp4_kms *mdp4_kms = get_kms(crtc);
  233. DBG("%s", mdp4_crtc->name);
  234. if (WARN_ON(!mdp4_crtc->enabled))
  235. return;
  236. mdp_irq_unregister(&mdp4_kms->base, &mdp4_crtc->err);
  237. mdp4_disable(mdp4_kms);
  238. mdp4_crtc->enabled = false;
  239. }
  240. static void mdp4_crtc_enable(struct drm_crtc *crtc)
  241. {
  242. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  243. struct mdp4_kms *mdp4_kms = get_kms(crtc);
  244. DBG("%s", mdp4_crtc->name);
  245. if (WARN_ON(mdp4_crtc->enabled))
  246. return;
  247. mdp4_enable(mdp4_kms);
  248. mdp_irq_register(&mdp4_kms->base, &mdp4_crtc->err);
  249. crtc_flush(crtc);
  250. mdp4_crtc->enabled = true;
  251. }
  252. static int mdp4_crtc_atomic_check(struct drm_crtc *crtc,
  253. struct drm_crtc_state *state)
  254. {
  255. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  256. DBG("%s: check", mdp4_crtc->name);
  257. // TODO anything else to check?
  258. return 0;
  259. }
  260. static void mdp4_crtc_atomic_begin(struct drm_crtc *crtc,
  261. struct drm_crtc_state *old_crtc_state)
  262. {
  263. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  264. DBG("%s: begin", mdp4_crtc->name);
  265. }
  266. static void mdp4_crtc_atomic_flush(struct drm_crtc *crtc,
  267. struct drm_crtc_state *old_crtc_state)
  268. {
  269. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  270. struct drm_device *dev = crtc->dev;
  271. unsigned long flags;
  272. DBG("%s: event: %p", mdp4_crtc->name, crtc->state->event);
  273. WARN_ON(mdp4_crtc->event);
  274. spin_lock_irqsave(&dev->event_lock, flags);
  275. mdp4_crtc->event = crtc->state->event;
  276. spin_unlock_irqrestore(&dev->event_lock, flags);
  277. blend_setup(crtc);
  278. crtc_flush(crtc);
  279. request_pending(crtc, PENDING_FLIP);
  280. }
  281. #define CURSOR_WIDTH 64
  282. #define CURSOR_HEIGHT 64
  283. /* called from IRQ to update cursor related registers (if needed). The
  284. * cursor registers, other than x/y position, appear not to be double
  285. * buffered, and changing them other than from vblank seems to trigger
  286. * underflow.
  287. */
  288. static void update_cursor(struct drm_crtc *crtc)
  289. {
  290. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  291. struct mdp4_kms *mdp4_kms = get_kms(crtc);
  292. enum mdp4_dma dma = mdp4_crtc->dma;
  293. unsigned long flags;
  294. spin_lock_irqsave(&mdp4_crtc->cursor.lock, flags);
  295. if (mdp4_crtc->cursor.stale) {
  296. struct drm_gem_object *next_bo = mdp4_crtc->cursor.next_bo;
  297. struct drm_gem_object *prev_bo = mdp4_crtc->cursor.scanout_bo;
  298. uint64_t iova = mdp4_crtc->cursor.next_iova;
  299. if (next_bo) {
  300. /* take a obj ref + iova ref when we start scanning out: */
  301. drm_gem_object_reference(next_bo);
  302. msm_gem_get_iova_locked(next_bo, mdp4_kms->id, &iova);
  303. /* enable cursor: */
  304. mdp4_write(mdp4_kms, REG_MDP4_DMA_CURSOR_SIZE(dma),
  305. MDP4_DMA_CURSOR_SIZE_WIDTH(mdp4_crtc->cursor.width) |
  306. MDP4_DMA_CURSOR_SIZE_HEIGHT(mdp4_crtc->cursor.height));
  307. mdp4_write(mdp4_kms, REG_MDP4_DMA_CURSOR_BASE(dma), iova);
  308. mdp4_write(mdp4_kms, REG_MDP4_DMA_CURSOR_BLEND_CONFIG(dma),
  309. MDP4_DMA_CURSOR_BLEND_CONFIG_FORMAT(CURSOR_ARGB) |
  310. MDP4_DMA_CURSOR_BLEND_CONFIG_CURSOR_EN);
  311. } else {
  312. /* disable cursor: */
  313. mdp4_write(mdp4_kms, REG_MDP4_DMA_CURSOR_BASE(dma),
  314. mdp4_kms->blank_cursor_iova);
  315. }
  316. /* and drop the iova ref + obj rev when done scanning out: */
  317. if (prev_bo)
  318. drm_flip_work_queue(&mdp4_crtc->unref_cursor_work, prev_bo);
  319. mdp4_crtc->cursor.scanout_bo = next_bo;
  320. mdp4_crtc->cursor.stale = false;
  321. }
  322. mdp4_write(mdp4_kms, REG_MDP4_DMA_CURSOR_POS(dma),
  323. MDP4_DMA_CURSOR_POS_X(mdp4_crtc->cursor.x) |
  324. MDP4_DMA_CURSOR_POS_Y(mdp4_crtc->cursor.y));
  325. spin_unlock_irqrestore(&mdp4_crtc->cursor.lock, flags);
  326. }
  327. static int mdp4_crtc_cursor_set(struct drm_crtc *crtc,
  328. struct drm_file *file_priv, uint32_t handle,
  329. uint32_t width, uint32_t height)
  330. {
  331. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  332. struct mdp4_kms *mdp4_kms = get_kms(crtc);
  333. struct drm_device *dev = crtc->dev;
  334. struct drm_gem_object *cursor_bo, *old_bo;
  335. unsigned long flags;
  336. uint64_t iova;
  337. int ret;
  338. if ((width > CURSOR_WIDTH) || (height > CURSOR_HEIGHT)) {
  339. dev_err(dev->dev, "bad cursor size: %dx%d\n", width, height);
  340. return -EINVAL;
  341. }
  342. if (handle) {
  343. cursor_bo = drm_gem_object_lookup(file_priv, handle);
  344. if (!cursor_bo)
  345. return -ENOENT;
  346. } else {
  347. cursor_bo = NULL;
  348. }
  349. if (cursor_bo) {
  350. ret = msm_gem_get_iova(cursor_bo, mdp4_kms->id, &iova);
  351. if (ret)
  352. goto fail;
  353. } else {
  354. iova = 0;
  355. }
  356. spin_lock_irqsave(&mdp4_crtc->cursor.lock, flags);
  357. old_bo = mdp4_crtc->cursor.next_bo;
  358. mdp4_crtc->cursor.next_bo = cursor_bo;
  359. mdp4_crtc->cursor.next_iova = iova;
  360. mdp4_crtc->cursor.width = width;
  361. mdp4_crtc->cursor.height = height;
  362. mdp4_crtc->cursor.stale = true;
  363. spin_unlock_irqrestore(&mdp4_crtc->cursor.lock, flags);
  364. if (old_bo) {
  365. /* drop our previous reference: */
  366. drm_flip_work_queue(&mdp4_crtc->unref_cursor_work, old_bo);
  367. }
  368. request_pending(crtc, PENDING_CURSOR);
  369. return 0;
  370. fail:
  371. drm_gem_object_unreference_unlocked(cursor_bo);
  372. return ret;
  373. }
  374. static int mdp4_crtc_cursor_move(struct drm_crtc *crtc, int x, int y)
  375. {
  376. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  377. unsigned long flags;
  378. spin_lock_irqsave(&mdp4_crtc->cursor.lock, flags);
  379. mdp4_crtc->cursor.x = x;
  380. mdp4_crtc->cursor.y = y;
  381. spin_unlock_irqrestore(&mdp4_crtc->cursor.lock, flags);
  382. crtc_flush(crtc);
  383. request_pending(crtc, PENDING_CURSOR);
  384. return 0;
  385. }
  386. static const struct drm_crtc_funcs mdp4_crtc_funcs = {
  387. .set_config = drm_atomic_helper_set_config,
  388. .destroy = mdp4_crtc_destroy,
  389. .page_flip = drm_atomic_helper_page_flip,
  390. .set_property = drm_atomic_helper_crtc_set_property,
  391. .cursor_set = mdp4_crtc_cursor_set,
  392. .cursor_move = mdp4_crtc_cursor_move,
  393. .reset = drm_atomic_helper_crtc_reset,
  394. .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
  395. .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
  396. };
  397. static const struct drm_crtc_helper_funcs mdp4_crtc_helper_funcs = {
  398. .mode_set_nofb = mdp4_crtc_mode_set_nofb,
  399. .disable = mdp4_crtc_disable,
  400. .enable = mdp4_crtc_enable,
  401. .atomic_check = mdp4_crtc_atomic_check,
  402. .atomic_begin = mdp4_crtc_atomic_begin,
  403. .atomic_flush = mdp4_crtc_atomic_flush,
  404. };
  405. static void mdp4_crtc_vblank_irq(struct mdp_irq *irq, uint32_t irqstatus)
  406. {
  407. struct mdp4_crtc *mdp4_crtc = container_of(irq, struct mdp4_crtc, vblank);
  408. struct drm_crtc *crtc = &mdp4_crtc->base;
  409. struct msm_drm_private *priv = crtc->dev->dev_private;
  410. unsigned pending;
  411. mdp_irq_unregister(&get_kms(crtc)->base, &mdp4_crtc->vblank);
  412. pending = atomic_xchg(&mdp4_crtc->pending, 0);
  413. if (pending & PENDING_FLIP) {
  414. complete_flip(crtc, NULL);
  415. }
  416. if (pending & PENDING_CURSOR) {
  417. update_cursor(crtc);
  418. drm_flip_work_commit(&mdp4_crtc->unref_cursor_work, priv->wq);
  419. }
  420. }
  421. static void mdp4_crtc_err_irq(struct mdp_irq *irq, uint32_t irqstatus)
  422. {
  423. struct mdp4_crtc *mdp4_crtc = container_of(irq, struct mdp4_crtc, err);
  424. struct drm_crtc *crtc = &mdp4_crtc->base;
  425. DBG("%s: error: %08x", mdp4_crtc->name, irqstatus);
  426. crtc_flush(crtc);
  427. }
  428. static void mdp4_crtc_wait_for_flush_done(struct drm_crtc *crtc)
  429. {
  430. struct drm_device *dev = crtc->dev;
  431. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  432. struct mdp4_kms *mdp4_kms = get_kms(crtc);
  433. int ret;
  434. ret = drm_crtc_vblank_get(crtc);
  435. if (ret)
  436. return;
  437. ret = wait_event_timeout(dev->vblank[drm_crtc_index(crtc)].queue,
  438. !(mdp4_read(mdp4_kms, REG_MDP4_OVERLAY_FLUSH) &
  439. mdp4_crtc->flushed_mask),
  440. msecs_to_jiffies(50));
  441. if (ret <= 0)
  442. dev_warn(dev->dev, "vblank time out, crtc=%d\n", mdp4_crtc->id);
  443. mdp4_crtc->flushed_mask = 0;
  444. drm_crtc_vblank_put(crtc);
  445. }
  446. uint32_t mdp4_crtc_vblank(struct drm_crtc *crtc)
  447. {
  448. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  449. return mdp4_crtc->vblank.irqmask;
  450. }
  451. /* set dma config, ie. the format the encoder wants. */
  452. void mdp4_crtc_set_config(struct drm_crtc *crtc, uint32_t config)
  453. {
  454. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  455. struct mdp4_kms *mdp4_kms = get_kms(crtc);
  456. mdp4_write(mdp4_kms, REG_MDP4_DMA_CONFIG(mdp4_crtc->dma), config);
  457. }
  458. /* set interface for routing crtc->encoder: */
  459. void mdp4_crtc_set_intf(struct drm_crtc *crtc, enum mdp4_intf intf, int mixer)
  460. {
  461. struct mdp4_crtc *mdp4_crtc = to_mdp4_crtc(crtc);
  462. struct mdp4_kms *mdp4_kms = get_kms(crtc);
  463. uint32_t intf_sel;
  464. intf_sel = mdp4_read(mdp4_kms, REG_MDP4_DISP_INTF_SEL);
  465. switch (mdp4_crtc->dma) {
  466. case DMA_P:
  467. intf_sel &= ~MDP4_DISP_INTF_SEL_PRIM__MASK;
  468. intf_sel |= MDP4_DISP_INTF_SEL_PRIM(intf);
  469. break;
  470. case DMA_S:
  471. intf_sel &= ~MDP4_DISP_INTF_SEL_SEC__MASK;
  472. intf_sel |= MDP4_DISP_INTF_SEL_SEC(intf);
  473. break;
  474. case DMA_E:
  475. intf_sel &= ~MDP4_DISP_INTF_SEL_EXT__MASK;
  476. intf_sel |= MDP4_DISP_INTF_SEL_EXT(intf);
  477. break;
  478. }
  479. if (intf == INTF_DSI_VIDEO) {
  480. intf_sel &= ~MDP4_DISP_INTF_SEL_DSI_CMD;
  481. intf_sel |= MDP4_DISP_INTF_SEL_DSI_VIDEO;
  482. } else if (intf == INTF_DSI_CMD) {
  483. intf_sel &= ~MDP4_DISP_INTF_SEL_DSI_VIDEO;
  484. intf_sel |= MDP4_DISP_INTF_SEL_DSI_CMD;
  485. }
  486. mdp4_crtc->mixer = mixer;
  487. blend_setup(crtc);
  488. DBG("%s: intf_sel=%08x", mdp4_crtc->name, intf_sel);
  489. mdp4_write(mdp4_kms, REG_MDP4_DISP_INTF_SEL, intf_sel);
  490. }
  491. void mdp4_crtc_wait_for_commit_done(struct drm_crtc *crtc)
  492. {
  493. /* wait_for_flush_done is the only case for now.
  494. * Later we will have command mode CRTC to wait for
  495. * other event.
  496. */
  497. mdp4_crtc_wait_for_flush_done(crtc);
  498. }
  499. static const char *dma_names[] = {
  500. "DMA_P", "DMA_S", "DMA_E",
  501. };
  502. /* initialize crtc */
  503. struct drm_crtc *mdp4_crtc_init(struct drm_device *dev,
  504. struct drm_plane *plane, int id, int ovlp_id,
  505. enum mdp4_dma dma_id)
  506. {
  507. struct drm_crtc *crtc = NULL;
  508. struct mdp4_crtc *mdp4_crtc;
  509. mdp4_crtc = kzalloc(sizeof(*mdp4_crtc), GFP_KERNEL);
  510. if (!mdp4_crtc)
  511. return ERR_PTR(-ENOMEM);
  512. crtc = &mdp4_crtc->base;
  513. mdp4_crtc->id = id;
  514. mdp4_crtc->ovlp = ovlp_id;
  515. mdp4_crtc->dma = dma_id;
  516. mdp4_crtc->vblank.irqmask = dma2irq(mdp4_crtc->dma);
  517. mdp4_crtc->vblank.irq = mdp4_crtc_vblank_irq;
  518. mdp4_crtc->err.irqmask = dma2err(mdp4_crtc->dma);
  519. mdp4_crtc->err.irq = mdp4_crtc_err_irq;
  520. snprintf(mdp4_crtc->name, sizeof(mdp4_crtc->name), "%s:%d",
  521. dma_names[dma_id], ovlp_id);
  522. spin_lock_init(&mdp4_crtc->cursor.lock);
  523. drm_flip_work_init(&mdp4_crtc->unref_cursor_work,
  524. "unref cursor", unref_cursor_worker);
  525. drm_crtc_init_with_planes(dev, crtc, plane, NULL, &mdp4_crtc_funcs,
  526. NULL);
  527. drm_crtc_helper_add(crtc, &mdp4_crtc_helper_funcs);
  528. plane->crtc = crtc;
  529. return crtc;
  530. }