exynos5433_drm_decon.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723
  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. }
  326. static void decon_disable(struct exynos_drm_crtc *crtc)
  327. {
  328. struct decon_context *ctx = crtc->ctx;
  329. int i;
  330. if (test_bit(BIT_SUSPENDED, &ctx->flags))
  331. return;
  332. /*
  333. * We need to make sure that all windows are disabled before we
  334. * suspend that connector. Otherwise we might try to scan from
  335. * a destroyed buffer later.
  336. */
  337. for (i = ctx->first_win; i < WINDOWS_NR; i++)
  338. decon_disable_plane(crtc, &ctx->planes[i]);
  339. decon_swreset(ctx);
  340. clear_bit(BIT_CLKS_ENABLED, &ctx->flags);
  341. pm_runtime_put_sync(ctx->dev);
  342. set_bit(BIT_SUSPENDED, &ctx->flags);
  343. }
  344. static void decon_te_irq_handler(struct exynos_drm_crtc *crtc)
  345. {
  346. struct decon_context *ctx = crtc->ctx;
  347. if (!test_bit(BIT_CLKS_ENABLED, &ctx->flags))
  348. return;
  349. if (test_and_clear_bit(BIT_WIN_UPDATED, &ctx->flags))
  350. decon_set_bits(ctx, DECON_TRIGCON, TRIGCON_SWTRIGCMD, ~0);
  351. drm_crtc_handle_vblank(&ctx->crtc->base);
  352. }
  353. static void decon_clear_channels(struct exynos_drm_crtc *crtc)
  354. {
  355. struct decon_context *ctx = crtc->ctx;
  356. int win, i, ret;
  357. DRM_DEBUG_KMS("%s\n", __FILE__);
  358. for (i = 0; i < ARRAY_SIZE(decon_clks_name); i++) {
  359. ret = clk_prepare_enable(ctx->clks[i]);
  360. if (ret < 0)
  361. goto err;
  362. }
  363. for (win = 0; win < WINDOWS_NR; win++) {
  364. decon_shadow_protect_win(ctx, win, true);
  365. decon_set_bits(ctx, DECON_WINCONx(win), WINCONx_ENWIN_F, 0);
  366. decon_shadow_protect_win(ctx, win, false);
  367. decon_set_bits(ctx, DECON_UPDATE, STANDALONE_UPDATE_F, ~0);
  368. }
  369. /* TODO: wait for possible vsync */
  370. msleep(50);
  371. err:
  372. while (--i >= 0)
  373. clk_disable_unprepare(ctx->clks[i]);
  374. }
  375. static struct exynos_drm_crtc_ops decon_crtc_ops = {
  376. .enable = decon_enable,
  377. .disable = decon_disable,
  378. .enable_vblank = decon_enable_vblank,
  379. .disable_vblank = decon_disable_vblank,
  380. .atomic_begin = decon_atomic_begin,
  381. .update_plane = decon_update_plane,
  382. .disable_plane = decon_disable_plane,
  383. .atomic_flush = decon_atomic_flush,
  384. .te_handler = decon_te_irq_handler,
  385. };
  386. static int decon_bind(struct device *dev, struct device *master, void *data)
  387. {
  388. struct decon_context *ctx = dev_get_drvdata(dev);
  389. struct drm_device *drm_dev = data;
  390. struct exynos_drm_private *priv = drm_dev->dev_private;
  391. struct exynos_drm_plane *exynos_plane;
  392. enum exynos_drm_output_type out_type;
  393. unsigned int win;
  394. int ret;
  395. ctx->drm_dev = drm_dev;
  396. ctx->pipe = priv->pipe++;
  397. for (win = ctx->first_win; win < WINDOWS_NR; win++) {
  398. int tmp = (win == ctx->first_win) ? 0 : win;
  399. ctx->configs[win].pixel_formats = decon_formats;
  400. ctx->configs[win].num_pixel_formats = ARRAY_SIZE(decon_formats);
  401. ctx->configs[win].zpos = win;
  402. ctx->configs[win].type = decon_win_types[tmp];
  403. ret = exynos_plane_init(drm_dev, &ctx->planes[win], win,
  404. 1 << ctx->pipe, &ctx->configs[win]);
  405. if (ret)
  406. return ret;
  407. }
  408. exynos_plane = &ctx->planes[ctx->first_win];
  409. out_type = (ctx->out_type == IFTYPE_HDMI) ? EXYNOS_DISPLAY_TYPE_HDMI
  410. : EXYNOS_DISPLAY_TYPE_LCD;
  411. ctx->crtc = exynos_drm_crtc_create(drm_dev, &exynos_plane->base,
  412. ctx->pipe, out_type,
  413. &decon_crtc_ops, ctx);
  414. if (IS_ERR(ctx->crtc)) {
  415. ret = PTR_ERR(ctx->crtc);
  416. goto err;
  417. }
  418. decon_clear_channels(ctx->crtc);
  419. ret = drm_iommu_attach_device(drm_dev, dev);
  420. if (ret)
  421. goto err;
  422. return ret;
  423. err:
  424. priv->pipe--;
  425. return ret;
  426. }
  427. static void decon_unbind(struct device *dev, struct device *master, void *data)
  428. {
  429. struct decon_context *ctx = dev_get_drvdata(dev);
  430. decon_disable(ctx->crtc);
  431. /* detach this sub driver from iommu mapping if supported. */
  432. drm_iommu_detach_device(ctx->drm_dev, ctx->dev);
  433. }
  434. static const struct component_ops decon_component_ops = {
  435. .bind = decon_bind,
  436. .unbind = decon_unbind,
  437. };
  438. static irqreturn_t decon_irq_handler(int irq, void *dev_id)
  439. {
  440. struct decon_context *ctx = dev_id;
  441. u32 val;
  442. int win;
  443. if (!test_bit(BIT_CLKS_ENABLED, &ctx->flags))
  444. goto out;
  445. val = readl(ctx->addr + DECON_VIDINTCON1);
  446. val &= VIDINTCON1_INTFRMDONEPEND | VIDINTCON1_INTFRMPEND;
  447. if (val) {
  448. for (win = ctx->first_win; win < WINDOWS_NR ; win++) {
  449. struct exynos_drm_plane *plane = &ctx->planes[win];
  450. if (!plane->pending_fb)
  451. continue;
  452. exynos_drm_crtc_finish_update(ctx->crtc, plane);
  453. }
  454. /* clear */
  455. writel(val, ctx->addr + DECON_VIDINTCON1);
  456. }
  457. out:
  458. return IRQ_HANDLED;
  459. }
  460. #ifdef CONFIG_PM
  461. static int exynos5433_decon_suspend(struct device *dev)
  462. {
  463. struct decon_context *ctx = dev_get_drvdata(dev);
  464. int i = ARRAY_SIZE(decon_clks_name);
  465. while (--i >= 0)
  466. clk_disable_unprepare(ctx->clks[i]);
  467. return 0;
  468. }
  469. static int exynos5433_decon_resume(struct device *dev)
  470. {
  471. struct decon_context *ctx = dev_get_drvdata(dev);
  472. int i, ret;
  473. for (i = 0; i < ARRAY_SIZE(decon_clks_name); i++) {
  474. ret = clk_prepare_enable(ctx->clks[i]);
  475. if (ret < 0)
  476. goto err;
  477. }
  478. return 0;
  479. err:
  480. while (--i >= 0)
  481. clk_disable_unprepare(ctx->clks[i]);
  482. return ret;
  483. }
  484. #endif
  485. static const struct dev_pm_ops exynos5433_decon_pm_ops = {
  486. SET_RUNTIME_PM_OPS(exynos5433_decon_suspend, exynos5433_decon_resume,
  487. NULL)
  488. };
  489. static const struct of_device_id exynos5433_decon_driver_dt_match[] = {
  490. {
  491. .compatible = "samsung,exynos5433-decon",
  492. .data = (void *)IFTYPE_RGB
  493. },
  494. {
  495. .compatible = "samsung,exynos5433-decon-tv",
  496. .data = (void *)IFTYPE_HDMI
  497. },
  498. {},
  499. };
  500. MODULE_DEVICE_TABLE(of, exynos5433_decon_driver_dt_match);
  501. static int exynos5433_decon_probe(struct platform_device *pdev)
  502. {
  503. const struct of_device_id *of_id;
  504. struct device *dev = &pdev->dev;
  505. struct decon_context *ctx;
  506. struct resource *res;
  507. int ret;
  508. int i;
  509. ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL);
  510. if (!ctx)
  511. return -ENOMEM;
  512. __set_bit(BIT_SUSPENDED, &ctx->flags);
  513. ctx->dev = dev;
  514. of_id = of_match_device(exynos5433_decon_driver_dt_match, &pdev->dev);
  515. ctx->out_type = (enum decon_iftype)of_id->data;
  516. if (ctx->out_type == IFTYPE_HDMI)
  517. ctx->first_win = 1;
  518. else if (of_get_child_by_name(dev->of_node, "i80-if-timings"))
  519. ctx->out_type = IFTYPE_I80;
  520. for (i = 0; i < ARRAY_SIZE(decon_clks_name); i++) {
  521. struct clk *clk;
  522. clk = devm_clk_get(ctx->dev, decon_clks_name[i]);
  523. if (IS_ERR(clk))
  524. return PTR_ERR(clk);
  525. ctx->clks[i] = clk;
  526. }
  527. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  528. if (!res) {
  529. dev_err(dev, "cannot find IO resource\n");
  530. return -ENXIO;
  531. }
  532. ctx->addr = devm_ioremap_resource(dev, res);
  533. if (IS_ERR(ctx->addr)) {
  534. dev_err(dev, "ioremap failed\n");
  535. return PTR_ERR(ctx->addr);
  536. }
  537. res = platform_get_resource_byname(pdev, IORESOURCE_IRQ,
  538. (ctx->out_type == IFTYPE_I80) ? "lcd_sys" : "vsync");
  539. if (!res) {
  540. dev_err(dev, "cannot find IRQ resource\n");
  541. return -ENXIO;
  542. }
  543. ret = devm_request_irq(dev, res->start, decon_irq_handler, 0,
  544. "drm_decon", ctx);
  545. if (ret < 0) {
  546. dev_err(dev, "lcd_sys irq request failed\n");
  547. return ret;
  548. }
  549. platform_set_drvdata(pdev, ctx);
  550. pm_runtime_enable(dev);
  551. ret = component_add(dev, &decon_component_ops);
  552. if (ret)
  553. goto err_disable_pm_runtime;
  554. return 0;
  555. err_disable_pm_runtime:
  556. pm_runtime_disable(dev);
  557. return ret;
  558. }
  559. static int exynos5433_decon_remove(struct platform_device *pdev)
  560. {
  561. pm_runtime_disable(&pdev->dev);
  562. component_del(&pdev->dev, &decon_component_ops);
  563. return 0;
  564. }
  565. struct platform_driver exynos5433_decon_driver = {
  566. .probe = exynos5433_decon_probe,
  567. .remove = exynos5433_decon_remove,
  568. .driver = {
  569. .name = "exynos5433-decon",
  570. .pm = &exynos5433_decon_pm_ops,
  571. .of_match_table = exynos5433_decon_driver_dt_match,
  572. },
  573. };