exynos5433_drm_decon.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725
  1. /* drivers/gpu/drm/exynos5433_drm_decon.c
  2. *
  3. * Copyright (C) 2015 Samsung Electronics Co.Ltd
  4. * Authors:
  5. * Joonyoung Shim <jy0922.shim@samsung.com>
  6. * Hyungwon Hwang <human.hwang@samsung.com>
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License version 2 as
  10. * published by the Free Software Foundationr
  11. */
  12. #include <linux/platform_device.h>
  13. #include <linux/clk.h>
  14. #include <linux/component.h>
  15. #include <linux/of_device.h>
  16. #include <linux/of_gpio.h>
  17. #include <linux/pm_runtime.h>
  18. #include <video/exynos5433_decon.h>
  19. #include "exynos_drm_drv.h"
  20. #include "exynos_drm_crtc.h"
  21. #include "exynos_drm_fb.h"
  22. #include "exynos_drm_plane.h"
  23. #include "exynos_drm_iommu.h"
  24. #define WINDOWS_NR 3
  25. #define MIN_FB_WIDTH_FOR_16WORD_BURST 128
  26. static const char * const decon_clks_name[] = {
  27. "pclk",
  28. "aclk_decon",
  29. "aclk_smmu_decon0x",
  30. "aclk_xiu_decon0x",
  31. "pclk_smmu_decon0x",
  32. "sclk_decon_vclk",
  33. "sclk_decon_eclk",
  34. };
  35. enum decon_iftype {
  36. IFTYPE_RGB,
  37. IFTYPE_I80,
  38. IFTYPE_HDMI
  39. };
  40. enum decon_flag_bits {
  41. BIT_CLKS_ENABLED,
  42. BIT_IRQS_ENABLED,
  43. BIT_WIN_UPDATED,
  44. BIT_SUSPENDED
  45. };
  46. struct decon_context {
  47. struct device *dev;
  48. struct drm_device *drm_dev;
  49. struct exynos_drm_crtc *crtc;
  50. struct exynos_drm_plane planes[WINDOWS_NR];
  51. struct exynos_drm_plane_config configs[WINDOWS_NR];
  52. void __iomem *addr;
  53. struct clk *clks[ARRAY_SIZE(decon_clks_name)];
  54. int pipe;
  55. unsigned long flags;
  56. enum decon_iftype out_type;
  57. int first_win;
  58. };
  59. static const uint32_t decon_formats[] = {
  60. DRM_FORMAT_XRGB1555,
  61. DRM_FORMAT_RGB565,
  62. DRM_FORMAT_XRGB8888,
  63. DRM_FORMAT_ARGB8888,
  64. };
  65. static const enum drm_plane_type decon_win_types[WINDOWS_NR] = {
  66. DRM_PLANE_TYPE_PRIMARY,
  67. DRM_PLANE_TYPE_OVERLAY,
  68. DRM_PLANE_TYPE_CURSOR,
  69. };
  70. static inline void decon_set_bits(struct decon_context *ctx, u32 reg, u32 mask,
  71. u32 val)
  72. {
  73. val = (val & mask) | (readl(ctx->addr + reg) & ~mask);
  74. writel(val, ctx->addr + reg);
  75. }
  76. static int decon_enable_vblank(struct exynos_drm_crtc *crtc)
  77. {
  78. struct decon_context *ctx = crtc->ctx;
  79. u32 val;
  80. if (test_bit(BIT_SUSPENDED, &ctx->flags))
  81. return -EPERM;
  82. if (test_and_set_bit(BIT_IRQS_ENABLED, &ctx->flags)) {
  83. val = VIDINTCON0_INTEN;
  84. if (ctx->out_type == IFTYPE_I80)
  85. val |= VIDINTCON0_FRAMEDONE;
  86. else
  87. val |= VIDINTCON0_INTFRMEN;
  88. writel(val, ctx->addr + DECON_VIDINTCON0);
  89. }
  90. return 0;
  91. }
  92. static void decon_disable_vblank(struct exynos_drm_crtc *crtc)
  93. {
  94. struct decon_context *ctx = crtc->ctx;
  95. if (test_bit(BIT_SUSPENDED, &ctx->flags))
  96. return;
  97. if (test_and_clear_bit(BIT_IRQS_ENABLED, &ctx->flags))
  98. writel(0, ctx->addr + DECON_VIDINTCON0);
  99. }
  100. static void decon_setup_trigger(struct decon_context *ctx)
  101. {
  102. u32 val = (ctx->out_type != IFTYPE_HDMI)
  103. ? TRIGCON_TRIGEN_PER_F | TRIGCON_TRIGEN_F |
  104. TRIGCON_TE_AUTO_MASK | TRIGCON_SWTRIGEN
  105. : TRIGCON_TRIGEN_PER_F | TRIGCON_TRIGEN_F |
  106. TRIGCON_HWTRIGMASK_I80_RGB | TRIGCON_HWTRIGEN_I80_RGB;
  107. writel(val, ctx->addr + DECON_TRIGCON);
  108. }
  109. static void decon_commit(struct exynos_drm_crtc *crtc)
  110. {
  111. struct decon_context *ctx = crtc->ctx;
  112. struct drm_display_mode *m = &crtc->base.mode;
  113. u32 val;
  114. if (test_bit(BIT_SUSPENDED, &ctx->flags))
  115. return;
  116. if (ctx->out_type == IFTYPE_HDMI) {
  117. m->crtc_hsync_start = m->crtc_hdisplay + 10;
  118. m->crtc_hsync_end = m->crtc_htotal - 92;
  119. m->crtc_vsync_start = m->crtc_vdisplay + 1;
  120. m->crtc_vsync_end = m->crtc_vsync_start + 1;
  121. }
  122. decon_set_bits(ctx, DECON_VIDCON0, VIDCON0_ENVID, 0);
  123. /* enable clock gate */
  124. val = CMU_CLKGAGE_MODE_SFR_F | CMU_CLKGAGE_MODE_MEM_F;
  125. writel(val, ctx->addr + DECON_CMU);
  126. /* lcd on and use command if */
  127. val = VIDOUT_LCD_ON;
  128. if (ctx->out_type == IFTYPE_I80)
  129. val |= VIDOUT_COMMAND_IF;
  130. else
  131. val |= VIDOUT_RGB_IF;
  132. writel(val, ctx->addr + DECON_VIDOUTCON0);
  133. val = VIDTCON2_LINEVAL(m->vdisplay - 1) |
  134. VIDTCON2_HOZVAL(m->hdisplay - 1);
  135. writel(val, ctx->addr + DECON_VIDTCON2);
  136. if (ctx->out_type != IFTYPE_I80) {
  137. val = VIDTCON00_VBPD_F(
  138. m->crtc_vtotal - m->crtc_vsync_end - 1) |
  139. VIDTCON00_VFPD_F(
  140. m->crtc_vsync_start - m->crtc_vdisplay - 1);
  141. writel(val, ctx->addr + DECON_VIDTCON00);
  142. val = VIDTCON01_VSPW_F(
  143. m->crtc_vsync_end - m->crtc_vsync_start - 1);
  144. writel(val, ctx->addr + DECON_VIDTCON01);
  145. val = VIDTCON10_HBPD_F(
  146. m->crtc_htotal - m->crtc_hsync_end - 1) |
  147. VIDTCON10_HFPD_F(
  148. m->crtc_hsync_start - m->crtc_hdisplay - 1);
  149. writel(val, ctx->addr + DECON_VIDTCON10);
  150. val = VIDTCON11_HSPW_F(
  151. m->crtc_hsync_end - m->crtc_hsync_start - 1);
  152. writel(val, ctx->addr + DECON_VIDTCON11);
  153. }
  154. decon_setup_trigger(ctx);
  155. /* enable output and display signal */
  156. decon_set_bits(ctx, DECON_VIDCON0, VIDCON0_ENVID | VIDCON0_ENVID_F, ~0);
  157. }
  158. static void decon_win_set_pixfmt(struct decon_context *ctx, unsigned int win,
  159. struct drm_framebuffer *fb)
  160. {
  161. unsigned long val;
  162. val = readl(ctx->addr + DECON_WINCONx(win));
  163. val &= ~WINCONx_BPPMODE_MASK;
  164. switch (fb->pixel_format) {
  165. case DRM_FORMAT_XRGB1555:
  166. val |= WINCONx_BPPMODE_16BPP_I1555;
  167. val |= WINCONx_HAWSWP_F;
  168. val |= WINCONx_BURSTLEN_16WORD;
  169. break;
  170. case DRM_FORMAT_RGB565:
  171. val |= WINCONx_BPPMODE_16BPP_565;
  172. val |= WINCONx_HAWSWP_F;
  173. val |= WINCONx_BURSTLEN_16WORD;
  174. break;
  175. case DRM_FORMAT_XRGB8888:
  176. val |= WINCONx_BPPMODE_24BPP_888;
  177. val |= WINCONx_WSWP_F;
  178. val |= WINCONx_BURSTLEN_16WORD;
  179. break;
  180. case DRM_FORMAT_ARGB8888:
  181. val |= WINCONx_BPPMODE_32BPP_A8888;
  182. val |= WINCONx_WSWP_F | WINCONx_BLD_PIX_F | WINCONx_ALPHA_SEL_F;
  183. val |= WINCONx_BURSTLEN_16WORD;
  184. break;
  185. default:
  186. DRM_ERROR("Proper pixel format is not set\n");
  187. return;
  188. }
  189. DRM_DEBUG_KMS("bpp = %u\n", fb->bits_per_pixel);
  190. /*
  191. * In case of exynos, setting dma-burst to 16Word causes permanent
  192. * tearing for very small buffers, e.g. cursor buffer. Burst Mode
  193. * switching which is based on plane size is not recommended as
  194. * plane size varies a lot towards the end of the screen and rapid
  195. * movement causes unstable DMA which results into iommu crash/tear.
  196. */
  197. if (fb->width < MIN_FB_WIDTH_FOR_16WORD_BURST) {
  198. val &= ~WINCONx_BURSTLEN_MASK;
  199. val |= WINCONx_BURSTLEN_8WORD;
  200. }
  201. writel(val, ctx->addr + DECON_WINCONx(win));
  202. }
  203. static void decon_shadow_protect_win(struct decon_context *ctx, int win,
  204. bool protect)
  205. {
  206. decon_set_bits(ctx, DECON_SHADOWCON, SHADOWCON_Wx_PROTECT(win),
  207. protect ? ~0 : 0);
  208. }
  209. static void decon_atomic_begin(struct exynos_drm_crtc *crtc)
  210. {
  211. struct decon_context *ctx = crtc->ctx;
  212. int i;
  213. if (test_bit(BIT_SUSPENDED, &ctx->flags))
  214. return;
  215. for (i = ctx->first_win; i < WINDOWS_NR; i++)
  216. decon_shadow_protect_win(ctx, i, true);
  217. }
  218. #define BIT_VAL(x, e, s) (((x) & ((1 << ((e) - (s) + 1)) - 1)) << (s))
  219. #define COORDINATE_X(x) BIT_VAL((x), 23, 12)
  220. #define COORDINATE_Y(x) BIT_VAL((x), 11, 0)
  221. static void decon_update_plane(struct exynos_drm_crtc *crtc,
  222. struct exynos_drm_plane *plane)
  223. {
  224. struct exynos_drm_plane_state *state =
  225. to_exynos_plane_state(plane->base.state);
  226. struct decon_context *ctx = crtc->ctx;
  227. struct drm_framebuffer *fb = state->base.fb;
  228. unsigned int win = plane->index;
  229. unsigned int bpp = fb->bits_per_pixel >> 3;
  230. unsigned int pitch = fb->pitches[0];
  231. dma_addr_t dma_addr = exynos_drm_fb_dma_addr(fb, 0);
  232. u32 val;
  233. if (test_bit(BIT_SUSPENDED, &ctx->flags))
  234. return;
  235. val = COORDINATE_X(state->crtc.x) | COORDINATE_Y(state->crtc.y);
  236. writel(val, ctx->addr + DECON_VIDOSDxA(win));
  237. val = COORDINATE_X(state->crtc.x + state->crtc.w - 1) |
  238. COORDINATE_Y(state->crtc.y + state->crtc.h - 1);
  239. writel(val, ctx->addr + DECON_VIDOSDxB(win));
  240. val = VIDOSD_Wx_ALPHA_R_F(0x0) | VIDOSD_Wx_ALPHA_G_F(0x0) |
  241. VIDOSD_Wx_ALPHA_B_F(0x0);
  242. writel(val, ctx->addr + DECON_VIDOSDxC(win));
  243. val = VIDOSD_Wx_ALPHA_R_F(0x0) | VIDOSD_Wx_ALPHA_G_F(0x0) |
  244. VIDOSD_Wx_ALPHA_B_F(0x0);
  245. writel(val, ctx->addr + DECON_VIDOSDxD(win));
  246. writel(dma_addr, ctx->addr + DECON_VIDW0xADD0B0(win));
  247. val = dma_addr + pitch * state->src.h;
  248. writel(val, ctx->addr + DECON_VIDW0xADD1B0(win));
  249. if (ctx->out_type != IFTYPE_HDMI)
  250. val = BIT_VAL(pitch - state->crtc.w * bpp, 27, 14)
  251. | BIT_VAL(state->crtc.w * bpp, 13, 0);
  252. else
  253. val = BIT_VAL(pitch - state->crtc.w * bpp, 29, 15)
  254. | BIT_VAL(state->crtc.w * bpp, 14, 0);
  255. writel(val, ctx->addr + DECON_VIDW0xADD2(win));
  256. decon_win_set_pixfmt(ctx, win, fb);
  257. /* window enable */
  258. decon_set_bits(ctx, DECON_WINCONx(win), WINCONx_ENWIN_F, ~0);
  259. /* standalone update */
  260. decon_set_bits(ctx, DECON_UPDATE, STANDALONE_UPDATE_F, ~0);
  261. }
  262. static void decon_disable_plane(struct exynos_drm_crtc *crtc,
  263. struct exynos_drm_plane *plane)
  264. {
  265. struct decon_context *ctx = crtc->ctx;
  266. unsigned int win = plane->index;
  267. if (test_bit(BIT_SUSPENDED, &ctx->flags))
  268. return;
  269. decon_shadow_protect_win(ctx, win, true);
  270. /* window disable */
  271. decon_set_bits(ctx, DECON_WINCONx(win), WINCONx_ENWIN_F, 0);
  272. decon_shadow_protect_win(ctx, win, false);
  273. /* standalone update */
  274. decon_set_bits(ctx, DECON_UPDATE, STANDALONE_UPDATE_F, ~0);
  275. }
  276. static void decon_atomic_flush(struct exynos_drm_crtc *crtc)
  277. {
  278. struct decon_context *ctx = crtc->ctx;
  279. int i;
  280. if (test_bit(BIT_SUSPENDED, &ctx->flags))
  281. return;
  282. for (i = ctx->first_win; i < WINDOWS_NR; i++)
  283. decon_shadow_protect_win(ctx, i, false);
  284. if (ctx->out_type == IFTYPE_I80)
  285. set_bit(BIT_WIN_UPDATED, &ctx->flags);
  286. }
  287. static void decon_swreset(struct decon_context *ctx)
  288. {
  289. unsigned int tries;
  290. writel(0, ctx->addr + DECON_VIDCON0);
  291. for (tries = 2000; tries; --tries) {
  292. if (~readl(ctx->addr + DECON_VIDCON0) & VIDCON0_STOP_STATUS)
  293. break;
  294. udelay(10);
  295. }
  296. WARN(tries == 0, "failed to disable DECON\n");
  297. writel(VIDCON0_SWRESET, ctx->addr + DECON_VIDCON0);
  298. for (tries = 2000; tries; --tries) {
  299. if (~readl(ctx->addr + DECON_VIDCON0) & VIDCON0_SWRESET)
  300. break;
  301. udelay(10);
  302. }
  303. WARN(tries == 0, "failed to software reset DECON\n");
  304. if (ctx->out_type != IFTYPE_HDMI)
  305. return;
  306. writel(VIDCON0_CLKVALUP | VIDCON0_VLCKFREE, ctx->addr + DECON_VIDCON0);
  307. decon_set_bits(ctx, DECON_CMU,
  308. CMU_CLKGAGE_MODE_SFR_F | CMU_CLKGAGE_MODE_MEM_F, ~0);
  309. writel(VIDCON1_VCLK_RUN_VDEN_DISABLE, ctx->addr + DECON_VIDCON1);
  310. writel(CRCCTRL_CRCEN | CRCCTRL_CRCSTART_F | CRCCTRL_CRCCLKEN,
  311. ctx->addr + DECON_CRCCTRL);
  312. decon_setup_trigger(ctx);
  313. }
  314. static void decon_enable(struct exynos_drm_crtc *crtc)
  315. {
  316. struct decon_context *ctx = crtc->ctx;
  317. if (!test_and_clear_bit(BIT_SUSPENDED, &ctx->flags))
  318. return;
  319. pm_runtime_get_sync(ctx->dev);
  320. set_bit(BIT_CLKS_ENABLED, &ctx->flags);
  321. /* if vblank was enabled status, enable it again. */
  322. if (test_and_clear_bit(BIT_IRQS_ENABLED, &ctx->flags))
  323. decon_enable_vblank(ctx->crtc);
  324. decon_commit(ctx->crtc);
  325. set_bit(BIT_SUSPENDED, &ctx->flags);
  326. }
  327. static void decon_disable(struct exynos_drm_crtc *crtc)
  328. {
  329. struct decon_context *ctx = crtc->ctx;
  330. int i;
  331. if (test_bit(BIT_SUSPENDED, &ctx->flags))
  332. return;
  333. /*
  334. * We need to make sure that all windows are disabled before we
  335. * suspend that connector. Otherwise we might try to scan from
  336. * a destroyed buffer later.
  337. */
  338. for (i = ctx->first_win; i < WINDOWS_NR; i++)
  339. decon_disable_plane(crtc, &ctx->planes[i]);
  340. decon_swreset(ctx);
  341. clear_bit(BIT_CLKS_ENABLED, &ctx->flags);
  342. pm_runtime_put_sync(ctx->dev);
  343. set_bit(BIT_SUSPENDED, &ctx->flags);
  344. }
  345. void decon_te_irq_handler(struct exynos_drm_crtc *crtc)
  346. {
  347. struct decon_context *ctx = crtc->ctx;
  348. if (!test_bit(BIT_CLKS_ENABLED, &ctx->flags))
  349. return;
  350. if (test_and_clear_bit(BIT_WIN_UPDATED, &ctx->flags))
  351. decon_set_bits(ctx, DECON_TRIGCON, TRIGCON_SWTRIGCMD, ~0);
  352. drm_crtc_handle_vblank(&ctx->crtc->base);
  353. }
  354. static void decon_clear_channels(struct exynos_drm_crtc *crtc)
  355. {
  356. struct decon_context *ctx = crtc->ctx;
  357. int win, i, ret;
  358. DRM_DEBUG_KMS("%s\n", __FILE__);
  359. for (i = 0; i < ARRAY_SIZE(decon_clks_name); i++) {
  360. ret = clk_prepare_enable(ctx->clks[i]);
  361. if (ret < 0)
  362. goto err;
  363. }
  364. for (win = 0; win < WINDOWS_NR; win++) {
  365. decon_shadow_protect_win(ctx, win, true);
  366. decon_set_bits(ctx, DECON_WINCONx(win), WINCONx_ENWIN_F, 0);
  367. decon_shadow_protect_win(ctx, win, false);
  368. decon_set_bits(ctx, DECON_UPDATE, STANDALONE_UPDATE_F, ~0);
  369. }
  370. /* TODO: wait for possible vsync */
  371. msleep(50);
  372. err:
  373. while (--i >= 0)
  374. clk_disable_unprepare(ctx->clks[i]);
  375. }
  376. static struct exynos_drm_crtc_ops decon_crtc_ops = {
  377. .enable = decon_enable,
  378. .disable = decon_disable,
  379. .enable_vblank = decon_enable_vblank,
  380. .disable_vblank = decon_disable_vblank,
  381. .atomic_begin = decon_atomic_begin,
  382. .update_plane = decon_update_plane,
  383. .disable_plane = decon_disable_plane,
  384. .atomic_flush = decon_atomic_flush,
  385. .te_handler = decon_te_irq_handler,
  386. };
  387. static int decon_bind(struct device *dev, struct device *master, void *data)
  388. {
  389. struct decon_context *ctx = dev_get_drvdata(dev);
  390. struct drm_device *drm_dev = data;
  391. struct exynos_drm_private *priv = drm_dev->dev_private;
  392. struct exynos_drm_plane *exynos_plane;
  393. enum exynos_drm_output_type out_type;
  394. unsigned int win;
  395. int ret;
  396. ctx->drm_dev = drm_dev;
  397. ctx->pipe = priv->pipe++;
  398. for (win = ctx->first_win; win < WINDOWS_NR; win++) {
  399. int tmp = (win == ctx->first_win) ? 0 : win;
  400. ctx->configs[win].pixel_formats = decon_formats;
  401. ctx->configs[win].num_pixel_formats = ARRAY_SIZE(decon_formats);
  402. ctx->configs[win].zpos = win;
  403. ctx->configs[win].type = decon_win_types[tmp];
  404. ret = exynos_plane_init(drm_dev, &ctx->planes[win], win,
  405. 1 << ctx->pipe, &ctx->configs[win]);
  406. if (ret)
  407. return ret;
  408. }
  409. exynos_plane = &ctx->planes[ctx->first_win];
  410. out_type = (ctx->out_type == IFTYPE_HDMI) ? EXYNOS_DISPLAY_TYPE_HDMI
  411. : EXYNOS_DISPLAY_TYPE_LCD;
  412. ctx->crtc = exynos_drm_crtc_create(drm_dev, &exynos_plane->base,
  413. ctx->pipe, out_type,
  414. &decon_crtc_ops, ctx);
  415. if (IS_ERR(ctx->crtc)) {
  416. ret = PTR_ERR(ctx->crtc);
  417. goto err;
  418. }
  419. decon_clear_channels(ctx->crtc);
  420. ret = drm_iommu_attach_device(drm_dev, dev);
  421. if (ret)
  422. goto err;
  423. return ret;
  424. err:
  425. priv->pipe--;
  426. return ret;
  427. }
  428. static void decon_unbind(struct device *dev, struct device *master, void *data)
  429. {
  430. struct decon_context *ctx = dev_get_drvdata(dev);
  431. decon_disable(ctx->crtc);
  432. /* detach this sub driver from iommu mapping if supported. */
  433. drm_iommu_detach_device(ctx->drm_dev, ctx->dev);
  434. }
  435. static const struct component_ops decon_component_ops = {
  436. .bind = decon_bind,
  437. .unbind = decon_unbind,
  438. };
  439. static irqreturn_t decon_irq_handler(int irq, void *dev_id)
  440. {
  441. struct decon_context *ctx = dev_id;
  442. u32 val;
  443. int win;
  444. if (!test_bit(BIT_CLKS_ENABLED, &ctx->flags))
  445. goto out;
  446. val = readl(ctx->addr + DECON_VIDINTCON1);
  447. val &= VIDINTCON1_INTFRMDONEPEND | VIDINTCON1_INTFRMPEND;
  448. if (val) {
  449. for (win = ctx->first_win; win < WINDOWS_NR ; win++) {
  450. struct exynos_drm_plane *plane = &ctx->planes[win];
  451. if (!plane->pending_fb)
  452. continue;
  453. exynos_drm_crtc_finish_update(ctx->crtc, plane);
  454. }
  455. /* clear */
  456. writel(val, ctx->addr + DECON_VIDINTCON1);
  457. }
  458. out:
  459. return IRQ_HANDLED;
  460. }
  461. #ifdef CONFIG_PM
  462. static int exynos5433_decon_suspend(struct device *dev)
  463. {
  464. struct decon_context *ctx = dev_get_drvdata(dev);
  465. int i;
  466. for (i = 0; i < ARRAY_SIZE(decon_clks_name); i++)
  467. clk_disable_unprepare(ctx->clks[i]);
  468. return 0;
  469. }
  470. static int exynos5433_decon_resume(struct device *dev)
  471. {
  472. struct decon_context *ctx = dev_get_drvdata(dev);
  473. int i, ret;
  474. for (i = 0; i < ARRAY_SIZE(decon_clks_name); i++) {
  475. ret = clk_prepare_enable(ctx->clks[i]);
  476. if (ret < 0)
  477. goto err;
  478. }
  479. return 0;
  480. err:
  481. while (--i >= 0)
  482. clk_disable_unprepare(ctx->clks[i]);
  483. return ret;
  484. }
  485. #endif
  486. static const struct dev_pm_ops exynos5433_decon_pm_ops = {
  487. SET_RUNTIME_PM_OPS(exynos5433_decon_suspend, exynos5433_decon_resume,
  488. NULL)
  489. };
  490. static const struct of_device_id exynos5433_decon_driver_dt_match[] = {
  491. {
  492. .compatible = "samsung,exynos5433-decon",
  493. .data = (void *)IFTYPE_RGB
  494. },
  495. {
  496. .compatible = "samsung,exynos5433-decon-tv",
  497. .data = (void *)IFTYPE_HDMI
  498. },
  499. {},
  500. };
  501. MODULE_DEVICE_TABLE(of, exynos5433_decon_driver_dt_match);
  502. static int exynos5433_decon_probe(struct platform_device *pdev)
  503. {
  504. const struct of_device_id *of_id;
  505. struct device *dev = &pdev->dev;
  506. struct decon_context *ctx;
  507. struct resource *res;
  508. int ret;
  509. int i;
  510. ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL);
  511. if (!ctx)
  512. return -ENOMEM;
  513. __set_bit(BIT_SUSPENDED, &ctx->flags);
  514. ctx->dev = dev;
  515. of_id = of_match_device(exynos5433_decon_driver_dt_match, &pdev->dev);
  516. ctx->out_type = (enum decon_iftype)of_id->data;
  517. if (ctx->out_type == IFTYPE_HDMI)
  518. ctx->first_win = 1;
  519. else if (of_get_child_by_name(dev->of_node, "i80-if-timings"))
  520. ctx->out_type = IFTYPE_I80;
  521. for (i = 0; i < ARRAY_SIZE(decon_clks_name); i++) {
  522. struct clk *clk;
  523. clk = devm_clk_get(ctx->dev, decon_clks_name[i]);
  524. if (IS_ERR(clk))
  525. return PTR_ERR(clk);
  526. ctx->clks[i] = clk;
  527. }
  528. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  529. if (!res) {
  530. dev_err(dev, "cannot find IO resource\n");
  531. return -ENXIO;
  532. }
  533. ctx->addr = devm_ioremap_resource(dev, res);
  534. if (IS_ERR(ctx->addr)) {
  535. dev_err(dev, "ioremap failed\n");
  536. return PTR_ERR(ctx->addr);
  537. }
  538. res = platform_get_resource_byname(pdev, IORESOURCE_IRQ,
  539. (ctx->out_type == IFTYPE_I80) ? "lcd_sys" : "vsync");
  540. if (!res) {
  541. dev_err(dev, "cannot find IRQ resource\n");
  542. return -ENXIO;
  543. }
  544. ret = devm_request_irq(dev, res->start, decon_irq_handler, 0,
  545. "drm_decon", ctx);
  546. if (ret < 0) {
  547. dev_err(dev, "lcd_sys irq request failed\n");
  548. return ret;
  549. }
  550. platform_set_drvdata(pdev, ctx);
  551. pm_runtime_enable(dev);
  552. ret = component_add(dev, &decon_component_ops);
  553. if (ret)
  554. goto err_disable_pm_runtime;
  555. return 0;
  556. err_disable_pm_runtime:
  557. pm_runtime_disable(dev);
  558. return ret;
  559. }
  560. static int exynos5433_decon_remove(struct platform_device *pdev)
  561. {
  562. pm_runtime_disable(&pdev->dev);
  563. component_del(&pdev->dev, &decon_component_ops);
  564. return 0;
  565. }
  566. struct platform_driver exynos5433_decon_driver = {
  567. .probe = exynos5433_decon_probe,
  568. .remove = exynos5433_decon_remove,
  569. .driver = {
  570. .name = "exynos5433-decon",
  571. .pm = &exynos5433_decon_pm_ops,
  572. .of_match_table = exynos5433_decon_driver_dt_match,
  573. },
  574. };