exynos5433_drm_decon.c 19 KB

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