exynos_drm_fimc.c 45 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852
  1. /*
  2. * Copyright (C) 2012 Samsung Electronics Co.Ltd
  3. * Authors:
  4. * Eunchul Kim <chulspro.kim@samsung.com>
  5. * Jinyoung Jeon <jy0.jeon@samsung.com>
  6. * Sangmin Lee <lsmin.lee@samsung.com>
  7. *
  8. * This program is free software; you can redistribute it and/or modify it
  9. * under the terms of the GNU General Public License as published by the
  10. * Free Software Foundation; either version 2 of the License, or (at your
  11. * option) any later version.
  12. *
  13. */
  14. #include <linux/kernel.h>
  15. #include <linux/platform_device.h>
  16. #include <linux/mfd/syscon.h>
  17. #include <linux/regmap.h>
  18. #include <linux/clk.h>
  19. #include <linux/pm_runtime.h>
  20. #include <linux/of.h>
  21. #include <linux/spinlock.h>
  22. #include <drm/drmP.h>
  23. #include <drm/exynos_drm.h>
  24. #include "regs-fimc.h"
  25. #include "exynos_drm_drv.h"
  26. #include "exynos_drm_ipp.h"
  27. #include "exynos_drm_fimc.h"
  28. /*
  29. * FIMC stands for Fully Interactive Mobile Camera and
  30. * supports image scaler/rotator and input/output DMA operations.
  31. * input DMA reads image data from the memory.
  32. * output DMA writes image data to memory.
  33. * FIMC supports image rotation and image effect functions.
  34. *
  35. * M2M operation : supports crop/scale/rotation/csc so on.
  36. * Memory ----> FIMC H/W ----> Memory.
  37. * Writeback operation : supports cloned screen with FIMD.
  38. * FIMD ----> FIMC H/W ----> Memory.
  39. * Output operation : supports direct display using local path.
  40. * Memory ----> FIMC H/W ----> FIMD.
  41. */
  42. /*
  43. * TODO
  44. * 1. check suspend/resume api if needed.
  45. * 2. need to check use case platform_device_id.
  46. * 3. check src/dst size with, height.
  47. * 4. added check_prepare api for right register.
  48. * 5. need to add supported list in prop_list.
  49. * 6. check prescaler/scaler optimization.
  50. */
  51. #define FIMC_MAX_DEVS 4
  52. #define FIMC_MAX_SRC 2
  53. #define FIMC_MAX_DST 32
  54. #define FIMC_SHFACTOR 10
  55. #define FIMC_BUF_STOP 1
  56. #define FIMC_BUF_START 2
  57. #define FIMC_WIDTH_ITU_709 1280
  58. #define FIMC_REFRESH_MAX 60
  59. #define FIMC_REFRESH_MIN 12
  60. #define FIMC_CROP_MAX 8192
  61. #define FIMC_CROP_MIN 32
  62. #define FIMC_SCALE_MAX 4224
  63. #define FIMC_SCALE_MIN 32
  64. #define get_fimc_context(dev) platform_get_drvdata(to_platform_device(dev))
  65. #define get_ctx_from_ippdrv(ippdrv) container_of(ippdrv,\
  66. struct fimc_context, ippdrv);
  67. enum fimc_wb {
  68. FIMC_WB_NONE,
  69. FIMC_WB_A,
  70. FIMC_WB_B,
  71. };
  72. enum {
  73. FIMC_CLK_LCLK,
  74. FIMC_CLK_GATE,
  75. FIMC_CLK_WB_A,
  76. FIMC_CLK_WB_B,
  77. FIMC_CLK_MUX,
  78. FIMC_CLK_PARENT,
  79. FIMC_CLKS_MAX
  80. };
  81. static const char * const fimc_clock_names[] = {
  82. [FIMC_CLK_LCLK] = "sclk_fimc",
  83. [FIMC_CLK_GATE] = "fimc",
  84. [FIMC_CLK_WB_A] = "pxl_async0",
  85. [FIMC_CLK_WB_B] = "pxl_async1",
  86. [FIMC_CLK_MUX] = "mux",
  87. [FIMC_CLK_PARENT] = "parent",
  88. };
  89. #define FIMC_DEFAULT_LCLK_FREQUENCY 133000000UL
  90. /*
  91. * A structure of scaler.
  92. *
  93. * @range: narrow, wide.
  94. * @bypass: unused scaler path.
  95. * @up_h: horizontal scale up.
  96. * @up_v: vertical scale up.
  97. * @hratio: horizontal ratio.
  98. * @vratio: vertical ratio.
  99. */
  100. struct fimc_scaler {
  101. bool range;
  102. bool bypass;
  103. bool up_h;
  104. bool up_v;
  105. u32 hratio;
  106. u32 vratio;
  107. };
  108. /*
  109. * A structure of scaler capability.
  110. *
  111. * find user manual table 43-1.
  112. * @in_hori: scaler input horizontal size.
  113. * @bypass: scaler bypass mode.
  114. * @dst_h_wo_rot: target horizontal size without output rotation.
  115. * @dst_h_rot: target horizontal size with output rotation.
  116. * @rl_w_wo_rot: real width without input rotation.
  117. * @rl_h_rot: real height without output rotation.
  118. */
  119. struct fimc_capability {
  120. /* scaler */
  121. u32 in_hori;
  122. u32 bypass;
  123. /* output rotator */
  124. u32 dst_h_wo_rot;
  125. u32 dst_h_rot;
  126. /* input rotator */
  127. u32 rl_w_wo_rot;
  128. u32 rl_h_rot;
  129. };
  130. /*
  131. * A structure of fimc context.
  132. *
  133. * @ippdrv: prepare initialization using ippdrv.
  134. * @regs_res: register resources.
  135. * @regs: memory mapped io registers.
  136. * @lock: locking of operations.
  137. * @clocks: fimc clocks.
  138. * @clk_frequency: LCLK clock frequency.
  139. * @sysreg: handle to SYSREG block regmap.
  140. * @sc: scaler infomations.
  141. * @pol: porarity of writeback.
  142. * @id: fimc id.
  143. * @irq: irq number.
  144. * @suspended: qos operations.
  145. */
  146. struct fimc_context {
  147. struct exynos_drm_ippdrv ippdrv;
  148. struct resource *regs_res;
  149. void __iomem *regs;
  150. spinlock_t lock;
  151. struct clk *clocks[FIMC_CLKS_MAX];
  152. u32 clk_frequency;
  153. struct regmap *sysreg;
  154. struct fimc_scaler sc;
  155. struct exynos_drm_ipp_pol pol;
  156. int id;
  157. int irq;
  158. bool suspended;
  159. };
  160. static u32 fimc_read(struct fimc_context *ctx, u32 reg)
  161. {
  162. return readl(ctx->regs + reg);
  163. }
  164. static void fimc_write(struct fimc_context *ctx, u32 val, u32 reg)
  165. {
  166. writel(val, ctx->regs + reg);
  167. }
  168. static void fimc_set_bits(struct fimc_context *ctx, u32 reg, u32 bits)
  169. {
  170. void __iomem *r = ctx->regs + reg;
  171. writel(readl(r) | bits, r);
  172. }
  173. static void fimc_clear_bits(struct fimc_context *ctx, u32 reg, u32 bits)
  174. {
  175. void __iomem *r = ctx->regs + reg;
  176. writel(readl(r) & ~bits, r);
  177. }
  178. static void fimc_sw_reset(struct fimc_context *ctx)
  179. {
  180. u32 cfg;
  181. /* stop dma operation */
  182. cfg = fimc_read(ctx, EXYNOS_CISTATUS);
  183. if (EXYNOS_CISTATUS_GET_ENVID_STATUS(cfg))
  184. fimc_clear_bits(ctx, EXYNOS_MSCTRL, EXYNOS_MSCTRL_ENVID);
  185. fimc_set_bits(ctx, EXYNOS_CISRCFMT, EXYNOS_CISRCFMT_ITU601_8BIT);
  186. /* disable image capture */
  187. fimc_clear_bits(ctx, EXYNOS_CIIMGCPT,
  188. EXYNOS_CIIMGCPT_IMGCPTEN_SC | EXYNOS_CIIMGCPT_IMGCPTEN);
  189. /* s/w reset */
  190. fimc_set_bits(ctx, EXYNOS_CIGCTRL, EXYNOS_CIGCTRL_SWRST);
  191. /* s/w reset complete */
  192. fimc_clear_bits(ctx, EXYNOS_CIGCTRL, EXYNOS_CIGCTRL_SWRST);
  193. /* reset sequence */
  194. fimc_write(ctx, 0x0, EXYNOS_CIFCNTSEQ);
  195. }
  196. static int fimc_set_camblk_fimd0_wb(struct fimc_context *ctx)
  197. {
  198. return regmap_update_bits(ctx->sysreg, SYSREG_CAMERA_BLK,
  199. SYSREG_FIMD0WB_DEST_MASK,
  200. ctx->id << SYSREG_FIMD0WB_DEST_SHIFT);
  201. }
  202. static void fimc_set_type_ctrl(struct fimc_context *ctx, enum fimc_wb wb)
  203. {
  204. u32 cfg;
  205. DRM_DEBUG_KMS("wb[%d]\n", wb);
  206. cfg = fimc_read(ctx, EXYNOS_CIGCTRL);
  207. cfg &= ~(EXYNOS_CIGCTRL_TESTPATTERN_MASK |
  208. EXYNOS_CIGCTRL_SELCAM_ITU_MASK |
  209. EXYNOS_CIGCTRL_SELCAM_MIPI_MASK |
  210. EXYNOS_CIGCTRL_SELCAM_FIMC_MASK |
  211. EXYNOS_CIGCTRL_SELWB_CAMIF_MASK |
  212. EXYNOS_CIGCTRL_SELWRITEBACK_MASK);
  213. switch (wb) {
  214. case FIMC_WB_A:
  215. cfg |= (EXYNOS_CIGCTRL_SELWRITEBACK_A |
  216. EXYNOS_CIGCTRL_SELWB_CAMIF_WRITEBACK);
  217. break;
  218. case FIMC_WB_B:
  219. cfg |= (EXYNOS_CIGCTRL_SELWRITEBACK_B |
  220. EXYNOS_CIGCTRL_SELWB_CAMIF_WRITEBACK);
  221. break;
  222. case FIMC_WB_NONE:
  223. default:
  224. cfg |= (EXYNOS_CIGCTRL_SELCAM_ITU_A |
  225. EXYNOS_CIGCTRL_SELWRITEBACK_A |
  226. EXYNOS_CIGCTRL_SELCAM_MIPI_A |
  227. EXYNOS_CIGCTRL_SELCAM_FIMC_ITU);
  228. break;
  229. }
  230. fimc_write(ctx, cfg, EXYNOS_CIGCTRL);
  231. }
  232. static void fimc_set_polarity(struct fimc_context *ctx,
  233. struct exynos_drm_ipp_pol *pol)
  234. {
  235. u32 cfg;
  236. DRM_DEBUG_KMS("inv_pclk[%d]inv_vsync[%d]\n",
  237. pol->inv_pclk, pol->inv_vsync);
  238. DRM_DEBUG_KMS("inv_href[%d]inv_hsync[%d]\n",
  239. pol->inv_href, pol->inv_hsync);
  240. cfg = fimc_read(ctx, EXYNOS_CIGCTRL);
  241. cfg &= ~(EXYNOS_CIGCTRL_INVPOLPCLK | EXYNOS_CIGCTRL_INVPOLVSYNC |
  242. EXYNOS_CIGCTRL_INVPOLHREF | EXYNOS_CIGCTRL_INVPOLHSYNC);
  243. if (pol->inv_pclk)
  244. cfg |= EXYNOS_CIGCTRL_INVPOLPCLK;
  245. if (pol->inv_vsync)
  246. cfg |= EXYNOS_CIGCTRL_INVPOLVSYNC;
  247. if (pol->inv_href)
  248. cfg |= EXYNOS_CIGCTRL_INVPOLHREF;
  249. if (pol->inv_hsync)
  250. cfg |= EXYNOS_CIGCTRL_INVPOLHSYNC;
  251. fimc_write(ctx, cfg, EXYNOS_CIGCTRL);
  252. }
  253. static void fimc_handle_jpeg(struct fimc_context *ctx, bool enable)
  254. {
  255. u32 cfg;
  256. DRM_DEBUG_KMS("enable[%d]\n", enable);
  257. cfg = fimc_read(ctx, EXYNOS_CIGCTRL);
  258. if (enable)
  259. cfg |= EXYNOS_CIGCTRL_CAM_JPEG;
  260. else
  261. cfg &= ~EXYNOS_CIGCTRL_CAM_JPEG;
  262. fimc_write(ctx, cfg, EXYNOS_CIGCTRL);
  263. }
  264. static void fimc_mask_irq(struct fimc_context *ctx, bool enable)
  265. {
  266. u32 cfg;
  267. DRM_DEBUG_KMS("enable[%d]\n", enable);
  268. cfg = fimc_read(ctx, EXYNOS_CIGCTRL);
  269. if (enable) {
  270. cfg &= ~EXYNOS_CIGCTRL_IRQ_OVFEN;
  271. cfg |= EXYNOS_CIGCTRL_IRQ_ENABLE | EXYNOS_CIGCTRL_IRQ_LEVEL;
  272. } else
  273. cfg &= ~EXYNOS_CIGCTRL_IRQ_ENABLE;
  274. fimc_write(ctx, cfg, EXYNOS_CIGCTRL);
  275. }
  276. static void fimc_clear_irq(struct fimc_context *ctx)
  277. {
  278. fimc_set_bits(ctx, EXYNOS_CIGCTRL, EXYNOS_CIGCTRL_IRQ_CLR);
  279. }
  280. static bool fimc_check_ovf(struct fimc_context *ctx)
  281. {
  282. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  283. u32 status, flag;
  284. status = fimc_read(ctx, EXYNOS_CISTATUS);
  285. flag = EXYNOS_CISTATUS_OVFIY | EXYNOS_CISTATUS_OVFICB |
  286. EXYNOS_CISTATUS_OVFICR;
  287. DRM_DEBUG_KMS("flag[0x%x]\n", flag);
  288. if (status & flag) {
  289. fimc_set_bits(ctx, EXYNOS_CIWDOFST,
  290. EXYNOS_CIWDOFST_CLROVFIY | EXYNOS_CIWDOFST_CLROVFICB |
  291. EXYNOS_CIWDOFST_CLROVFICR);
  292. dev_err(ippdrv->dev, "occurred overflow at %d, status 0x%x.\n",
  293. ctx->id, status);
  294. return true;
  295. }
  296. return false;
  297. }
  298. static bool fimc_check_frame_end(struct fimc_context *ctx)
  299. {
  300. u32 cfg;
  301. cfg = fimc_read(ctx, EXYNOS_CISTATUS);
  302. DRM_DEBUG_KMS("cfg[0x%x]\n", cfg);
  303. if (!(cfg & EXYNOS_CISTATUS_FRAMEEND))
  304. return false;
  305. cfg &= ~(EXYNOS_CISTATUS_FRAMEEND);
  306. fimc_write(ctx, cfg, EXYNOS_CISTATUS);
  307. return true;
  308. }
  309. static int fimc_get_buf_id(struct fimc_context *ctx)
  310. {
  311. u32 cfg;
  312. int frame_cnt, buf_id;
  313. cfg = fimc_read(ctx, EXYNOS_CISTATUS2);
  314. frame_cnt = EXYNOS_CISTATUS2_GET_FRAMECOUNT_BEFORE(cfg);
  315. if (frame_cnt == 0)
  316. frame_cnt = EXYNOS_CISTATUS2_GET_FRAMECOUNT_PRESENT(cfg);
  317. DRM_DEBUG_KMS("present[%d]before[%d]\n",
  318. EXYNOS_CISTATUS2_GET_FRAMECOUNT_PRESENT(cfg),
  319. EXYNOS_CISTATUS2_GET_FRAMECOUNT_BEFORE(cfg));
  320. if (frame_cnt == 0) {
  321. DRM_ERROR("failed to get frame count.\n");
  322. return -EIO;
  323. }
  324. buf_id = frame_cnt - 1;
  325. DRM_DEBUG_KMS("buf_id[%d]\n", buf_id);
  326. return buf_id;
  327. }
  328. static void fimc_handle_lastend(struct fimc_context *ctx, bool enable)
  329. {
  330. u32 cfg;
  331. DRM_DEBUG_KMS("enable[%d]\n", enable);
  332. cfg = fimc_read(ctx, EXYNOS_CIOCTRL);
  333. if (enable)
  334. cfg |= EXYNOS_CIOCTRL_LASTENDEN;
  335. else
  336. cfg &= ~EXYNOS_CIOCTRL_LASTENDEN;
  337. fimc_write(ctx, cfg, EXYNOS_CIOCTRL);
  338. }
  339. static int fimc_src_set_fmt_order(struct fimc_context *ctx, u32 fmt)
  340. {
  341. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  342. u32 cfg;
  343. DRM_DEBUG_KMS("fmt[0x%x]\n", fmt);
  344. /* RGB */
  345. cfg = fimc_read(ctx, EXYNOS_CISCCTRL);
  346. cfg &= ~EXYNOS_CISCCTRL_INRGB_FMT_RGB_MASK;
  347. switch (fmt) {
  348. case DRM_FORMAT_RGB565:
  349. cfg |= EXYNOS_CISCCTRL_INRGB_FMT_RGB565;
  350. fimc_write(ctx, cfg, EXYNOS_CISCCTRL);
  351. return 0;
  352. case DRM_FORMAT_RGB888:
  353. case DRM_FORMAT_XRGB8888:
  354. cfg |= EXYNOS_CISCCTRL_INRGB_FMT_RGB888;
  355. fimc_write(ctx, cfg, EXYNOS_CISCCTRL);
  356. return 0;
  357. default:
  358. /* bypass */
  359. break;
  360. }
  361. /* YUV */
  362. cfg = fimc_read(ctx, EXYNOS_MSCTRL);
  363. cfg &= ~(EXYNOS_MSCTRL_ORDER2P_SHIFT_MASK |
  364. EXYNOS_MSCTRL_C_INT_IN_2PLANE |
  365. EXYNOS_MSCTRL_ORDER422_YCBYCR);
  366. switch (fmt) {
  367. case DRM_FORMAT_YUYV:
  368. cfg |= EXYNOS_MSCTRL_ORDER422_YCBYCR;
  369. break;
  370. case DRM_FORMAT_YVYU:
  371. cfg |= EXYNOS_MSCTRL_ORDER422_YCRYCB;
  372. break;
  373. case DRM_FORMAT_UYVY:
  374. cfg |= EXYNOS_MSCTRL_ORDER422_CBYCRY;
  375. break;
  376. case DRM_FORMAT_VYUY:
  377. case DRM_FORMAT_YUV444:
  378. cfg |= EXYNOS_MSCTRL_ORDER422_CRYCBY;
  379. break;
  380. case DRM_FORMAT_NV21:
  381. case DRM_FORMAT_NV61:
  382. cfg |= (EXYNOS_MSCTRL_ORDER2P_LSB_CRCB |
  383. EXYNOS_MSCTRL_C_INT_IN_2PLANE);
  384. break;
  385. case DRM_FORMAT_YUV422:
  386. case DRM_FORMAT_YUV420:
  387. case DRM_FORMAT_YVU420:
  388. cfg |= EXYNOS_MSCTRL_C_INT_IN_3PLANE;
  389. break;
  390. case DRM_FORMAT_NV12:
  391. case DRM_FORMAT_NV16:
  392. cfg |= (EXYNOS_MSCTRL_ORDER2P_LSB_CBCR |
  393. EXYNOS_MSCTRL_C_INT_IN_2PLANE);
  394. break;
  395. default:
  396. dev_err(ippdrv->dev, "inavlid source yuv order 0x%x.\n", fmt);
  397. return -EINVAL;
  398. }
  399. fimc_write(ctx, cfg, EXYNOS_MSCTRL);
  400. return 0;
  401. }
  402. static int fimc_src_set_fmt(struct device *dev, u32 fmt)
  403. {
  404. struct fimc_context *ctx = get_fimc_context(dev);
  405. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  406. u32 cfg;
  407. DRM_DEBUG_KMS("fmt[0x%x]\n", fmt);
  408. cfg = fimc_read(ctx, EXYNOS_MSCTRL);
  409. cfg &= ~EXYNOS_MSCTRL_INFORMAT_RGB;
  410. switch (fmt) {
  411. case DRM_FORMAT_RGB565:
  412. case DRM_FORMAT_RGB888:
  413. case DRM_FORMAT_XRGB8888:
  414. cfg |= EXYNOS_MSCTRL_INFORMAT_RGB;
  415. break;
  416. case DRM_FORMAT_YUV444:
  417. cfg |= EXYNOS_MSCTRL_INFORMAT_YCBCR420;
  418. break;
  419. case DRM_FORMAT_YUYV:
  420. case DRM_FORMAT_YVYU:
  421. case DRM_FORMAT_UYVY:
  422. case DRM_FORMAT_VYUY:
  423. cfg |= EXYNOS_MSCTRL_INFORMAT_YCBCR422_1PLANE;
  424. break;
  425. case DRM_FORMAT_NV16:
  426. case DRM_FORMAT_NV61:
  427. case DRM_FORMAT_YUV422:
  428. cfg |= EXYNOS_MSCTRL_INFORMAT_YCBCR422;
  429. break;
  430. case DRM_FORMAT_YUV420:
  431. case DRM_FORMAT_YVU420:
  432. case DRM_FORMAT_NV12:
  433. case DRM_FORMAT_NV21:
  434. cfg |= EXYNOS_MSCTRL_INFORMAT_YCBCR420;
  435. break;
  436. default:
  437. dev_err(ippdrv->dev, "inavlid source format 0x%x.\n", fmt);
  438. return -EINVAL;
  439. }
  440. fimc_write(ctx, cfg, EXYNOS_MSCTRL);
  441. cfg = fimc_read(ctx, EXYNOS_CIDMAPARAM);
  442. cfg &= ~EXYNOS_CIDMAPARAM_R_MODE_MASK;
  443. cfg |= EXYNOS_CIDMAPARAM_R_MODE_LINEAR;
  444. fimc_write(ctx, cfg, EXYNOS_CIDMAPARAM);
  445. return fimc_src_set_fmt_order(ctx, fmt);
  446. }
  447. static int fimc_src_set_transf(struct device *dev,
  448. enum drm_exynos_degree degree,
  449. enum drm_exynos_flip flip, bool *swap)
  450. {
  451. struct fimc_context *ctx = get_fimc_context(dev);
  452. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  453. u32 cfg1, cfg2;
  454. DRM_DEBUG_KMS("degree[%d]flip[0x%x]\n", degree, flip);
  455. cfg1 = fimc_read(ctx, EXYNOS_MSCTRL);
  456. cfg1 &= ~(EXYNOS_MSCTRL_FLIP_X_MIRROR |
  457. EXYNOS_MSCTRL_FLIP_Y_MIRROR);
  458. cfg2 = fimc_read(ctx, EXYNOS_CITRGFMT);
  459. cfg2 &= ~EXYNOS_CITRGFMT_INROT90_CLOCKWISE;
  460. switch (degree) {
  461. case EXYNOS_DRM_DEGREE_0:
  462. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  463. cfg1 |= EXYNOS_MSCTRL_FLIP_X_MIRROR;
  464. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  465. cfg1 |= EXYNOS_MSCTRL_FLIP_Y_MIRROR;
  466. break;
  467. case EXYNOS_DRM_DEGREE_90:
  468. cfg2 |= EXYNOS_CITRGFMT_INROT90_CLOCKWISE;
  469. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  470. cfg1 |= EXYNOS_MSCTRL_FLIP_X_MIRROR;
  471. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  472. cfg1 |= EXYNOS_MSCTRL_FLIP_Y_MIRROR;
  473. break;
  474. case EXYNOS_DRM_DEGREE_180:
  475. cfg1 |= (EXYNOS_MSCTRL_FLIP_X_MIRROR |
  476. EXYNOS_MSCTRL_FLIP_Y_MIRROR);
  477. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  478. cfg1 &= ~EXYNOS_MSCTRL_FLIP_X_MIRROR;
  479. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  480. cfg1 &= ~EXYNOS_MSCTRL_FLIP_Y_MIRROR;
  481. break;
  482. case EXYNOS_DRM_DEGREE_270:
  483. cfg1 |= (EXYNOS_MSCTRL_FLIP_X_MIRROR |
  484. EXYNOS_MSCTRL_FLIP_Y_MIRROR);
  485. cfg2 |= EXYNOS_CITRGFMT_INROT90_CLOCKWISE;
  486. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  487. cfg1 &= ~EXYNOS_MSCTRL_FLIP_X_MIRROR;
  488. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  489. cfg1 &= ~EXYNOS_MSCTRL_FLIP_Y_MIRROR;
  490. break;
  491. default:
  492. dev_err(ippdrv->dev, "inavlid degree value %d.\n", degree);
  493. return -EINVAL;
  494. }
  495. fimc_write(ctx, cfg1, EXYNOS_MSCTRL);
  496. fimc_write(ctx, cfg2, EXYNOS_CITRGFMT);
  497. *swap = (cfg2 & EXYNOS_CITRGFMT_INROT90_CLOCKWISE) ? 1 : 0;
  498. return 0;
  499. }
  500. static int fimc_set_window(struct fimc_context *ctx,
  501. struct drm_exynos_pos *pos, struct drm_exynos_sz *sz)
  502. {
  503. u32 cfg, h1, h2, v1, v2;
  504. /* cropped image */
  505. h1 = pos->x;
  506. h2 = sz->hsize - pos->w - pos->x;
  507. v1 = pos->y;
  508. v2 = sz->vsize - pos->h - pos->y;
  509. DRM_DEBUG_KMS("x[%d]y[%d]w[%d]h[%d]hsize[%d]vsize[%d]\n",
  510. pos->x, pos->y, pos->w, pos->h, sz->hsize, sz->vsize);
  511. DRM_DEBUG_KMS("h1[%d]h2[%d]v1[%d]v2[%d]\n", h1, h2, v1, v2);
  512. /*
  513. * set window offset 1, 2 size
  514. * check figure 43-21 in user manual
  515. */
  516. cfg = fimc_read(ctx, EXYNOS_CIWDOFST);
  517. cfg &= ~(EXYNOS_CIWDOFST_WINHOROFST_MASK |
  518. EXYNOS_CIWDOFST_WINVEROFST_MASK);
  519. cfg |= (EXYNOS_CIWDOFST_WINHOROFST(h1) |
  520. EXYNOS_CIWDOFST_WINVEROFST(v1));
  521. cfg |= EXYNOS_CIWDOFST_WINOFSEN;
  522. fimc_write(ctx, cfg, EXYNOS_CIWDOFST);
  523. cfg = (EXYNOS_CIWDOFST2_WINHOROFST2(h2) |
  524. EXYNOS_CIWDOFST2_WINVEROFST2(v2));
  525. fimc_write(ctx, cfg, EXYNOS_CIWDOFST2);
  526. return 0;
  527. }
  528. static int fimc_src_set_size(struct device *dev, int swap,
  529. struct drm_exynos_pos *pos, struct drm_exynos_sz *sz)
  530. {
  531. struct fimc_context *ctx = get_fimc_context(dev);
  532. struct drm_exynos_pos img_pos = *pos;
  533. struct drm_exynos_sz img_sz = *sz;
  534. u32 cfg;
  535. DRM_DEBUG_KMS("swap[%d]hsize[%d]vsize[%d]\n",
  536. swap, sz->hsize, sz->vsize);
  537. /* original size */
  538. cfg = (EXYNOS_ORGISIZE_HORIZONTAL(img_sz.hsize) |
  539. EXYNOS_ORGISIZE_VERTICAL(img_sz.vsize));
  540. fimc_write(ctx, cfg, EXYNOS_ORGISIZE);
  541. DRM_DEBUG_KMS("x[%d]y[%d]w[%d]h[%d]\n", pos->x, pos->y, pos->w, pos->h);
  542. if (swap) {
  543. img_pos.w = pos->h;
  544. img_pos.h = pos->w;
  545. img_sz.hsize = sz->vsize;
  546. img_sz.vsize = sz->hsize;
  547. }
  548. /* set input DMA image size */
  549. cfg = fimc_read(ctx, EXYNOS_CIREAL_ISIZE);
  550. cfg &= ~(EXYNOS_CIREAL_ISIZE_HEIGHT_MASK |
  551. EXYNOS_CIREAL_ISIZE_WIDTH_MASK);
  552. cfg |= (EXYNOS_CIREAL_ISIZE_WIDTH(img_pos.w) |
  553. EXYNOS_CIREAL_ISIZE_HEIGHT(img_pos.h));
  554. fimc_write(ctx, cfg, EXYNOS_CIREAL_ISIZE);
  555. /*
  556. * set input FIFO image size
  557. * for now, we support only ITU601 8 bit mode
  558. */
  559. cfg = (EXYNOS_CISRCFMT_ITU601_8BIT |
  560. EXYNOS_CISRCFMT_SOURCEHSIZE(img_sz.hsize) |
  561. EXYNOS_CISRCFMT_SOURCEVSIZE(img_sz.vsize));
  562. fimc_write(ctx, cfg, EXYNOS_CISRCFMT);
  563. /* offset Y(RGB), Cb, Cr */
  564. cfg = (EXYNOS_CIIYOFF_HORIZONTAL(img_pos.x) |
  565. EXYNOS_CIIYOFF_VERTICAL(img_pos.y));
  566. fimc_write(ctx, cfg, EXYNOS_CIIYOFF);
  567. cfg = (EXYNOS_CIICBOFF_HORIZONTAL(img_pos.x) |
  568. EXYNOS_CIICBOFF_VERTICAL(img_pos.y));
  569. fimc_write(ctx, cfg, EXYNOS_CIICBOFF);
  570. cfg = (EXYNOS_CIICROFF_HORIZONTAL(img_pos.x) |
  571. EXYNOS_CIICROFF_VERTICAL(img_pos.y));
  572. fimc_write(ctx, cfg, EXYNOS_CIICROFF);
  573. return fimc_set_window(ctx, &img_pos, &img_sz);
  574. }
  575. static int fimc_src_set_addr(struct device *dev,
  576. struct drm_exynos_ipp_buf_info *buf_info, u32 buf_id,
  577. enum drm_exynos_ipp_buf_type buf_type)
  578. {
  579. struct fimc_context *ctx = get_fimc_context(dev);
  580. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  581. struct drm_exynos_ipp_cmd_node *c_node = ippdrv->c_node;
  582. struct drm_exynos_ipp_property *property;
  583. struct drm_exynos_ipp_config *config;
  584. if (!c_node) {
  585. DRM_ERROR("failed to get c_node.\n");
  586. return -EINVAL;
  587. }
  588. property = &c_node->property;
  589. DRM_DEBUG_KMS("prop_id[%d]buf_id[%d]buf_type[%d]\n",
  590. property->prop_id, buf_id, buf_type);
  591. if (buf_id > FIMC_MAX_SRC) {
  592. dev_info(ippdrv->dev, "inavlid buf_id %d.\n", buf_id);
  593. return -ENOMEM;
  594. }
  595. /* address register set */
  596. switch (buf_type) {
  597. case IPP_BUF_ENQUEUE:
  598. config = &property->config[EXYNOS_DRM_OPS_SRC];
  599. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_Y],
  600. EXYNOS_CIIYSA0);
  601. if (config->fmt == DRM_FORMAT_YVU420) {
  602. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CR],
  603. EXYNOS_CIICBSA0);
  604. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CB],
  605. EXYNOS_CIICRSA0);
  606. } else {
  607. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CB],
  608. EXYNOS_CIICBSA0);
  609. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CR],
  610. EXYNOS_CIICRSA0);
  611. }
  612. break;
  613. case IPP_BUF_DEQUEUE:
  614. fimc_write(ctx, 0x0, EXYNOS_CIIYSA0);
  615. fimc_write(ctx, 0x0, EXYNOS_CIICBSA0);
  616. fimc_write(ctx, 0x0, EXYNOS_CIICRSA0);
  617. break;
  618. default:
  619. /* bypass */
  620. break;
  621. }
  622. return 0;
  623. }
  624. static struct exynos_drm_ipp_ops fimc_src_ops = {
  625. .set_fmt = fimc_src_set_fmt,
  626. .set_transf = fimc_src_set_transf,
  627. .set_size = fimc_src_set_size,
  628. .set_addr = fimc_src_set_addr,
  629. };
  630. static int fimc_dst_set_fmt_order(struct fimc_context *ctx, u32 fmt)
  631. {
  632. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  633. u32 cfg;
  634. DRM_DEBUG_KMS("fmt[0x%x]\n", fmt);
  635. /* RGB */
  636. cfg = fimc_read(ctx, EXYNOS_CISCCTRL);
  637. cfg &= ~EXYNOS_CISCCTRL_OUTRGB_FMT_RGB_MASK;
  638. switch (fmt) {
  639. case DRM_FORMAT_RGB565:
  640. cfg |= EXYNOS_CISCCTRL_OUTRGB_FMT_RGB565;
  641. fimc_write(ctx, cfg, EXYNOS_CISCCTRL);
  642. return 0;
  643. case DRM_FORMAT_RGB888:
  644. cfg |= EXYNOS_CISCCTRL_OUTRGB_FMT_RGB888;
  645. fimc_write(ctx, cfg, EXYNOS_CISCCTRL);
  646. return 0;
  647. case DRM_FORMAT_XRGB8888:
  648. cfg |= (EXYNOS_CISCCTRL_OUTRGB_FMT_RGB888 |
  649. EXYNOS_CISCCTRL_EXTRGB_EXTENSION);
  650. fimc_write(ctx, cfg, EXYNOS_CISCCTRL);
  651. break;
  652. default:
  653. /* bypass */
  654. break;
  655. }
  656. /* YUV */
  657. cfg = fimc_read(ctx, EXYNOS_CIOCTRL);
  658. cfg &= ~(EXYNOS_CIOCTRL_ORDER2P_MASK |
  659. EXYNOS_CIOCTRL_ORDER422_MASK |
  660. EXYNOS_CIOCTRL_YCBCR_PLANE_MASK);
  661. switch (fmt) {
  662. case DRM_FORMAT_XRGB8888:
  663. cfg |= EXYNOS_CIOCTRL_ALPHA_OUT;
  664. break;
  665. case DRM_FORMAT_YUYV:
  666. cfg |= EXYNOS_CIOCTRL_ORDER422_YCBYCR;
  667. break;
  668. case DRM_FORMAT_YVYU:
  669. cfg |= EXYNOS_CIOCTRL_ORDER422_YCRYCB;
  670. break;
  671. case DRM_FORMAT_UYVY:
  672. cfg |= EXYNOS_CIOCTRL_ORDER422_CBYCRY;
  673. break;
  674. case DRM_FORMAT_VYUY:
  675. cfg |= EXYNOS_CIOCTRL_ORDER422_CRYCBY;
  676. break;
  677. case DRM_FORMAT_NV21:
  678. case DRM_FORMAT_NV61:
  679. cfg |= EXYNOS_CIOCTRL_ORDER2P_LSB_CRCB;
  680. cfg |= EXYNOS_CIOCTRL_YCBCR_2PLANE;
  681. break;
  682. case DRM_FORMAT_YUV422:
  683. case DRM_FORMAT_YUV420:
  684. case DRM_FORMAT_YVU420:
  685. cfg |= EXYNOS_CIOCTRL_YCBCR_3PLANE;
  686. break;
  687. case DRM_FORMAT_NV12:
  688. case DRM_FORMAT_NV16:
  689. cfg |= EXYNOS_CIOCTRL_ORDER2P_LSB_CBCR;
  690. cfg |= EXYNOS_CIOCTRL_YCBCR_2PLANE;
  691. break;
  692. default:
  693. dev_err(ippdrv->dev, "inavlid target yuv order 0x%x.\n", fmt);
  694. return -EINVAL;
  695. }
  696. fimc_write(ctx, cfg, EXYNOS_CIOCTRL);
  697. return 0;
  698. }
  699. static int fimc_dst_set_fmt(struct device *dev, u32 fmt)
  700. {
  701. struct fimc_context *ctx = get_fimc_context(dev);
  702. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  703. u32 cfg;
  704. DRM_DEBUG_KMS("fmt[0x%x]\n", fmt);
  705. cfg = fimc_read(ctx, EXYNOS_CIEXTEN);
  706. if (fmt == DRM_FORMAT_AYUV) {
  707. cfg |= EXYNOS_CIEXTEN_YUV444_OUT;
  708. fimc_write(ctx, cfg, EXYNOS_CIEXTEN);
  709. } else {
  710. cfg &= ~EXYNOS_CIEXTEN_YUV444_OUT;
  711. fimc_write(ctx, cfg, EXYNOS_CIEXTEN);
  712. cfg = fimc_read(ctx, EXYNOS_CITRGFMT);
  713. cfg &= ~EXYNOS_CITRGFMT_OUTFORMAT_MASK;
  714. switch (fmt) {
  715. case DRM_FORMAT_RGB565:
  716. case DRM_FORMAT_RGB888:
  717. case DRM_FORMAT_XRGB8888:
  718. cfg |= EXYNOS_CITRGFMT_OUTFORMAT_RGB;
  719. break;
  720. case DRM_FORMAT_YUYV:
  721. case DRM_FORMAT_YVYU:
  722. case DRM_FORMAT_UYVY:
  723. case DRM_FORMAT_VYUY:
  724. cfg |= EXYNOS_CITRGFMT_OUTFORMAT_YCBCR422_1PLANE;
  725. break;
  726. case DRM_FORMAT_NV16:
  727. case DRM_FORMAT_NV61:
  728. case DRM_FORMAT_YUV422:
  729. cfg |= EXYNOS_CITRGFMT_OUTFORMAT_YCBCR422;
  730. break;
  731. case DRM_FORMAT_YUV420:
  732. case DRM_FORMAT_YVU420:
  733. case DRM_FORMAT_NV12:
  734. case DRM_FORMAT_NV21:
  735. cfg |= EXYNOS_CITRGFMT_OUTFORMAT_YCBCR420;
  736. break;
  737. default:
  738. dev_err(ippdrv->dev, "inavlid target format 0x%x.\n",
  739. fmt);
  740. return -EINVAL;
  741. }
  742. fimc_write(ctx, cfg, EXYNOS_CITRGFMT);
  743. }
  744. cfg = fimc_read(ctx, EXYNOS_CIDMAPARAM);
  745. cfg &= ~EXYNOS_CIDMAPARAM_W_MODE_MASK;
  746. cfg |= EXYNOS_CIDMAPARAM_W_MODE_LINEAR;
  747. fimc_write(ctx, cfg, EXYNOS_CIDMAPARAM);
  748. return fimc_dst_set_fmt_order(ctx, fmt);
  749. }
  750. static int fimc_dst_set_transf(struct device *dev,
  751. enum drm_exynos_degree degree,
  752. enum drm_exynos_flip flip, bool *swap)
  753. {
  754. struct fimc_context *ctx = get_fimc_context(dev);
  755. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  756. u32 cfg;
  757. DRM_DEBUG_KMS("degree[%d]flip[0x%x]\n", degree, flip);
  758. cfg = fimc_read(ctx, EXYNOS_CITRGFMT);
  759. cfg &= ~EXYNOS_CITRGFMT_FLIP_MASK;
  760. cfg &= ~EXYNOS_CITRGFMT_OUTROT90_CLOCKWISE;
  761. switch (degree) {
  762. case EXYNOS_DRM_DEGREE_0:
  763. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  764. cfg |= EXYNOS_CITRGFMT_FLIP_X_MIRROR;
  765. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  766. cfg |= EXYNOS_CITRGFMT_FLIP_Y_MIRROR;
  767. break;
  768. case EXYNOS_DRM_DEGREE_90:
  769. cfg |= EXYNOS_CITRGFMT_OUTROT90_CLOCKWISE;
  770. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  771. cfg |= EXYNOS_CITRGFMT_FLIP_X_MIRROR;
  772. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  773. cfg |= EXYNOS_CITRGFMT_FLIP_Y_MIRROR;
  774. break;
  775. case EXYNOS_DRM_DEGREE_180:
  776. cfg |= (EXYNOS_CITRGFMT_FLIP_X_MIRROR |
  777. EXYNOS_CITRGFMT_FLIP_Y_MIRROR);
  778. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  779. cfg &= ~EXYNOS_CITRGFMT_FLIP_X_MIRROR;
  780. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  781. cfg &= ~EXYNOS_CITRGFMT_FLIP_Y_MIRROR;
  782. break;
  783. case EXYNOS_DRM_DEGREE_270:
  784. cfg |= (EXYNOS_CITRGFMT_OUTROT90_CLOCKWISE |
  785. EXYNOS_CITRGFMT_FLIP_X_MIRROR |
  786. EXYNOS_CITRGFMT_FLIP_Y_MIRROR);
  787. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  788. cfg &= ~EXYNOS_CITRGFMT_FLIP_X_MIRROR;
  789. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  790. cfg &= ~EXYNOS_CITRGFMT_FLIP_Y_MIRROR;
  791. break;
  792. default:
  793. dev_err(ippdrv->dev, "inavlid degree value %d.\n", degree);
  794. return -EINVAL;
  795. }
  796. fimc_write(ctx, cfg, EXYNOS_CITRGFMT);
  797. *swap = (cfg & EXYNOS_CITRGFMT_OUTROT90_CLOCKWISE) ? 1 : 0;
  798. return 0;
  799. }
  800. static int fimc_set_prescaler(struct fimc_context *ctx, struct fimc_scaler *sc,
  801. struct drm_exynos_pos *src, struct drm_exynos_pos *dst)
  802. {
  803. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  804. u32 cfg, cfg_ext, shfactor;
  805. u32 pre_dst_width, pre_dst_height;
  806. u32 hfactor, vfactor;
  807. int ret = 0;
  808. u32 src_w, src_h, dst_w, dst_h;
  809. cfg_ext = fimc_read(ctx, EXYNOS_CITRGFMT);
  810. if (cfg_ext & EXYNOS_CITRGFMT_INROT90_CLOCKWISE) {
  811. src_w = src->h;
  812. src_h = src->w;
  813. } else {
  814. src_w = src->w;
  815. src_h = src->h;
  816. }
  817. if (cfg_ext & EXYNOS_CITRGFMT_OUTROT90_CLOCKWISE) {
  818. dst_w = dst->h;
  819. dst_h = dst->w;
  820. } else {
  821. dst_w = dst->w;
  822. dst_h = dst->h;
  823. }
  824. /* fimc_ippdrv_check_property assures that dividers are not null */
  825. hfactor = fls(src_w / dst_w / 2);
  826. if (hfactor > FIMC_SHFACTOR / 2) {
  827. dev_err(ippdrv->dev, "failed to get ratio horizontal.\n");
  828. return -EINVAL;
  829. }
  830. vfactor = fls(src_h / dst_h / 2);
  831. if (vfactor > FIMC_SHFACTOR / 2) {
  832. dev_err(ippdrv->dev, "failed to get ratio vertical.\n");
  833. return -EINVAL;
  834. }
  835. pre_dst_width = src_w >> hfactor;
  836. pre_dst_height = src_h >> vfactor;
  837. DRM_DEBUG_KMS("pre_dst_width[%d]pre_dst_height[%d]\n",
  838. pre_dst_width, pre_dst_height);
  839. DRM_DEBUG_KMS("hfactor[%d]vfactor[%d]\n", hfactor, vfactor);
  840. sc->hratio = (src_w << 14) / (dst_w << hfactor);
  841. sc->vratio = (src_h << 14) / (dst_h << vfactor);
  842. sc->up_h = (dst_w >= src_w) ? true : false;
  843. sc->up_v = (dst_h >= src_h) ? true : false;
  844. DRM_DEBUG_KMS("hratio[%d]vratio[%d]up_h[%d]up_v[%d]\n",
  845. sc->hratio, sc->vratio, sc->up_h, sc->up_v);
  846. shfactor = FIMC_SHFACTOR - (hfactor + vfactor);
  847. DRM_DEBUG_KMS("shfactor[%d]\n", shfactor);
  848. cfg = (EXYNOS_CISCPRERATIO_SHFACTOR(shfactor) |
  849. EXYNOS_CISCPRERATIO_PREHORRATIO(1 << hfactor) |
  850. EXYNOS_CISCPRERATIO_PREVERRATIO(1 << vfactor));
  851. fimc_write(ctx, cfg, EXYNOS_CISCPRERATIO);
  852. cfg = (EXYNOS_CISCPREDST_PREDSTWIDTH(pre_dst_width) |
  853. EXYNOS_CISCPREDST_PREDSTHEIGHT(pre_dst_height));
  854. fimc_write(ctx, cfg, EXYNOS_CISCPREDST);
  855. return ret;
  856. }
  857. static void fimc_set_scaler(struct fimc_context *ctx, struct fimc_scaler *sc)
  858. {
  859. u32 cfg, cfg_ext;
  860. DRM_DEBUG_KMS("range[%d]bypass[%d]up_h[%d]up_v[%d]\n",
  861. sc->range, sc->bypass, sc->up_h, sc->up_v);
  862. DRM_DEBUG_KMS("hratio[%d]vratio[%d]\n",
  863. sc->hratio, sc->vratio);
  864. cfg = fimc_read(ctx, EXYNOS_CISCCTRL);
  865. cfg &= ~(EXYNOS_CISCCTRL_SCALERBYPASS |
  866. EXYNOS_CISCCTRL_SCALEUP_H | EXYNOS_CISCCTRL_SCALEUP_V |
  867. EXYNOS_CISCCTRL_MAIN_V_RATIO_MASK |
  868. EXYNOS_CISCCTRL_MAIN_H_RATIO_MASK |
  869. EXYNOS_CISCCTRL_CSCR2Y_WIDE |
  870. EXYNOS_CISCCTRL_CSCY2R_WIDE);
  871. if (sc->range)
  872. cfg |= (EXYNOS_CISCCTRL_CSCR2Y_WIDE |
  873. EXYNOS_CISCCTRL_CSCY2R_WIDE);
  874. if (sc->bypass)
  875. cfg |= EXYNOS_CISCCTRL_SCALERBYPASS;
  876. if (sc->up_h)
  877. cfg |= EXYNOS_CISCCTRL_SCALEUP_H;
  878. if (sc->up_v)
  879. cfg |= EXYNOS_CISCCTRL_SCALEUP_V;
  880. cfg |= (EXYNOS_CISCCTRL_MAINHORRATIO((sc->hratio >> 6)) |
  881. EXYNOS_CISCCTRL_MAINVERRATIO((sc->vratio >> 6)));
  882. fimc_write(ctx, cfg, EXYNOS_CISCCTRL);
  883. cfg_ext = fimc_read(ctx, EXYNOS_CIEXTEN);
  884. cfg_ext &= ~EXYNOS_CIEXTEN_MAINHORRATIO_EXT_MASK;
  885. cfg_ext &= ~EXYNOS_CIEXTEN_MAINVERRATIO_EXT_MASK;
  886. cfg_ext |= (EXYNOS_CIEXTEN_MAINHORRATIO_EXT(sc->hratio) |
  887. EXYNOS_CIEXTEN_MAINVERRATIO_EXT(sc->vratio));
  888. fimc_write(ctx, cfg_ext, EXYNOS_CIEXTEN);
  889. }
  890. static int fimc_dst_set_size(struct device *dev, int swap,
  891. struct drm_exynos_pos *pos, struct drm_exynos_sz *sz)
  892. {
  893. struct fimc_context *ctx = get_fimc_context(dev);
  894. struct drm_exynos_pos img_pos = *pos;
  895. struct drm_exynos_sz img_sz = *sz;
  896. u32 cfg;
  897. DRM_DEBUG_KMS("swap[%d]hsize[%d]vsize[%d]\n",
  898. swap, sz->hsize, sz->vsize);
  899. /* original size */
  900. cfg = (EXYNOS_ORGOSIZE_HORIZONTAL(img_sz.hsize) |
  901. EXYNOS_ORGOSIZE_VERTICAL(img_sz.vsize));
  902. fimc_write(ctx, cfg, EXYNOS_ORGOSIZE);
  903. DRM_DEBUG_KMS("x[%d]y[%d]w[%d]h[%d]\n", pos->x, pos->y, pos->w, pos->h);
  904. /* CSC ITU */
  905. cfg = fimc_read(ctx, EXYNOS_CIGCTRL);
  906. cfg &= ~EXYNOS_CIGCTRL_CSC_MASK;
  907. if (sz->hsize >= FIMC_WIDTH_ITU_709)
  908. cfg |= EXYNOS_CIGCTRL_CSC_ITU709;
  909. else
  910. cfg |= EXYNOS_CIGCTRL_CSC_ITU601;
  911. fimc_write(ctx, cfg, EXYNOS_CIGCTRL);
  912. if (swap) {
  913. img_pos.w = pos->h;
  914. img_pos.h = pos->w;
  915. img_sz.hsize = sz->vsize;
  916. img_sz.vsize = sz->hsize;
  917. }
  918. /* target image size */
  919. cfg = fimc_read(ctx, EXYNOS_CITRGFMT);
  920. cfg &= ~(EXYNOS_CITRGFMT_TARGETH_MASK |
  921. EXYNOS_CITRGFMT_TARGETV_MASK);
  922. cfg |= (EXYNOS_CITRGFMT_TARGETHSIZE(img_pos.w) |
  923. EXYNOS_CITRGFMT_TARGETVSIZE(img_pos.h));
  924. fimc_write(ctx, cfg, EXYNOS_CITRGFMT);
  925. /* target area */
  926. cfg = EXYNOS_CITAREA_TARGET_AREA(img_pos.w * img_pos.h);
  927. fimc_write(ctx, cfg, EXYNOS_CITAREA);
  928. /* offset Y(RGB), Cb, Cr */
  929. cfg = (EXYNOS_CIOYOFF_HORIZONTAL(img_pos.x) |
  930. EXYNOS_CIOYOFF_VERTICAL(img_pos.y));
  931. fimc_write(ctx, cfg, EXYNOS_CIOYOFF);
  932. cfg = (EXYNOS_CIOCBOFF_HORIZONTAL(img_pos.x) |
  933. EXYNOS_CIOCBOFF_VERTICAL(img_pos.y));
  934. fimc_write(ctx, cfg, EXYNOS_CIOCBOFF);
  935. cfg = (EXYNOS_CIOCROFF_HORIZONTAL(img_pos.x) |
  936. EXYNOS_CIOCROFF_VERTICAL(img_pos.y));
  937. fimc_write(ctx, cfg, EXYNOS_CIOCROFF);
  938. return 0;
  939. }
  940. static void fimc_dst_set_buf_seq(struct fimc_context *ctx, u32 buf_id,
  941. enum drm_exynos_ipp_buf_type buf_type)
  942. {
  943. unsigned long flags;
  944. u32 buf_num;
  945. u32 cfg;
  946. DRM_DEBUG_KMS("buf_id[%d]buf_type[%d]\n", buf_id, buf_type);
  947. spin_lock_irqsave(&ctx->lock, flags);
  948. cfg = fimc_read(ctx, EXYNOS_CIFCNTSEQ);
  949. if (buf_type == IPP_BUF_ENQUEUE)
  950. cfg |= (1 << buf_id);
  951. else
  952. cfg &= ~(1 << buf_id);
  953. fimc_write(ctx, cfg, EXYNOS_CIFCNTSEQ);
  954. buf_num = hweight32(cfg);
  955. if (buf_type == IPP_BUF_ENQUEUE && buf_num >= FIMC_BUF_START)
  956. fimc_mask_irq(ctx, true);
  957. else if (buf_type == IPP_BUF_DEQUEUE && buf_num <= FIMC_BUF_STOP)
  958. fimc_mask_irq(ctx, false);
  959. spin_unlock_irqrestore(&ctx->lock, flags);
  960. }
  961. static int fimc_dst_set_addr(struct device *dev,
  962. struct drm_exynos_ipp_buf_info *buf_info, u32 buf_id,
  963. enum drm_exynos_ipp_buf_type buf_type)
  964. {
  965. struct fimc_context *ctx = get_fimc_context(dev);
  966. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  967. struct drm_exynos_ipp_cmd_node *c_node = ippdrv->c_node;
  968. struct drm_exynos_ipp_property *property;
  969. struct drm_exynos_ipp_config *config;
  970. if (!c_node) {
  971. DRM_ERROR("failed to get c_node.\n");
  972. return -EINVAL;
  973. }
  974. property = &c_node->property;
  975. DRM_DEBUG_KMS("prop_id[%d]buf_id[%d]buf_type[%d]\n",
  976. property->prop_id, buf_id, buf_type);
  977. if (buf_id > FIMC_MAX_DST) {
  978. dev_info(ippdrv->dev, "inavlid buf_id %d.\n", buf_id);
  979. return -ENOMEM;
  980. }
  981. /* address register set */
  982. switch (buf_type) {
  983. case IPP_BUF_ENQUEUE:
  984. config = &property->config[EXYNOS_DRM_OPS_DST];
  985. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_Y],
  986. EXYNOS_CIOYSA(buf_id));
  987. if (config->fmt == DRM_FORMAT_YVU420) {
  988. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CR],
  989. EXYNOS_CIOCBSA(buf_id));
  990. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CB],
  991. EXYNOS_CIOCRSA(buf_id));
  992. } else {
  993. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CB],
  994. EXYNOS_CIOCBSA(buf_id));
  995. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CR],
  996. EXYNOS_CIOCRSA(buf_id));
  997. }
  998. break;
  999. case IPP_BUF_DEQUEUE:
  1000. fimc_write(ctx, 0x0, EXYNOS_CIOYSA(buf_id));
  1001. fimc_write(ctx, 0x0, EXYNOS_CIOCBSA(buf_id));
  1002. fimc_write(ctx, 0x0, EXYNOS_CIOCRSA(buf_id));
  1003. break;
  1004. default:
  1005. /* bypass */
  1006. break;
  1007. }
  1008. fimc_dst_set_buf_seq(ctx, buf_id, buf_type);
  1009. return 0;
  1010. }
  1011. static struct exynos_drm_ipp_ops fimc_dst_ops = {
  1012. .set_fmt = fimc_dst_set_fmt,
  1013. .set_transf = fimc_dst_set_transf,
  1014. .set_size = fimc_dst_set_size,
  1015. .set_addr = fimc_dst_set_addr,
  1016. };
  1017. static int fimc_clk_ctrl(struct fimc_context *ctx, bool enable)
  1018. {
  1019. DRM_DEBUG_KMS("enable[%d]\n", enable);
  1020. if (enable) {
  1021. clk_prepare_enable(ctx->clocks[FIMC_CLK_GATE]);
  1022. clk_prepare_enable(ctx->clocks[FIMC_CLK_WB_A]);
  1023. ctx->suspended = false;
  1024. } else {
  1025. clk_disable_unprepare(ctx->clocks[FIMC_CLK_GATE]);
  1026. clk_disable_unprepare(ctx->clocks[FIMC_CLK_WB_A]);
  1027. ctx->suspended = true;
  1028. }
  1029. return 0;
  1030. }
  1031. static irqreturn_t fimc_irq_handler(int irq, void *dev_id)
  1032. {
  1033. struct fimc_context *ctx = dev_id;
  1034. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  1035. struct drm_exynos_ipp_cmd_node *c_node = ippdrv->c_node;
  1036. struct drm_exynos_ipp_event_work *event_work =
  1037. c_node->event_work;
  1038. int buf_id;
  1039. DRM_DEBUG_KMS("fimc id[%d]\n", ctx->id);
  1040. fimc_clear_irq(ctx);
  1041. if (fimc_check_ovf(ctx))
  1042. return IRQ_NONE;
  1043. if (!fimc_check_frame_end(ctx))
  1044. return IRQ_NONE;
  1045. buf_id = fimc_get_buf_id(ctx);
  1046. if (buf_id < 0)
  1047. return IRQ_HANDLED;
  1048. DRM_DEBUG_KMS("buf_id[%d]\n", buf_id);
  1049. fimc_dst_set_buf_seq(ctx, buf_id, IPP_BUF_DEQUEUE);
  1050. event_work->ippdrv = ippdrv;
  1051. event_work->buf_id[EXYNOS_DRM_OPS_DST] = buf_id;
  1052. queue_work(ippdrv->event_workq, &event_work->work);
  1053. return IRQ_HANDLED;
  1054. }
  1055. static int fimc_init_prop_list(struct exynos_drm_ippdrv *ippdrv)
  1056. {
  1057. struct drm_exynos_ipp_prop_list *prop_list = &ippdrv->prop_list;
  1058. prop_list->version = 1;
  1059. prop_list->writeback = 1;
  1060. prop_list->refresh_min = FIMC_REFRESH_MIN;
  1061. prop_list->refresh_max = FIMC_REFRESH_MAX;
  1062. prop_list->flip = (1 << EXYNOS_DRM_FLIP_NONE) |
  1063. (1 << EXYNOS_DRM_FLIP_VERTICAL) |
  1064. (1 << EXYNOS_DRM_FLIP_HORIZONTAL);
  1065. prop_list->degree = (1 << EXYNOS_DRM_DEGREE_0) |
  1066. (1 << EXYNOS_DRM_DEGREE_90) |
  1067. (1 << EXYNOS_DRM_DEGREE_180) |
  1068. (1 << EXYNOS_DRM_DEGREE_270);
  1069. prop_list->csc = 1;
  1070. prop_list->crop = 1;
  1071. prop_list->crop_max.hsize = FIMC_CROP_MAX;
  1072. prop_list->crop_max.vsize = FIMC_CROP_MAX;
  1073. prop_list->crop_min.hsize = FIMC_CROP_MIN;
  1074. prop_list->crop_min.vsize = FIMC_CROP_MIN;
  1075. prop_list->scale = 1;
  1076. prop_list->scale_max.hsize = FIMC_SCALE_MAX;
  1077. prop_list->scale_max.vsize = FIMC_SCALE_MAX;
  1078. prop_list->scale_min.hsize = FIMC_SCALE_MIN;
  1079. prop_list->scale_min.vsize = FIMC_SCALE_MIN;
  1080. return 0;
  1081. }
  1082. static inline bool fimc_check_drm_flip(enum drm_exynos_flip flip)
  1083. {
  1084. switch (flip) {
  1085. case EXYNOS_DRM_FLIP_NONE:
  1086. case EXYNOS_DRM_FLIP_VERTICAL:
  1087. case EXYNOS_DRM_FLIP_HORIZONTAL:
  1088. case EXYNOS_DRM_FLIP_BOTH:
  1089. return true;
  1090. default:
  1091. DRM_DEBUG_KMS("invalid flip\n");
  1092. return false;
  1093. }
  1094. }
  1095. static int fimc_ippdrv_check_property(struct device *dev,
  1096. struct drm_exynos_ipp_property *property)
  1097. {
  1098. struct fimc_context *ctx = get_fimc_context(dev);
  1099. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  1100. struct drm_exynos_ipp_prop_list *pp = &ippdrv->prop_list;
  1101. struct drm_exynos_ipp_config *config;
  1102. struct drm_exynos_pos *pos;
  1103. struct drm_exynos_sz *sz;
  1104. bool swap;
  1105. int i;
  1106. for_each_ipp_ops(i) {
  1107. if ((i == EXYNOS_DRM_OPS_SRC) &&
  1108. (property->cmd == IPP_CMD_WB))
  1109. continue;
  1110. config = &property->config[i];
  1111. pos = &config->pos;
  1112. sz = &config->sz;
  1113. /* check for flip */
  1114. if (!fimc_check_drm_flip(config->flip)) {
  1115. DRM_ERROR("invalid flip.\n");
  1116. goto err_property;
  1117. }
  1118. /* check for degree */
  1119. switch (config->degree) {
  1120. case EXYNOS_DRM_DEGREE_90:
  1121. case EXYNOS_DRM_DEGREE_270:
  1122. swap = true;
  1123. break;
  1124. case EXYNOS_DRM_DEGREE_0:
  1125. case EXYNOS_DRM_DEGREE_180:
  1126. swap = false;
  1127. break;
  1128. default:
  1129. DRM_ERROR("invalid degree.\n");
  1130. goto err_property;
  1131. }
  1132. /* check for buffer bound */
  1133. if ((pos->x + pos->w > sz->hsize) ||
  1134. (pos->y + pos->h > sz->vsize)) {
  1135. DRM_ERROR("out of buf bound.\n");
  1136. goto err_property;
  1137. }
  1138. /* check for crop */
  1139. if ((i == EXYNOS_DRM_OPS_SRC) && (pp->crop)) {
  1140. if (swap) {
  1141. if ((pos->h < pp->crop_min.hsize) ||
  1142. (sz->vsize > pp->crop_max.hsize) ||
  1143. (pos->w < pp->crop_min.vsize) ||
  1144. (sz->hsize > pp->crop_max.vsize)) {
  1145. DRM_ERROR("out of crop size.\n");
  1146. goto err_property;
  1147. }
  1148. } else {
  1149. if ((pos->w < pp->crop_min.hsize) ||
  1150. (sz->hsize > pp->crop_max.hsize) ||
  1151. (pos->h < pp->crop_min.vsize) ||
  1152. (sz->vsize > pp->crop_max.vsize)) {
  1153. DRM_ERROR("out of crop size.\n");
  1154. goto err_property;
  1155. }
  1156. }
  1157. }
  1158. /* check for scale */
  1159. if ((i == EXYNOS_DRM_OPS_DST) && (pp->scale)) {
  1160. if (swap) {
  1161. if ((pos->h < pp->scale_min.hsize) ||
  1162. (sz->vsize > pp->scale_max.hsize) ||
  1163. (pos->w < pp->scale_min.vsize) ||
  1164. (sz->hsize > pp->scale_max.vsize)) {
  1165. DRM_ERROR("out of scale size.\n");
  1166. goto err_property;
  1167. }
  1168. } else {
  1169. if ((pos->w < pp->scale_min.hsize) ||
  1170. (sz->hsize > pp->scale_max.hsize) ||
  1171. (pos->h < pp->scale_min.vsize) ||
  1172. (sz->vsize > pp->scale_max.vsize)) {
  1173. DRM_ERROR("out of scale size.\n");
  1174. goto err_property;
  1175. }
  1176. }
  1177. }
  1178. }
  1179. return 0;
  1180. err_property:
  1181. for_each_ipp_ops(i) {
  1182. if ((i == EXYNOS_DRM_OPS_SRC) &&
  1183. (property->cmd == IPP_CMD_WB))
  1184. continue;
  1185. config = &property->config[i];
  1186. pos = &config->pos;
  1187. sz = &config->sz;
  1188. DRM_ERROR("[%s]f[%d]r[%d]pos[%d %d %d %d]sz[%d %d]\n",
  1189. i ? "dst" : "src", config->flip, config->degree,
  1190. pos->x, pos->y, pos->w, pos->h,
  1191. sz->hsize, sz->vsize);
  1192. }
  1193. return -EINVAL;
  1194. }
  1195. static void fimc_clear_addr(struct fimc_context *ctx)
  1196. {
  1197. int i;
  1198. for (i = 0; i < FIMC_MAX_SRC; i++) {
  1199. fimc_write(ctx, 0, EXYNOS_CIIYSA(i));
  1200. fimc_write(ctx, 0, EXYNOS_CIICBSA(i));
  1201. fimc_write(ctx, 0, EXYNOS_CIICRSA(i));
  1202. }
  1203. for (i = 0; i < FIMC_MAX_DST; i++) {
  1204. fimc_write(ctx, 0, EXYNOS_CIOYSA(i));
  1205. fimc_write(ctx, 0, EXYNOS_CIOCBSA(i));
  1206. fimc_write(ctx, 0, EXYNOS_CIOCRSA(i));
  1207. }
  1208. }
  1209. static int fimc_ippdrv_reset(struct device *dev)
  1210. {
  1211. struct fimc_context *ctx = get_fimc_context(dev);
  1212. /* reset h/w block */
  1213. fimc_sw_reset(ctx);
  1214. /* reset scaler capability */
  1215. memset(&ctx->sc, 0x0, sizeof(ctx->sc));
  1216. fimc_clear_addr(ctx);
  1217. return 0;
  1218. }
  1219. static int fimc_ippdrv_start(struct device *dev, enum drm_exynos_ipp_cmd cmd)
  1220. {
  1221. struct fimc_context *ctx = get_fimc_context(dev);
  1222. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  1223. struct drm_exynos_ipp_cmd_node *c_node = ippdrv->c_node;
  1224. struct drm_exynos_ipp_property *property;
  1225. struct drm_exynos_ipp_config *config;
  1226. struct drm_exynos_pos img_pos[EXYNOS_DRM_OPS_MAX];
  1227. struct drm_exynos_ipp_set_wb set_wb;
  1228. int ret, i;
  1229. u32 cfg0, cfg1;
  1230. DRM_DEBUG_KMS("cmd[%d]\n", cmd);
  1231. if (!c_node) {
  1232. DRM_ERROR("failed to get c_node.\n");
  1233. return -EINVAL;
  1234. }
  1235. property = &c_node->property;
  1236. fimc_mask_irq(ctx, true);
  1237. for_each_ipp_ops(i) {
  1238. config = &property->config[i];
  1239. img_pos[i] = config->pos;
  1240. }
  1241. ret = fimc_set_prescaler(ctx, &ctx->sc,
  1242. &img_pos[EXYNOS_DRM_OPS_SRC],
  1243. &img_pos[EXYNOS_DRM_OPS_DST]);
  1244. if (ret) {
  1245. dev_err(dev, "failed to set precalser.\n");
  1246. return ret;
  1247. }
  1248. /* If set ture, we can save jpeg about screen */
  1249. fimc_handle_jpeg(ctx, false);
  1250. fimc_set_scaler(ctx, &ctx->sc);
  1251. fimc_set_polarity(ctx, &ctx->pol);
  1252. switch (cmd) {
  1253. case IPP_CMD_M2M:
  1254. fimc_set_type_ctrl(ctx, FIMC_WB_NONE);
  1255. fimc_handle_lastend(ctx, false);
  1256. /* setup dma */
  1257. cfg0 = fimc_read(ctx, EXYNOS_MSCTRL);
  1258. cfg0 &= ~EXYNOS_MSCTRL_INPUT_MASK;
  1259. cfg0 |= EXYNOS_MSCTRL_INPUT_MEMORY;
  1260. fimc_write(ctx, cfg0, EXYNOS_MSCTRL);
  1261. break;
  1262. case IPP_CMD_WB:
  1263. fimc_set_type_ctrl(ctx, FIMC_WB_A);
  1264. fimc_handle_lastend(ctx, true);
  1265. /* setup FIMD */
  1266. ret = fimc_set_camblk_fimd0_wb(ctx);
  1267. if (ret < 0) {
  1268. dev_err(dev, "camblk setup failed.\n");
  1269. return ret;
  1270. }
  1271. set_wb.enable = 1;
  1272. set_wb.refresh = property->refresh_rate;
  1273. exynos_drm_ippnb_send_event(IPP_SET_WRITEBACK, (void *)&set_wb);
  1274. break;
  1275. case IPP_CMD_OUTPUT:
  1276. default:
  1277. ret = -EINVAL;
  1278. dev_err(dev, "invalid operations.\n");
  1279. return ret;
  1280. }
  1281. /* Reset status */
  1282. fimc_write(ctx, 0x0, EXYNOS_CISTATUS);
  1283. cfg0 = fimc_read(ctx, EXYNOS_CIIMGCPT);
  1284. cfg0 &= ~EXYNOS_CIIMGCPT_IMGCPTEN_SC;
  1285. cfg0 |= EXYNOS_CIIMGCPT_IMGCPTEN_SC;
  1286. /* Scaler */
  1287. cfg1 = fimc_read(ctx, EXYNOS_CISCCTRL);
  1288. cfg1 &= ~EXYNOS_CISCCTRL_SCAN_MASK;
  1289. cfg1 |= (EXYNOS_CISCCTRL_PROGRESSIVE |
  1290. EXYNOS_CISCCTRL_SCALERSTART);
  1291. fimc_write(ctx, cfg1, EXYNOS_CISCCTRL);
  1292. /* Enable image capture*/
  1293. cfg0 |= EXYNOS_CIIMGCPT_IMGCPTEN;
  1294. fimc_write(ctx, cfg0, EXYNOS_CIIMGCPT);
  1295. /* Disable frame end irq */
  1296. fimc_clear_bits(ctx, EXYNOS_CIGCTRL, EXYNOS_CIGCTRL_IRQ_END_DISABLE);
  1297. fimc_clear_bits(ctx, EXYNOS_CIOCTRL, EXYNOS_CIOCTRL_WEAVE_MASK);
  1298. if (cmd == IPP_CMD_M2M)
  1299. fimc_set_bits(ctx, EXYNOS_MSCTRL, EXYNOS_MSCTRL_ENVID);
  1300. return 0;
  1301. }
  1302. static void fimc_ippdrv_stop(struct device *dev, enum drm_exynos_ipp_cmd cmd)
  1303. {
  1304. struct fimc_context *ctx = get_fimc_context(dev);
  1305. struct drm_exynos_ipp_set_wb set_wb = {0, 0};
  1306. u32 cfg;
  1307. DRM_DEBUG_KMS("cmd[%d]\n", cmd);
  1308. switch (cmd) {
  1309. case IPP_CMD_M2M:
  1310. /* Source clear */
  1311. cfg = fimc_read(ctx, EXYNOS_MSCTRL);
  1312. cfg &= ~EXYNOS_MSCTRL_INPUT_MASK;
  1313. cfg &= ~EXYNOS_MSCTRL_ENVID;
  1314. fimc_write(ctx, cfg, EXYNOS_MSCTRL);
  1315. break;
  1316. case IPP_CMD_WB:
  1317. exynos_drm_ippnb_send_event(IPP_SET_WRITEBACK, (void *)&set_wb);
  1318. break;
  1319. case IPP_CMD_OUTPUT:
  1320. default:
  1321. dev_err(dev, "invalid operations.\n");
  1322. break;
  1323. }
  1324. fimc_mask_irq(ctx, false);
  1325. /* reset sequence */
  1326. fimc_write(ctx, 0x0, EXYNOS_CIFCNTSEQ);
  1327. /* Scaler disable */
  1328. fimc_clear_bits(ctx, EXYNOS_CISCCTRL, EXYNOS_CISCCTRL_SCALERSTART);
  1329. /* Disable image capture */
  1330. fimc_clear_bits(ctx, EXYNOS_CIIMGCPT,
  1331. EXYNOS_CIIMGCPT_IMGCPTEN_SC | EXYNOS_CIIMGCPT_IMGCPTEN);
  1332. /* Enable frame end irq */
  1333. fimc_set_bits(ctx, EXYNOS_CIGCTRL, EXYNOS_CIGCTRL_IRQ_END_DISABLE);
  1334. }
  1335. static void fimc_put_clocks(struct fimc_context *ctx)
  1336. {
  1337. int i;
  1338. for (i = 0; i < FIMC_CLKS_MAX; i++) {
  1339. if (IS_ERR(ctx->clocks[i]))
  1340. continue;
  1341. clk_put(ctx->clocks[i]);
  1342. ctx->clocks[i] = ERR_PTR(-EINVAL);
  1343. }
  1344. }
  1345. static int fimc_setup_clocks(struct fimc_context *ctx)
  1346. {
  1347. struct device *fimc_dev = ctx->ippdrv.dev;
  1348. struct device *dev;
  1349. int ret, i;
  1350. for (i = 0; i < FIMC_CLKS_MAX; i++)
  1351. ctx->clocks[i] = ERR_PTR(-EINVAL);
  1352. for (i = 0; i < FIMC_CLKS_MAX; i++) {
  1353. if (i == FIMC_CLK_WB_A || i == FIMC_CLK_WB_B)
  1354. dev = fimc_dev->parent;
  1355. else
  1356. dev = fimc_dev;
  1357. ctx->clocks[i] = clk_get(dev, fimc_clock_names[i]);
  1358. if (IS_ERR(ctx->clocks[i])) {
  1359. if (i >= FIMC_CLK_MUX)
  1360. break;
  1361. ret = PTR_ERR(ctx->clocks[i]);
  1362. dev_err(fimc_dev, "failed to get clock: %s\n",
  1363. fimc_clock_names[i]);
  1364. goto e_clk_free;
  1365. }
  1366. }
  1367. /* Optional FIMC LCLK parent clock setting */
  1368. if (!IS_ERR(ctx->clocks[FIMC_CLK_PARENT])) {
  1369. ret = clk_set_parent(ctx->clocks[FIMC_CLK_MUX],
  1370. ctx->clocks[FIMC_CLK_PARENT]);
  1371. if (ret < 0) {
  1372. dev_err(fimc_dev, "failed to set parent.\n");
  1373. goto e_clk_free;
  1374. }
  1375. }
  1376. ret = clk_set_rate(ctx->clocks[FIMC_CLK_LCLK], ctx->clk_frequency);
  1377. if (ret < 0)
  1378. goto e_clk_free;
  1379. ret = clk_prepare_enable(ctx->clocks[FIMC_CLK_LCLK]);
  1380. if (!ret)
  1381. return ret;
  1382. e_clk_free:
  1383. fimc_put_clocks(ctx);
  1384. return ret;
  1385. }
  1386. static int fimc_parse_dt(struct fimc_context *ctx)
  1387. {
  1388. struct device_node *node = ctx->ippdrv.dev->of_node;
  1389. /* Handle only devices that support the LCD Writeback data path */
  1390. if (!of_property_read_bool(node, "samsung,lcd-wb"))
  1391. return -ENODEV;
  1392. if (of_property_read_u32(node, "clock-frequency",
  1393. &ctx->clk_frequency))
  1394. ctx->clk_frequency = FIMC_DEFAULT_LCLK_FREQUENCY;
  1395. ctx->id = of_alias_get_id(node, "fimc");
  1396. if (ctx->id < 0) {
  1397. dev_err(ctx->ippdrv.dev, "failed to get node alias id.\n");
  1398. return -EINVAL;
  1399. }
  1400. return 0;
  1401. }
  1402. static int fimc_probe(struct platform_device *pdev)
  1403. {
  1404. struct device *dev = &pdev->dev;
  1405. struct fimc_context *ctx;
  1406. struct resource *res;
  1407. struct exynos_drm_ippdrv *ippdrv;
  1408. int ret;
  1409. if (!dev->of_node) {
  1410. dev_err(dev, "device tree node not found.\n");
  1411. return -ENODEV;
  1412. }
  1413. ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL);
  1414. if (!ctx)
  1415. return -ENOMEM;
  1416. ctx->ippdrv.dev = dev;
  1417. ret = fimc_parse_dt(ctx);
  1418. if (ret < 0)
  1419. return ret;
  1420. ctx->sysreg = syscon_regmap_lookup_by_phandle(dev->of_node,
  1421. "samsung,sysreg");
  1422. if (IS_ERR(ctx->sysreg)) {
  1423. dev_err(dev, "syscon regmap lookup failed.\n");
  1424. return PTR_ERR(ctx->sysreg);
  1425. }
  1426. /* resource memory */
  1427. ctx->regs_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  1428. ctx->regs = devm_ioremap_resource(dev, ctx->regs_res);
  1429. if (IS_ERR(ctx->regs))
  1430. return PTR_ERR(ctx->regs);
  1431. /* resource irq */
  1432. res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
  1433. if (!res) {
  1434. dev_err(dev, "failed to request irq resource.\n");
  1435. return -ENOENT;
  1436. }
  1437. ctx->irq = res->start;
  1438. ret = devm_request_threaded_irq(dev, ctx->irq, NULL, fimc_irq_handler,
  1439. IRQF_ONESHOT, "drm_fimc", ctx);
  1440. if (ret < 0) {
  1441. dev_err(dev, "failed to request irq.\n");
  1442. return ret;
  1443. }
  1444. ret = fimc_setup_clocks(ctx);
  1445. if (ret < 0)
  1446. return ret;
  1447. ippdrv = &ctx->ippdrv;
  1448. ippdrv->ops[EXYNOS_DRM_OPS_SRC] = &fimc_src_ops;
  1449. ippdrv->ops[EXYNOS_DRM_OPS_DST] = &fimc_dst_ops;
  1450. ippdrv->check_property = fimc_ippdrv_check_property;
  1451. ippdrv->reset = fimc_ippdrv_reset;
  1452. ippdrv->start = fimc_ippdrv_start;
  1453. ippdrv->stop = fimc_ippdrv_stop;
  1454. ret = fimc_init_prop_list(ippdrv);
  1455. if (ret < 0) {
  1456. dev_err(dev, "failed to init property list.\n");
  1457. goto err_put_clk;
  1458. }
  1459. DRM_DEBUG_KMS("id[%d]ippdrv[0x%x]\n", ctx->id, (int)ippdrv);
  1460. spin_lock_init(&ctx->lock);
  1461. platform_set_drvdata(pdev, ctx);
  1462. pm_runtime_set_active(dev);
  1463. pm_runtime_enable(dev);
  1464. ret = exynos_drm_ippdrv_register(ippdrv);
  1465. if (ret < 0) {
  1466. dev_err(dev, "failed to register drm fimc device.\n");
  1467. goto err_pm_dis;
  1468. }
  1469. dev_info(dev, "drm fimc registered successfully.\n");
  1470. return 0;
  1471. err_pm_dis:
  1472. pm_runtime_disable(dev);
  1473. err_put_clk:
  1474. fimc_put_clocks(ctx);
  1475. return ret;
  1476. }
  1477. static int fimc_remove(struct platform_device *pdev)
  1478. {
  1479. struct device *dev = &pdev->dev;
  1480. struct fimc_context *ctx = get_fimc_context(dev);
  1481. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  1482. exynos_drm_ippdrv_unregister(ippdrv);
  1483. fimc_put_clocks(ctx);
  1484. pm_runtime_set_suspended(dev);
  1485. pm_runtime_disable(dev);
  1486. return 0;
  1487. }
  1488. #ifdef CONFIG_PM_SLEEP
  1489. static int fimc_suspend(struct device *dev)
  1490. {
  1491. struct fimc_context *ctx = get_fimc_context(dev);
  1492. DRM_DEBUG_KMS("id[%d]\n", ctx->id);
  1493. if (pm_runtime_suspended(dev))
  1494. return 0;
  1495. return fimc_clk_ctrl(ctx, false);
  1496. }
  1497. static int fimc_resume(struct device *dev)
  1498. {
  1499. struct fimc_context *ctx = get_fimc_context(dev);
  1500. DRM_DEBUG_KMS("id[%d]\n", ctx->id);
  1501. if (!pm_runtime_suspended(dev))
  1502. return fimc_clk_ctrl(ctx, true);
  1503. return 0;
  1504. }
  1505. #endif
  1506. #ifdef CONFIG_PM
  1507. static int fimc_runtime_suspend(struct device *dev)
  1508. {
  1509. struct fimc_context *ctx = get_fimc_context(dev);
  1510. DRM_DEBUG_KMS("id[%d]\n", ctx->id);
  1511. return fimc_clk_ctrl(ctx, false);
  1512. }
  1513. static int fimc_runtime_resume(struct device *dev)
  1514. {
  1515. struct fimc_context *ctx = get_fimc_context(dev);
  1516. DRM_DEBUG_KMS("id[%d]\n", ctx->id);
  1517. return fimc_clk_ctrl(ctx, true);
  1518. }
  1519. #endif
  1520. static const struct dev_pm_ops fimc_pm_ops = {
  1521. SET_SYSTEM_SLEEP_PM_OPS(fimc_suspend, fimc_resume)
  1522. SET_RUNTIME_PM_OPS(fimc_runtime_suspend, fimc_runtime_resume, NULL)
  1523. };
  1524. static const struct of_device_id fimc_of_match[] = {
  1525. { .compatible = "samsung,exynos4210-fimc" },
  1526. { .compatible = "samsung,exynos4212-fimc" },
  1527. { },
  1528. };
  1529. MODULE_DEVICE_TABLE(of, fimc_of_match);
  1530. struct platform_driver fimc_driver = {
  1531. .probe = fimc_probe,
  1532. .remove = fimc_remove,
  1533. .driver = {
  1534. .of_match_table = fimc_of_match,
  1535. .name = "exynos-drm-fimc",
  1536. .owner = THIS_MODULE,
  1537. .pm = &fimc_pm_ops,
  1538. },
  1539. };