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