exynos_drm_fimc.c 46 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862
  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_NV12MT:
  392. case DRM_FORMAT_NV16:
  393. cfg |= (EXYNOS_MSCTRL_ORDER2P_LSB_CBCR |
  394. EXYNOS_MSCTRL_C_INT_IN_2PLANE);
  395. break;
  396. default:
  397. dev_err(ippdrv->dev, "inavlid source yuv order 0x%x.\n", fmt);
  398. return -EINVAL;
  399. }
  400. fimc_write(ctx, cfg, EXYNOS_MSCTRL);
  401. return 0;
  402. }
  403. static int fimc_src_set_fmt(struct device *dev, u32 fmt)
  404. {
  405. struct fimc_context *ctx = get_fimc_context(dev);
  406. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  407. u32 cfg;
  408. DRM_DEBUG_KMS("fmt[0x%x]\n", fmt);
  409. cfg = fimc_read(ctx, EXYNOS_MSCTRL);
  410. cfg &= ~EXYNOS_MSCTRL_INFORMAT_RGB;
  411. switch (fmt) {
  412. case DRM_FORMAT_RGB565:
  413. case DRM_FORMAT_RGB888:
  414. case DRM_FORMAT_XRGB8888:
  415. cfg |= EXYNOS_MSCTRL_INFORMAT_RGB;
  416. break;
  417. case DRM_FORMAT_YUV444:
  418. cfg |= EXYNOS_MSCTRL_INFORMAT_YCBCR420;
  419. break;
  420. case DRM_FORMAT_YUYV:
  421. case DRM_FORMAT_YVYU:
  422. case DRM_FORMAT_UYVY:
  423. case DRM_FORMAT_VYUY:
  424. cfg |= EXYNOS_MSCTRL_INFORMAT_YCBCR422_1PLANE;
  425. break;
  426. case DRM_FORMAT_NV16:
  427. case DRM_FORMAT_NV61:
  428. case DRM_FORMAT_YUV422:
  429. cfg |= EXYNOS_MSCTRL_INFORMAT_YCBCR422;
  430. break;
  431. case DRM_FORMAT_YUV420:
  432. case DRM_FORMAT_YVU420:
  433. case DRM_FORMAT_NV12:
  434. case DRM_FORMAT_NV21:
  435. case DRM_FORMAT_NV12MT:
  436. cfg |= EXYNOS_MSCTRL_INFORMAT_YCBCR420;
  437. break;
  438. default:
  439. dev_err(ippdrv->dev, "inavlid source format 0x%x.\n", fmt);
  440. return -EINVAL;
  441. }
  442. fimc_write(ctx, cfg, EXYNOS_MSCTRL);
  443. cfg = fimc_read(ctx, EXYNOS_CIDMAPARAM);
  444. cfg &= ~EXYNOS_CIDMAPARAM_R_MODE_MASK;
  445. if (fmt == DRM_FORMAT_NV12MT)
  446. cfg |= EXYNOS_CIDMAPARAM_R_MODE_64X32;
  447. else
  448. cfg |= EXYNOS_CIDMAPARAM_R_MODE_LINEAR;
  449. fimc_write(ctx, cfg, EXYNOS_CIDMAPARAM);
  450. return fimc_src_set_fmt_order(ctx, fmt);
  451. }
  452. static int fimc_src_set_transf(struct device *dev,
  453. enum drm_exynos_degree degree,
  454. enum drm_exynos_flip flip, bool *swap)
  455. {
  456. struct fimc_context *ctx = get_fimc_context(dev);
  457. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  458. u32 cfg1, cfg2;
  459. DRM_DEBUG_KMS("degree[%d]flip[0x%x]\n", degree, flip);
  460. cfg1 = fimc_read(ctx, EXYNOS_MSCTRL);
  461. cfg1 &= ~(EXYNOS_MSCTRL_FLIP_X_MIRROR |
  462. EXYNOS_MSCTRL_FLIP_Y_MIRROR);
  463. cfg2 = fimc_read(ctx, EXYNOS_CITRGFMT);
  464. cfg2 &= ~EXYNOS_CITRGFMT_INROT90_CLOCKWISE;
  465. switch (degree) {
  466. case EXYNOS_DRM_DEGREE_0:
  467. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  468. cfg1 |= EXYNOS_MSCTRL_FLIP_X_MIRROR;
  469. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  470. cfg1 |= EXYNOS_MSCTRL_FLIP_Y_MIRROR;
  471. break;
  472. case EXYNOS_DRM_DEGREE_90:
  473. cfg2 |= EXYNOS_CITRGFMT_INROT90_CLOCKWISE;
  474. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  475. cfg1 |= EXYNOS_MSCTRL_FLIP_X_MIRROR;
  476. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  477. cfg1 |= EXYNOS_MSCTRL_FLIP_Y_MIRROR;
  478. break;
  479. case EXYNOS_DRM_DEGREE_180:
  480. cfg1 |= (EXYNOS_MSCTRL_FLIP_X_MIRROR |
  481. EXYNOS_MSCTRL_FLIP_Y_MIRROR);
  482. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  483. cfg1 &= ~EXYNOS_MSCTRL_FLIP_X_MIRROR;
  484. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  485. cfg1 &= ~EXYNOS_MSCTRL_FLIP_Y_MIRROR;
  486. break;
  487. case EXYNOS_DRM_DEGREE_270:
  488. cfg1 |= (EXYNOS_MSCTRL_FLIP_X_MIRROR |
  489. EXYNOS_MSCTRL_FLIP_Y_MIRROR);
  490. cfg2 |= EXYNOS_CITRGFMT_INROT90_CLOCKWISE;
  491. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  492. cfg1 &= ~EXYNOS_MSCTRL_FLIP_X_MIRROR;
  493. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  494. cfg1 &= ~EXYNOS_MSCTRL_FLIP_Y_MIRROR;
  495. break;
  496. default:
  497. dev_err(ippdrv->dev, "inavlid degree value %d.\n", degree);
  498. return -EINVAL;
  499. }
  500. fimc_write(ctx, cfg1, EXYNOS_MSCTRL);
  501. fimc_write(ctx, cfg2, EXYNOS_CITRGFMT);
  502. *swap = (cfg2 & EXYNOS_CITRGFMT_INROT90_CLOCKWISE) ? 1 : 0;
  503. return 0;
  504. }
  505. static int fimc_set_window(struct fimc_context *ctx,
  506. struct drm_exynos_pos *pos, struct drm_exynos_sz *sz)
  507. {
  508. u32 cfg, h1, h2, v1, v2;
  509. /* cropped image */
  510. h1 = pos->x;
  511. h2 = sz->hsize - pos->w - pos->x;
  512. v1 = pos->y;
  513. v2 = sz->vsize - pos->h - pos->y;
  514. DRM_DEBUG_KMS("x[%d]y[%d]w[%d]h[%d]hsize[%d]vsize[%d]\n",
  515. pos->x, pos->y, pos->w, pos->h, sz->hsize, sz->vsize);
  516. DRM_DEBUG_KMS("h1[%d]h2[%d]v1[%d]v2[%d]\n", h1, h2, v1, v2);
  517. /*
  518. * set window offset 1, 2 size
  519. * check figure 43-21 in user manual
  520. */
  521. cfg = fimc_read(ctx, EXYNOS_CIWDOFST);
  522. cfg &= ~(EXYNOS_CIWDOFST_WINHOROFST_MASK |
  523. EXYNOS_CIWDOFST_WINVEROFST_MASK);
  524. cfg |= (EXYNOS_CIWDOFST_WINHOROFST(h1) |
  525. EXYNOS_CIWDOFST_WINVEROFST(v1));
  526. cfg |= EXYNOS_CIWDOFST_WINOFSEN;
  527. fimc_write(ctx, cfg, EXYNOS_CIWDOFST);
  528. cfg = (EXYNOS_CIWDOFST2_WINHOROFST2(h2) |
  529. EXYNOS_CIWDOFST2_WINVEROFST2(v2));
  530. fimc_write(ctx, cfg, EXYNOS_CIWDOFST2);
  531. return 0;
  532. }
  533. static int fimc_src_set_size(struct device *dev, int swap,
  534. struct drm_exynos_pos *pos, struct drm_exynos_sz *sz)
  535. {
  536. struct fimc_context *ctx = get_fimc_context(dev);
  537. struct drm_exynos_pos img_pos = *pos;
  538. struct drm_exynos_sz img_sz = *sz;
  539. u32 cfg;
  540. DRM_DEBUG_KMS("swap[%d]hsize[%d]vsize[%d]\n",
  541. swap, sz->hsize, sz->vsize);
  542. /* original size */
  543. cfg = (EXYNOS_ORGISIZE_HORIZONTAL(img_sz.hsize) |
  544. EXYNOS_ORGISIZE_VERTICAL(img_sz.vsize));
  545. fimc_write(ctx, cfg, EXYNOS_ORGISIZE);
  546. DRM_DEBUG_KMS("x[%d]y[%d]w[%d]h[%d]\n", pos->x, pos->y, pos->w, pos->h);
  547. if (swap) {
  548. img_pos.w = pos->h;
  549. img_pos.h = pos->w;
  550. img_sz.hsize = sz->vsize;
  551. img_sz.vsize = sz->hsize;
  552. }
  553. /* set input DMA image size */
  554. cfg = fimc_read(ctx, EXYNOS_CIREAL_ISIZE);
  555. cfg &= ~(EXYNOS_CIREAL_ISIZE_HEIGHT_MASK |
  556. EXYNOS_CIREAL_ISIZE_WIDTH_MASK);
  557. cfg |= (EXYNOS_CIREAL_ISIZE_WIDTH(img_pos.w) |
  558. EXYNOS_CIREAL_ISIZE_HEIGHT(img_pos.h));
  559. fimc_write(ctx, cfg, EXYNOS_CIREAL_ISIZE);
  560. /*
  561. * set input FIFO image size
  562. * for now, we support only ITU601 8 bit mode
  563. */
  564. cfg = (EXYNOS_CISRCFMT_ITU601_8BIT |
  565. EXYNOS_CISRCFMT_SOURCEHSIZE(img_sz.hsize) |
  566. EXYNOS_CISRCFMT_SOURCEVSIZE(img_sz.vsize));
  567. fimc_write(ctx, cfg, EXYNOS_CISRCFMT);
  568. /* offset Y(RGB), Cb, Cr */
  569. cfg = (EXYNOS_CIIYOFF_HORIZONTAL(img_pos.x) |
  570. EXYNOS_CIIYOFF_VERTICAL(img_pos.y));
  571. fimc_write(ctx, cfg, EXYNOS_CIIYOFF);
  572. cfg = (EXYNOS_CIICBOFF_HORIZONTAL(img_pos.x) |
  573. EXYNOS_CIICBOFF_VERTICAL(img_pos.y));
  574. fimc_write(ctx, cfg, EXYNOS_CIICBOFF);
  575. cfg = (EXYNOS_CIICROFF_HORIZONTAL(img_pos.x) |
  576. EXYNOS_CIICROFF_VERTICAL(img_pos.y));
  577. fimc_write(ctx, cfg, EXYNOS_CIICROFF);
  578. return fimc_set_window(ctx, &img_pos, &img_sz);
  579. }
  580. static int fimc_src_set_addr(struct device *dev,
  581. struct drm_exynos_ipp_buf_info *buf_info, u32 buf_id,
  582. enum drm_exynos_ipp_buf_type buf_type)
  583. {
  584. struct fimc_context *ctx = get_fimc_context(dev);
  585. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  586. struct drm_exynos_ipp_cmd_node *c_node = ippdrv->c_node;
  587. struct drm_exynos_ipp_property *property;
  588. struct drm_exynos_ipp_config *config;
  589. if (!c_node) {
  590. DRM_ERROR("failed to get c_node.\n");
  591. return -EINVAL;
  592. }
  593. property = &c_node->property;
  594. DRM_DEBUG_KMS("prop_id[%d]buf_id[%d]buf_type[%d]\n",
  595. property->prop_id, buf_id, buf_type);
  596. if (buf_id > FIMC_MAX_SRC) {
  597. dev_info(ippdrv->dev, "inavlid buf_id %d.\n", buf_id);
  598. return -ENOMEM;
  599. }
  600. /* address register set */
  601. switch (buf_type) {
  602. case IPP_BUF_ENQUEUE:
  603. config = &property->config[EXYNOS_DRM_OPS_SRC];
  604. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_Y],
  605. EXYNOS_CIIYSA0);
  606. if (config->fmt == DRM_FORMAT_YVU420) {
  607. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CR],
  608. EXYNOS_CIICBSA0);
  609. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CB],
  610. EXYNOS_CIICRSA0);
  611. } else {
  612. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CB],
  613. EXYNOS_CIICBSA0);
  614. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CR],
  615. EXYNOS_CIICRSA0);
  616. }
  617. break;
  618. case IPP_BUF_DEQUEUE:
  619. fimc_write(ctx, 0x0, EXYNOS_CIIYSA0);
  620. fimc_write(ctx, 0x0, EXYNOS_CIICBSA0);
  621. fimc_write(ctx, 0x0, EXYNOS_CIICRSA0);
  622. break;
  623. default:
  624. /* bypass */
  625. break;
  626. }
  627. return 0;
  628. }
  629. static struct exynos_drm_ipp_ops fimc_src_ops = {
  630. .set_fmt = fimc_src_set_fmt,
  631. .set_transf = fimc_src_set_transf,
  632. .set_size = fimc_src_set_size,
  633. .set_addr = fimc_src_set_addr,
  634. };
  635. static int fimc_dst_set_fmt_order(struct fimc_context *ctx, u32 fmt)
  636. {
  637. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  638. u32 cfg;
  639. DRM_DEBUG_KMS("fmt[0x%x]\n", fmt);
  640. /* RGB */
  641. cfg = fimc_read(ctx, EXYNOS_CISCCTRL);
  642. cfg &= ~EXYNOS_CISCCTRL_OUTRGB_FMT_RGB_MASK;
  643. switch (fmt) {
  644. case DRM_FORMAT_RGB565:
  645. cfg |= EXYNOS_CISCCTRL_OUTRGB_FMT_RGB565;
  646. fimc_write(ctx, cfg, EXYNOS_CISCCTRL);
  647. return 0;
  648. case DRM_FORMAT_RGB888:
  649. cfg |= EXYNOS_CISCCTRL_OUTRGB_FMT_RGB888;
  650. fimc_write(ctx, cfg, EXYNOS_CISCCTRL);
  651. return 0;
  652. case DRM_FORMAT_XRGB8888:
  653. cfg |= (EXYNOS_CISCCTRL_OUTRGB_FMT_RGB888 |
  654. EXYNOS_CISCCTRL_EXTRGB_EXTENSION);
  655. fimc_write(ctx, cfg, EXYNOS_CISCCTRL);
  656. break;
  657. default:
  658. /* bypass */
  659. break;
  660. }
  661. /* YUV */
  662. cfg = fimc_read(ctx, EXYNOS_CIOCTRL);
  663. cfg &= ~(EXYNOS_CIOCTRL_ORDER2P_MASK |
  664. EXYNOS_CIOCTRL_ORDER422_MASK |
  665. EXYNOS_CIOCTRL_YCBCR_PLANE_MASK);
  666. switch (fmt) {
  667. case DRM_FORMAT_XRGB8888:
  668. cfg |= EXYNOS_CIOCTRL_ALPHA_OUT;
  669. break;
  670. case DRM_FORMAT_YUYV:
  671. cfg |= EXYNOS_CIOCTRL_ORDER422_YCBYCR;
  672. break;
  673. case DRM_FORMAT_YVYU:
  674. cfg |= EXYNOS_CIOCTRL_ORDER422_YCRYCB;
  675. break;
  676. case DRM_FORMAT_UYVY:
  677. cfg |= EXYNOS_CIOCTRL_ORDER422_CBYCRY;
  678. break;
  679. case DRM_FORMAT_VYUY:
  680. cfg |= EXYNOS_CIOCTRL_ORDER422_CRYCBY;
  681. break;
  682. case DRM_FORMAT_NV21:
  683. case DRM_FORMAT_NV61:
  684. cfg |= EXYNOS_CIOCTRL_ORDER2P_LSB_CRCB;
  685. cfg |= EXYNOS_CIOCTRL_YCBCR_2PLANE;
  686. break;
  687. case DRM_FORMAT_YUV422:
  688. case DRM_FORMAT_YUV420:
  689. case DRM_FORMAT_YVU420:
  690. cfg |= EXYNOS_CIOCTRL_YCBCR_3PLANE;
  691. break;
  692. case DRM_FORMAT_NV12:
  693. case DRM_FORMAT_NV12MT:
  694. case DRM_FORMAT_NV16:
  695. cfg |= EXYNOS_CIOCTRL_ORDER2P_LSB_CBCR;
  696. cfg |= EXYNOS_CIOCTRL_YCBCR_2PLANE;
  697. break;
  698. default:
  699. dev_err(ippdrv->dev, "inavlid target yuv order 0x%x.\n", fmt);
  700. return -EINVAL;
  701. }
  702. fimc_write(ctx, cfg, EXYNOS_CIOCTRL);
  703. return 0;
  704. }
  705. static int fimc_dst_set_fmt(struct device *dev, u32 fmt)
  706. {
  707. struct fimc_context *ctx = get_fimc_context(dev);
  708. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  709. u32 cfg;
  710. DRM_DEBUG_KMS("fmt[0x%x]\n", fmt);
  711. cfg = fimc_read(ctx, EXYNOS_CIEXTEN);
  712. if (fmt == DRM_FORMAT_AYUV) {
  713. cfg |= EXYNOS_CIEXTEN_YUV444_OUT;
  714. fimc_write(ctx, cfg, EXYNOS_CIEXTEN);
  715. } else {
  716. cfg &= ~EXYNOS_CIEXTEN_YUV444_OUT;
  717. fimc_write(ctx, cfg, EXYNOS_CIEXTEN);
  718. cfg = fimc_read(ctx, EXYNOS_CITRGFMT);
  719. cfg &= ~EXYNOS_CITRGFMT_OUTFORMAT_MASK;
  720. switch (fmt) {
  721. case DRM_FORMAT_RGB565:
  722. case DRM_FORMAT_RGB888:
  723. case DRM_FORMAT_XRGB8888:
  724. cfg |= EXYNOS_CITRGFMT_OUTFORMAT_RGB;
  725. break;
  726. case DRM_FORMAT_YUYV:
  727. case DRM_FORMAT_YVYU:
  728. case DRM_FORMAT_UYVY:
  729. case DRM_FORMAT_VYUY:
  730. cfg |= EXYNOS_CITRGFMT_OUTFORMAT_YCBCR422_1PLANE;
  731. break;
  732. case DRM_FORMAT_NV16:
  733. case DRM_FORMAT_NV61:
  734. case DRM_FORMAT_YUV422:
  735. cfg |= EXYNOS_CITRGFMT_OUTFORMAT_YCBCR422;
  736. break;
  737. case DRM_FORMAT_YUV420:
  738. case DRM_FORMAT_YVU420:
  739. case DRM_FORMAT_NV12:
  740. case DRM_FORMAT_NV12MT:
  741. case DRM_FORMAT_NV21:
  742. cfg |= EXYNOS_CITRGFMT_OUTFORMAT_YCBCR420;
  743. break;
  744. default:
  745. dev_err(ippdrv->dev, "inavlid target format 0x%x.\n",
  746. fmt);
  747. return -EINVAL;
  748. }
  749. fimc_write(ctx, cfg, EXYNOS_CITRGFMT);
  750. }
  751. cfg = fimc_read(ctx, EXYNOS_CIDMAPARAM);
  752. cfg &= ~EXYNOS_CIDMAPARAM_W_MODE_MASK;
  753. if (fmt == DRM_FORMAT_NV12MT)
  754. cfg |= EXYNOS_CIDMAPARAM_W_MODE_64X32;
  755. else
  756. cfg |= EXYNOS_CIDMAPARAM_W_MODE_LINEAR;
  757. fimc_write(ctx, cfg, EXYNOS_CIDMAPARAM);
  758. return fimc_dst_set_fmt_order(ctx, fmt);
  759. }
  760. static int fimc_dst_set_transf(struct device *dev,
  761. enum drm_exynos_degree degree,
  762. enum drm_exynos_flip flip, bool *swap)
  763. {
  764. struct fimc_context *ctx = get_fimc_context(dev);
  765. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  766. u32 cfg;
  767. DRM_DEBUG_KMS("degree[%d]flip[0x%x]\n", degree, flip);
  768. cfg = fimc_read(ctx, EXYNOS_CITRGFMT);
  769. cfg &= ~EXYNOS_CITRGFMT_FLIP_MASK;
  770. cfg &= ~EXYNOS_CITRGFMT_OUTROT90_CLOCKWISE;
  771. switch (degree) {
  772. case EXYNOS_DRM_DEGREE_0:
  773. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  774. cfg |= EXYNOS_CITRGFMT_FLIP_X_MIRROR;
  775. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  776. cfg |= EXYNOS_CITRGFMT_FLIP_Y_MIRROR;
  777. break;
  778. case EXYNOS_DRM_DEGREE_90:
  779. cfg |= EXYNOS_CITRGFMT_OUTROT90_CLOCKWISE;
  780. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  781. cfg |= EXYNOS_CITRGFMT_FLIP_X_MIRROR;
  782. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  783. cfg |= EXYNOS_CITRGFMT_FLIP_Y_MIRROR;
  784. break;
  785. case EXYNOS_DRM_DEGREE_180:
  786. cfg |= (EXYNOS_CITRGFMT_FLIP_X_MIRROR |
  787. EXYNOS_CITRGFMT_FLIP_Y_MIRROR);
  788. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  789. cfg &= ~EXYNOS_CITRGFMT_FLIP_X_MIRROR;
  790. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  791. cfg &= ~EXYNOS_CITRGFMT_FLIP_Y_MIRROR;
  792. break;
  793. case EXYNOS_DRM_DEGREE_270:
  794. cfg |= (EXYNOS_CITRGFMT_OUTROT90_CLOCKWISE |
  795. EXYNOS_CITRGFMT_FLIP_X_MIRROR |
  796. EXYNOS_CITRGFMT_FLIP_Y_MIRROR);
  797. if (flip & EXYNOS_DRM_FLIP_VERTICAL)
  798. cfg &= ~EXYNOS_CITRGFMT_FLIP_X_MIRROR;
  799. if (flip & EXYNOS_DRM_FLIP_HORIZONTAL)
  800. cfg &= ~EXYNOS_CITRGFMT_FLIP_Y_MIRROR;
  801. break;
  802. default:
  803. dev_err(ippdrv->dev, "inavlid degree value %d.\n", degree);
  804. return -EINVAL;
  805. }
  806. fimc_write(ctx, cfg, EXYNOS_CITRGFMT);
  807. *swap = (cfg & EXYNOS_CITRGFMT_OUTROT90_CLOCKWISE) ? 1 : 0;
  808. return 0;
  809. }
  810. static int fimc_set_prescaler(struct fimc_context *ctx, struct fimc_scaler *sc,
  811. struct drm_exynos_pos *src, struct drm_exynos_pos *dst)
  812. {
  813. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  814. u32 cfg, cfg_ext, shfactor;
  815. u32 pre_dst_width, pre_dst_height;
  816. u32 hfactor, vfactor;
  817. int ret = 0;
  818. u32 src_w, src_h, dst_w, dst_h;
  819. cfg_ext = fimc_read(ctx, EXYNOS_CITRGFMT);
  820. if (cfg_ext & EXYNOS_CITRGFMT_INROT90_CLOCKWISE) {
  821. src_w = src->h;
  822. src_h = src->w;
  823. } else {
  824. src_w = src->w;
  825. src_h = src->h;
  826. }
  827. if (cfg_ext & EXYNOS_CITRGFMT_OUTROT90_CLOCKWISE) {
  828. dst_w = dst->h;
  829. dst_h = dst->w;
  830. } else {
  831. dst_w = dst->w;
  832. dst_h = dst->h;
  833. }
  834. /* fimc_ippdrv_check_property assures that dividers are not null */
  835. hfactor = fls(src_w / dst_w / 2);
  836. if (hfactor > FIMC_SHFACTOR / 2) {
  837. dev_err(ippdrv->dev, "failed to get ratio horizontal.\n");
  838. return -EINVAL;
  839. }
  840. vfactor = fls(src_h / dst_h / 2);
  841. if (vfactor > FIMC_SHFACTOR / 2) {
  842. dev_err(ippdrv->dev, "failed to get ratio vertical.\n");
  843. return -EINVAL;
  844. }
  845. pre_dst_width = src_w >> hfactor;
  846. pre_dst_height = src_h >> vfactor;
  847. DRM_DEBUG_KMS("pre_dst_width[%d]pre_dst_height[%d]\n",
  848. pre_dst_width, pre_dst_height);
  849. DRM_DEBUG_KMS("hfactor[%d]vfactor[%d]\n", hfactor, vfactor);
  850. sc->hratio = (src_w << 14) / (dst_w << hfactor);
  851. sc->vratio = (src_h << 14) / (dst_h << vfactor);
  852. sc->up_h = (dst_w >= src_w) ? true : false;
  853. sc->up_v = (dst_h >= src_h) ? true : false;
  854. DRM_DEBUG_KMS("hratio[%d]vratio[%d]up_h[%d]up_v[%d]\n",
  855. sc->hratio, sc->vratio, sc->up_h, sc->up_v);
  856. shfactor = FIMC_SHFACTOR - (hfactor + vfactor);
  857. DRM_DEBUG_KMS("shfactor[%d]\n", shfactor);
  858. cfg = (EXYNOS_CISCPRERATIO_SHFACTOR(shfactor) |
  859. EXYNOS_CISCPRERATIO_PREHORRATIO(1 << hfactor) |
  860. EXYNOS_CISCPRERATIO_PREVERRATIO(1 << vfactor));
  861. fimc_write(ctx, cfg, EXYNOS_CISCPRERATIO);
  862. cfg = (EXYNOS_CISCPREDST_PREDSTWIDTH(pre_dst_width) |
  863. EXYNOS_CISCPREDST_PREDSTHEIGHT(pre_dst_height));
  864. fimc_write(ctx, cfg, EXYNOS_CISCPREDST);
  865. return ret;
  866. }
  867. static void fimc_set_scaler(struct fimc_context *ctx, struct fimc_scaler *sc)
  868. {
  869. u32 cfg, cfg_ext;
  870. DRM_DEBUG_KMS("range[%d]bypass[%d]up_h[%d]up_v[%d]\n",
  871. sc->range, sc->bypass, sc->up_h, sc->up_v);
  872. DRM_DEBUG_KMS("hratio[%d]vratio[%d]\n",
  873. sc->hratio, sc->vratio);
  874. cfg = fimc_read(ctx, EXYNOS_CISCCTRL);
  875. cfg &= ~(EXYNOS_CISCCTRL_SCALERBYPASS |
  876. EXYNOS_CISCCTRL_SCALEUP_H | EXYNOS_CISCCTRL_SCALEUP_V |
  877. EXYNOS_CISCCTRL_MAIN_V_RATIO_MASK |
  878. EXYNOS_CISCCTRL_MAIN_H_RATIO_MASK |
  879. EXYNOS_CISCCTRL_CSCR2Y_WIDE |
  880. EXYNOS_CISCCTRL_CSCY2R_WIDE);
  881. if (sc->range)
  882. cfg |= (EXYNOS_CISCCTRL_CSCR2Y_WIDE |
  883. EXYNOS_CISCCTRL_CSCY2R_WIDE);
  884. if (sc->bypass)
  885. cfg |= EXYNOS_CISCCTRL_SCALERBYPASS;
  886. if (sc->up_h)
  887. cfg |= EXYNOS_CISCCTRL_SCALEUP_H;
  888. if (sc->up_v)
  889. cfg |= EXYNOS_CISCCTRL_SCALEUP_V;
  890. cfg |= (EXYNOS_CISCCTRL_MAINHORRATIO((sc->hratio >> 6)) |
  891. EXYNOS_CISCCTRL_MAINVERRATIO((sc->vratio >> 6)));
  892. fimc_write(ctx, cfg, EXYNOS_CISCCTRL);
  893. cfg_ext = fimc_read(ctx, EXYNOS_CIEXTEN);
  894. cfg_ext &= ~EXYNOS_CIEXTEN_MAINHORRATIO_EXT_MASK;
  895. cfg_ext &= ~EXYNOS_CIEXTEN_MAINVERRATIO_EXT_MASK;
  896. cfg_ext |= (EXYNOS_CIEXTEN_MAINHORRATIO_EXT(sc->hratio) |
  897. EXYNOS_CIEXTEN_MAINVERRATIO_EXT(sc->vratio));
  898. fimc_write(ctx, cfg_ext, EXYNOS_CIEXTEN);
  899. }
  900. static int fimc_dst_set_size(struct device *dev, int swap,
  901. struct drm_exynos_pos *pos, struct drm_exynos_sz *sz)
  902. {
  903. struct fimc_context *ctx = get_fimc_context(dev);
  904. struct drm_exynos_pos img_pos = *pos;
  905. struct drm_exynos_sz img_sz = *sz;
  906. u32 cfg;
  907. DRM_DEBUG_KMS("swap[%d]hsize[%d]vsize[%d]\n",
  908. swap, sz->hsize, sz->vsize);
  909. /* original size */
  910. cfg = (EXYNOS_ORGOSIZE_HORIZONTAL(img_sz.hsize) |
  911. EXYNOS_ORGOSIZE_VERTICAL(img_sz.vsize));
  912. fimc_write(ctx, cfg, EXYNOS_ORGOSIZE);
  913. DRM_DEBUG_KMS("x[%d]y[%d]w[%d]h[%d]\n", pos->x, pos->y, pos->w, pos->h);
  914. /* CSC ITU */
  915. cfg = fimc_read(ctx, EXYNOS_CIGCTRL);
  916. cfg &= ~EXYNOS_CIGCTRL_CSC_MASK;
  917. if (sz->hsize >= FIMC_WIDTH_ITU_709)
  918. cfg |= EXYNOS_CIGCTRL_CSC_ITU709;
  919. else
  920. cfg |= EXYNOS_CIGCTRL_CSC_ITU601;
  921. fimc_write(ctx, cfg, EXYNOS_CIGCTRL);
  922. if (swap) {
  923. img_pos.w = pos->h;
  924. img_pos.h = pos->w;
  925. img_sz.hsize = sz->vsize;
  926. img_sz.vsize = sz->hsize;
  927. }
  928. /* target image size */
  929. cfg = fimc_read(ctx, EXYNOS_CITRGFMT);
  930. cfg &= ~(EXYNOS_CITRGFMT_TARGETH_MASK |
  931. EXYNOS_CITRGFMT_TARGETV_MASK);
  932. cfg |= (EXYNOS_CITRGFMT_TARGETHSIZE(img_pos.w) |
  933. EXYNOS_CITRGFMT_TARGETVSIZE(img_pos.h));
  934. fimc_write(ctx, cfg, EXYNOS_CITRGFMT);
  935. /* target area */
  936. cfg = EXYNOS_CITAREA_TARGET_AREA(img_pos.w * img_pos.h);
  937. fimc_write(ctx, cfg, EXYNOS_CITAREA);
  938. /* offset Y(RGB), Cb, Cr */
  939. cfg = (EXYNOS_CIOYOFF_HORIZONTAL(img_pos.x) |
  940. EXYNOS_CIOYOFF_VERTICAL(img_pos.y));
  941. fimc_write(ctx, cfg, EXYNOS_CIOYOFF);
  942. cfg = (EXYNOS_CIOCBOFF_HORIZONTAL(img_pos.x) |
  943. EXYNOS_CIOCBOFF_VERTICAL(img_pos.y));
  944. fimc_write(ctx, cfg, EXYNOS_CIOCBOFF);
  945. cfg = (EXYNOS_CIOCROFF_HORIZONTAL(img_pos.x) |
  946. EXYNOS_CIOCROFF_VERTICAL(img_pos.y));
  947. fimc_write(ctx, cfg, EXYNOS_CIOCROFF);
  948. return 0;
  949. }
  950. static void fimc_dst_set_buf_seq(struct fimc_context *ctx, u32 buf_id,
  951. enum drm_exynos_ipp_buf_type buf_type)
  952. {
  953. unsigned long flags;
  954. u32 buf_num;
  955. u32 cfg;
  956. DRM_DEBUG_KMS("buf_id[%d]buf_type[%d]\n", buf_id, buf_type);
  957. spin_lock_irqsave(&ctx->lock, flags);
  958. cfg = fimc_read(ctx, EXYNOS_CIFCNTSEQ);
  959. if (buf_type == IPP_BUF_ENQUEUE)
  960. cfg |= (1 << buf_id);
  961. else
  962. cfg &= ~(1 << buf_id);
  963. fimc_write(ctx, cfg, EXYNOS_CIFCNTSEQ);
  964. buf_num = hweight32(cfg);
  965. if (buf_type == IPP_BUF_ENQUEUE && buf_num >= FIMC_BUF_START)
  966. fimc_mask_irq(ctx, true);
  967. else if (buf_type == IPP_BUF_DEQUEUE && buf_num <= FIMC_BUF_STOP)
  968. fimc_mask_irq(ctx, false);
  969. spin_unlock_irqrestore(&ctx->lock, flags);
  970. }
  971. static int fimc_dst_set_addr(struct device *dev,
  972. struct drm_exynos_ipp_buf_info *buf_info, u32 buf_id,
  973. enum drm_exynos_ipp_buf_type buf_type)
  974. {
  975. struct fimc_context *ctx = get_fimc_context(dev);
  976. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  977. struct drm_exynos_ipp_cmd_node *c_node = ippdrv->c_node;
  978. struct drm_exynos_ipp_property *property;
  979. struct drm_exynos_ipp_config *config;
  980. if (!c_node) {
  981. DRM_ERROR("failed to get c_node.\n");
  982. return -EINVAL;
  983. }
  984. property = &c_node->property;
  985. DRM_DEBUG_KMS("prop_id[%d]buf_id[%d]buf_type[%d]\n",
  986. property->prop_id, buf_id, buf_type);
  987. if (buf_id > FIMC_MAX_DST) {
  988. dev_info(ippdrv->dev, "inavlid buf_id %d.\n", buf_id);
  989. return -ENOMEM;
  990. }
  991. /* address register set */
  992. switch (buf_type) {
  993. case IPP_BUF_ENQUEUE:
  994. config = &property->config[EXYNOS_DRM_OPS_DST];
  995. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_Y],
  996. EXYNOS_CIOYSA(buf_id));
  997. if (config->fmt == DRM_FORMAT_YVU420) {
  998. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CR],
  999. EXYNOS_CIOCBSA(buf_id));
  1000. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CB],
  1001. EXYNOS_CIOCRSA(buf_id));
  1002. } else {
  1003. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CB],
  1004. EXYNOS_CIOCBSA(buf_id));
  1005. fimc_write(ctx, buf_info->base[EXYNOS_DRM_PLANAR_CR],
  1006. EXYNOS_CIOCRSA(buf_id));
  1007. }
  1008. break;
  1009. case IPP_BUF_DEQUEUE:
  1010. fimc_write(ctx, 0x0, EXYNOS_CIOYSA(buf_id));
  1011. fimc_write(ctx, 0x0, EXYNOS_CIOCBSA(buf_id));
  1012. fimc_write(ctx, 0x0, EXYNOS_CIOCRSA(buf_id));
  1013. break;
  1014. default:
  1015. /* bypass */
  1016. break;
  1017. }
  1018. fimc_dst_set_buf_seq(ctx, buf_id, buf_type);
  1019. return 0;
  1020. }
  1021. static struct exynos_drm_ipp_ops fimc_dst_ops = {
  1022. .set_fmt = fimc_dst_set_fmt,
  1023. .set_transf = fimc_dst_set_transf,
  1024. .set_size = fimc_dst_set_size,
  1025. .set_addr = fimc_dst_set_addr,
  1026. };
  1027. static int fimc_clk_ctrl(struct fimc_context *ctx, bool enable)
  1028. {
  1029. DRM_DEBUG_KMS("enable[%d]\n", enable);
  1030. if (enable) {
  1031. clk_prepare_enable(ctx->clocks[FIMC_CLK_GATE]);
  1032. clk_prepare_enable(ctx->clocks[FIMC_CLK_WB_A]);
  1033. ctx->suspended = false;
  1034. } else {
  1035. clk_disable_unprepare(ctx->clocks[FIMC_CLK_GATE]);
  1036. clk_disable_unprepare(ctx->clocks[FIMC_CLK_WB_A]);
  1037. ctx->suspended = true;
  1038. }
  1039. return 0;
  1040. }
  1041. static irqreturn_t fimc_irq_handler(int irq, void *dev_id)
  1042. {
  1043. struct fimc_context *ctx = dev_id;
  1044. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  1045. struct drm_exynos_ipp_cmd_node *c_node = ippdrv->c_node;
  1046. struct drm_exynos_ipp_event_work *event_work =
  1047. c_node->event_work;
  1048. int buf_id;
  1049. DRM_DEBUG_KMS("fimc id[%d]\n", ctx->id);
  1050. fimc_clear_irq(ctx);
  1051. if (fimc_check_ovf(ctx))
  1052. return IRQ_NONE;
  1053. if (!fimc_check_frame_end(ctx))
  1054. return IRQ_NONE;
  1055. buf_id = fimc_get_buf_id(ctx);
  1056. if (buf_id < 0)
  1057. return IRQ_HANDLED;
  1058. DRM_DEBUG_KMS("buf_id[%d]\n", buf_id);
  1059. fimc_dst_set_buf_seq(ctx, buf_id, IPP_BUF_DEQUEUE);
  1060. event_work->ippdrv = ippdrv;
  1061. event_work->buf_id[EXYNOS_DRM_OPS_DST] = buf_id;
  1062. queue_work(ippdrv->event_workq, &event_work->work);
  1063. return IRQ_HANDLED;
  1064. }
  1065. static int fimc_init_prop_list(struct exynos_drm_ippdrv *ippdrv)
  1066. {
  1067. struct drm_exynos_ipp_prop_list *prop_list = &ippdrv->prop_list;
  1068. prop_list->version = 1;
  1069. prop_list->writeback = 1;
  1070. prop_list->refresh_min = FIMC_REFRESH_MIN;
  1071. prop_list->refresh_max = FIMC_REFRESH_MAX;
  1072. prop_list->flip = (1 << EXYNOS_DRM_FLIP_NONE) |
  1073. (1 << EXYNOS_DRM_FLIP_VERTICAL) |
  1074. (1 << EXYNOS_DRM_FLIP_HORIZONTAL);
  1075. prop_list->degree = (1 << EXYNOS_DRM_DEGREE_0) |
  1076. (1 << EXYNOS_DRM_DEGREE_90) |
  1077. (1 << EXYNOS_DRM_DEGREE_180) |
  1078. (1 << EXYNOS_DRM_DEGREE_270);
  1079. prop_list->csc = 1;
  1080. prop_list->crop = 1;
  1081. prop_list->crop_max.hsize = FIMC_CROP_MAX;
  1082. prop_list->crop_max.vsize = FIMC_CROP_MAX;
  1083. prop_list->crop_min.hsize = FIMC_CROP_MIN;
  1084. prop_list->crop_min.vsize = FIMC_CROP_MIN;
  1085. prop_list->scale = 1;
  1086. prop_list->scale_max.hsize = FIMC_SCALE_MAX;
  1087. prop_list->scale_max.vsize = FIMC_SCALE_MAX;
  1088. prop_list->scale_min.hsize = FIMC_SCALE_MIN;
  1089. prop_list->scale_min.vsize = FIMC_SCALE_MIN;
  1090. return 0;
  1091. }
  1092. static inline bool fimc_check_drm_flip(enum drm_exynos_flip flip)
  1093. {
  1094. switch (flip) {
  1095. case EXYNOS_DRM_FLIP_NONE:
  1096. case EXYNOS_DRM_FLIP_VERTICAL:
  1097. case EXYNOS_DRM_FLIP_HORIZONTAL:
  1098. case EXYNOS_DRM_FLIP_BOTH:
  1099. return true;
  1100. default:
  1101. DRM_DEBUG_KMS("invalid flip\n");
  1102. return false;
  1103. }
  1104. }
  1105. static int fimc_ippdrv_check_property(struct device *dev,
  1106. struct drm_exynos_ipp_property *property)
  1107. {
  1108. struct fimc_context *ctx = get_fimc_context(dev);
  1109. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  1110. struct drm_exynos_ipp_prop_list *pp = &ippdrv->prop_list;
  1111. struct drm_exynos_ipp_config *config;
  1112. struct drm_exynos_pos *pos;
  1113. struct drm_exynos_sz *sz;
  1114. bool swap;
  1115. int i;
  1116. for_each_ipp_ops(i) {
  1117. if ((i == EXYNOS_DRM_OPS_SRC) &&
  1118. (property->cmd == IPP_CMD_WB))
  1119. continue;
  1120. config = &property->config[i];
  1121. pos = &config->pos;
  1122. sz = &config->sz;
  1123. /* check for flip */
  1124. if (!fimc_check_drm_flip(config->flip)) {
  1125. DRM_ERROR("invalid flip.\n");
  1126. goto err_property;
  1127. }
  1128. /* check for degree */
  1129. switch (config->degree) {
  1130. case EXYNOS_DRM_DEGREE_90:
  1131. case EXYNOS_DRM_DEGREE_270:
  1132. swap = true;
  1133. break;
  1134. case EXYNOS_DRM_DEGREE_0:
  1135. case EXYNOS_DRM_DEGREE_180:
  1136. swap = false;
  1137. break;
  1138. default:
  1139. DRM_ERROR("invalid degree.\n");
  1140. goto err_property;
  1141. }
  1142. /* check for buffer bound */
  1143. if ((pos->x + pos->w > sz->hsize) ||
  1144. (pos->y + pos->h > sz->vsize)) {
  1145. DRM_ERROR("out of buf bound.\n");
  1146. goto err_property;
  1147. }
  1148. /* check for crop */
  1149. if ((i == EXYNOS_DRM_OPS_SRC) && (pp->crop)) {
  1150. if (swap) {
  1151. if ((pos->h < pp->crop_min.hsize) ||
  1152. (sz->vsize > pp->crop_max.hsize) ||
  1153. (pos->w < pp->crop_min.vsize) ||
  1154. (sz->hsize > pp->crop_max.vsize)) {
  1155. DRM_ERROR("out of crop size.\n");
  1156. goto err_property;
  1157. }
  1158. } else {
  1159. if ((pos->w < pp->crop_min.hsize) ||
  1160. (sz->hsize > pp->crop_max.hsize) ||
  1161. (pos->h < pp->crop_min.vsize) ||
  1162. (sz->vsize > pp->crop_max.vsize)) {
  1163. DRM_ERROR("out of crop size.\n");
  1164. goto err_property;
  1165. }
  1166. }
  1167. }
  1168. /* check for scale */
  1169. if ((i == EXYNOS_DRM_OPS_DST) && (pp->scale)) {
  1170. if (swap) {
  1171. if ((pos->h < pp->scale_min.hsize) ||
  1172. (sz->vsize > pp->scale_max.hsize) ||
  1173. (pos->w < pp->scale_min.vsize) ||
  1174. (sz->hsize > pp->scale_max.vsize)) {
  1175. DRM_ERROR("out of scale size.\n");
  1176. goto err_property;
  1177. }
  1178. } else {
  1179. if ((pos->w < pp->scale_min.hsize) ||
  1180. (sz->hsize > pp->scale_max.hsize) ||
  1181. (pos->h < pp->scale_min.vsize) ||
  1182. (sz->vsize > pp->scale_max.vsize)) {
  1183. DRM_ERROR("out of scale size.\n");
  1184. goto err_property;
  1185. }
  1186. }
  1187. }
  1188. }
  1189. return 0;
  1190. err_property:
  1191. for_each_ipp_ops(i) {
  1192. if ((i == EXYNOS_DRM_OPS_SRC) &&
  1193. (property->cmd == IPP_CMD_WB))
  1194. continue;
  1195. config = &property->config[i];
  1196. pos = &config->pos;
  1197. sz = &config->sz;
  1198. DRM_ERROR("[%s]f[%d]r[%d]pos[%d %d %d %d]sz[%d %d]\n",
  1199. i ? "dst" : "src", config->flip, config->degree,
  1200. pos->x, pos->y, pos->w, pos->h,
  1201. sz->hsize, sz->vsize);
  1202. }
  1203. return -EINVAL;
  1204. }
  1205. static void fimc_clear_addr(struct fimc_context *ctx)
  1206. {
  1207. int i;
  1208. for (i = 0; i < FIMC_MAX_SRC; i++) {
  1209. fimc_write(ctx, 0, EXYNOS_CIIYSA(i));
  1210. fimc_write(ctx, 0, EXYNOS_CIICBSA(i));
  1211. fimc_write(ctx, 0, EXYNOS_CIICRSA(i));
  1212. }
  1213. for (i = 0; i < FIMC_MAX_DST; i++) {
  1214. fimc_write(ctx, 0, EXYNOS_CIOYSA(i));
  1215. fimc_write(ctx, 0, EXYNOS_CIOCBSA(i));
  1216. fimc_write(ctx, 0, EXYNOS_CIOCRSA(i));
  1217. }
  1218. }
  1219. static int fimc_ippdrv_reset(struct device *dev)
  1220. {
  1221. struct fimc_context *ctx = get_fimc_context(dev);
  1222. /* reset h/w block */
  1223. fimc_sw_reset(ctx);
  1224. /* reset scaler capability */
  1225. memset(&ctx->sc, 0x0, sizeof(ctx->sc));
  1226. fimc_clear_addr(ctx);
  1227. return 0;
  1228. }
  1229. static int fimc_ippdrv_start(struct device *dev, enum drm_exynos_ipp_cmd cmd)
  1230. {
  1231. struct fimc_context *ctx = get_fimc_context(dev);
  1232. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  1233. struct drm_exynos_ipp_cmd_node *c_node = ippdrv->c_node;
  1234. struct drm_exynos_ipp_property *property;
  1235. struct drm_exynos_ipp_config *config;
  1236. struct drm_exynos_pos img_pos[EXYNOS_DRM_OPS_MAX];
  1237. struct drm_exynos_ipp_set_wb set_wb;
  1238. int ret, i;
  1239. u32 cfg0, cfg1;
  1240. DRM_DEBUG_KMS("cmd[%d]\n", cmd);
  1241. if (!c_node) {
  1242. DRM_ERROR("failed to get c_node.\n");
  1243. return -EINVAL;
  1244. }
  1245. property = &c_node->property;
  1246. fimc_mask_irq(ctx, true);
  1247. for_each_ipp_ops(i) {
  1248. config = &property->config[i];
  1249. img_pos[i] = config->pos;
  1250. }
  1251. ret = fimc_set_prescaler(ctx, &ctx->sc,
  1252. &img_pos[EXYNOS_DRM_OPS_SRC],
  1253. &img_pos[EXYNOS_DRM_OPS_DST]);
  1254. if (ret) {
  1255. dev_err(dev, "failed to set precalser.\n");
  1256. return ret;
  1257. }
  1258. /* If set ture, we can save jpeg about screen */
  1259. fimc_handle_jpeg(ctx, false);
  1260. fimc_set_scaler(ctx, &ctx->sc);
  1261. fimc_set_polarity(ctx, &ctx->pol);
  1262. switch (cmd) {
  1263. case IPP_CMD_M2M:
  1264. fimc_set_type_ctrl(ctx, FIMC_WB_NONE);
  1265. fimc_handle_lastend(ctx, false);
  1266. /* setup dma */
  1267. cfg0 = fimc_read(ctx, EXYNOS_MSCTRL);
  1268. cfg0 &= ~EXYNOS_MSCTRL_INPUT_MASK;
  1269. cfg0 |= EXYNOS_MSCTRL_INPUT_MEMORY;
  1270. fimc_write(ctx, cfg0, EXYNOS_MSCTRL);
  1271. break;
  1272. case IPP_CMD_WB:
  1273. fimc_set_type_ctrl(ctx, FIMC_WB_A);
  1274. fimc_handle_lastend(ctx, true);
  1275. /* setup FIMD */
  1276. ret = fimc_set_camblk_fimd0_wb(ctx);
  1277. if (ret < 0) {
  1278. dev_err(dev, "camblk setup failed.\n");
  1279. return ret;
  1280. }
  1281. set_wb.enable = 1;
  1282. set_wb.refresh = property->refresh_rate;
  1283. exynos_drm_ippnb_send_event(IPP_SET_WRITEBACK, (void *)&set_wb);
  1284. break;
  1285. case IPP_CMD_OUTPUT:
  1286. default:
  1287. ret = -EINVAL;
  1288. dev_err(dev, "invalid operations.\n");
  1289. return ret;
  1290. }
  1291. /* Reset status */
  1292. fimc_write(ctx, 0x0, EXYNOS_CISTATUS);
  1293. cfg0 = fimc_read(ctx, EXYNOS_CIIMGCPT);
  1294. cfg0 &= ~EXYNOS_CIIMGCPT_IMGCPTEN_SC;
  1295. cfg0 |= EXYNOS_CIIMGCPT_IMGCPTEN_SC;
  1296. /* Scaler */
  1297. cfg1 = fimc_read(ctx, EXYNOS_CISCCTRL);
  1298. cfg1 &= ~EXYNOS_CISCCTRL_SCAN_MASK;
  1299. cfg1 |= (EXYNOS_CISCCTRL_PROGRESSIVE |
  1300. EXYNOS_CISCCTRL_SCALERSTART);
  1301. fimc_write(ctx, cfg1, EXYNOS_CISCCTRL);
  1302. /* Enable image capture*/
  1303. cfg0 |= EXYNOS_CIIMGCPT_IMGCPTEN;
  1304. fimc_write(ctx, cfg0, EXYNOS_CIIMGCPT);
  1305. /* Disable frame end irq */
  1306. fimc_clear_bits(ctx, EXYNOS_CIGCTRL, EXYNOS_CIGCTRL_IRQ_END_DISABLE);
  1307. fimc_clear_bits(ctx, EXYNOS_CIOCTRL, EXYNOS_CIOCTRL_WEAVE_MASK);
  1308. if (cmd == IPP_CMD_M2M)
  1309. fimc_set_bits(ctx, EXYNOS_MSCTRL, EXYNOS_MSCTRL_ENVID);
  1310. return 0;
  1311. }
  1312. static void fimc_ippdrv_stop(struct device *dev, enum drm_exynos_ipp_cmd cmd)
  1313. {
  1314. struct fimc_context *ctx = get_fimc_context(dev);
  1315. struct drm_exynos_ipp_set_wb set_wb = {0, 0};
  1316. u32 cfg;
  1317. DRM_DEBUG_KMS("cmd[%d]\n", cmd);
  1318. switch (cmd) {
  1319. case IPP_CMD_M2M:
  1320. /* Source clear */
  1321. cfg = fimc_read(ctx, EXYNOS_MSCTRL);
  1322. cfg &= ~EXYNOS_MSCTRL_INPUT_MASK;
  1323. cfg &= ~EXYNOS_MSCTRL_ENVID;
  1324. fimc_write(ctx, cfg, EXYNOS_MSCTRL);
  1325. break;
  1326. case IPP_CMD_WB:
  1327. exynos_drm_ippnb_send_event(IPP_SET_WRITEBACK, (void *)&set_wb);
  1328. break;
  1329. case IPP_CMD_OUTPUT:
  1330. default:
  1331. dev_err(dev, "invalid operations.\n");
  1332. break;
  1333. }
  1334. fimc_mask_irq(ctx, false);
  1335. /* reset sequence */
  1336. fimc_write(ctx, 0x0, EXYNOS_CIFCNTSEQ);
  1337. /* Scaler disable */
  1338. fimc_clear_bits(ctx, EXYNOS_CISCCTRL, EXYNOS_CISCCTRL_SCALERSTART);
  1339. /* Disable image capture */
  1340. fimc_clear_bits(ctx, EXYNOS_CIIMGCPT,
  1341. EXYNOS_CIIMGCPT_IMGCPTEN_SC | EXYNOS_CIIMGCPT_IMGCPTEN);
  1342. /* Enable frame end irq */
  1343. fimc_set_bits(ctx, EXYNOS_CIGCTRL, EXYNOS_CIGCTRL_IRQ_END_DISABLE);
  1344. }
  1345. static void fimc_put_clocks(struct fimc_context *ctx)
  1346. {
  1347. int i;
  1348. for (i = 0; i < FIMC_CLKS_MAX; i++) {
  1349. if (IS_ERR(ctx->clocks[i]))
  1350. continue;
  1351. clk_put(ctx->clocks[i]);
  1352. ctx->clocks[i] = ERR_PTR(-EINVAL);
  1353. }
  1354. }
  1355. static int fimc_setup_clocks(struct fimc_context *ctx)
  1356. {
  1357. struct device *fimc_dev = ctx->ippdrv.dev;
  1358. struct device *dev;
  1359. int ret, i;
  1360. for (i = 0; i < FIMC_CLKS_MAX; i++)
  1361. ctx->clocks[i] = ERR_PTR(-EINVAL);
  1362. for (i = 0; i < FIMC_CLKS_MAX; i++) {
  1363. if (i == FIMC_CLK_WB_A || i == FIMC_CLK_WB_B)
  1364. dev = fimc_dev->parent;
  1365. else
  1366. dev = fimc_dev;
  1367. ctx->clocks[i] = clk_get(dev, fimc_clock_names[i]);
  1368. if (IS_ERR(ctx->clocks[i])) {
  1369. if (i >= FIMC_CLK_MUX)
  1370. break;
  1371. ret = PTR_ERR(ctx->clocks[i]);
  1372. dev_err(fimc_dev, "failed to get clock: %s\n",
  1373. fimc_clock_names[i]);
  1374. goto e_clk_free;
  1375. }
  1376. }
  1377. /* Optional FIMC LCLK parent clock setting */
  1378. if (!IS_ERR(ctx->clocks[FIMC_CLK_PARENT])) {
  1379. ret = clk_set_parent(ctx->clocks[FIMC_CLK_MUX],
  1380. ctx->clocks[FIMC_CLK_PARENT]);
  1381. if (ret < 0) {
  1382. dev_err(fimc_dev, "failed to set parent.\n");
  1383. goto e_clk_free;
  1384. }
  1385. }
  1386. ret = clk_set_rate(ctx->clocks[FIMC_CLK_LCLK], ctx->clk_frequency);
  1387. if (ret < 0)
  1388. goto e_clk_free;
  1389. ret = clk_prepare_enable(ctx->clocks[FIMC_CLK_LCLK]);
  1390. if (!ret)
  1391. return ret;
  1392. e_clk_free:
  1393. fimc_put_clocks(ctx);
  1394. return ret;
  1395. }
  1396. static int fimc_parse_dt(struct fimc_context *ctx)
  1397. {
  1398. struct device_node *node = ctx->ippdrv.dev->of_node;
  1399. /* Handle only devices that support the LCD Writeback data path */
  1400. if (!of_property_read_bool(node, "samsung,lcd-wb"))
  1401. return -ENODEV;
  1402. if (of_property_read_u32(node, "clock-frequency",
  1403. &ctx->clk_frequency))
  1404. ctx->clk_frequency = FIMC_DEFAULT_LCLK_FREQUENCY;
  1405. ctx->id = of_alias_get_id(node, "fimc");
  1406. if (ctx->id < 0) {
  1407. dev_err(ctx->ippdrv.dev, "failed to get node alias id.\n");
  1408. return -EINVAL;
  1409. }
  1410. return 0;
  1411. }
  1412. static int fimc_probe(struct platform_device *pdev)
  1413. {
  1414. struct device *dev = &pdev->dev;
  1415. struct fimc_context *ctx;
  1416. struct resource *res;
  1417. struct exynos_drm_ippdrv *ippdrv;
  1418. int ret;
  1419. if (!dev->of_node) {
  1420. dev_err(dev, "device tree node not found.\n");
  1421. return -ENODEV;
  1422. }
  1423. ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL);
  1424. if (!ctx)
  1425. return -ENOMEM;
  1426. ctx->ippdrv.dev = dev;
  1427. ret = fimc_parse_dt(ctx);
  1428. if (ret < 0)
  1429. return ret;
  1430. ctx->sysreg = syscon_regmap_lookup_by_phandle(dev->of_node,
  1431. "samsung,sysreg");
  1432. if (IS_ERR(ctx->sysreg)) {
  1433. dev_err(dev, "syscon regmap lookup failed.\n");
  1434. return PTR_ERR(ctx->sysreg);
  1435. }
  1436. /* resource memory */
  1437. ctx->regs_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  1438. ctx->regs = devm_ioremap_resource(dev, ctx->regs_res);
  1439. if (IS_ERR(ctx->regs))
  1440. return PTR_ERR(ctx->regs);
  1441. /* resource irq */
  1442. res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
  1443. if (!res) {
  1444. dev_err(dev, "failed to request irq resource.\n");
  1445. return -ENOENT;
  1446. }
  1447. ctx->irq = res->start;
  1448. ret = devm_request_threaded_irq(dev, ctx->irq, NULL, fimc_irq_handler,
  1449. IRQF_ONESHOT, "drm_fimc", ctx);
  1450. if (ret < 0) {
  1451. dev_err(dev, "failed to request irq.\n");
  1452. return ret;
  1453. }
  1454. ret = fimc_setup_clocks(ctx);
  1455. if (ret < 0)
  1456. return ret;
  1457. ippdrv = &ctx->ippdrv;
  1458. ippdrv->ops[EXYNOS_DRM_OPS_SRC] = &fimc_src_ops;
  1459. ippdrv->ops[EXYNOS_DRM_OPS_DST] = &fimc_dst_ops;
  1460. ippdrv->check_property = fimc_ippdrv_check_property;
  1461. ippdrv->reset = fimc_ippdrv_reset;
  1462. ippdrv->start = fimc_ippdrv_start;
  1463. ippdrv->stop = fimc_ippdrv_stop;
  1464. ret = fimc_init_prop_list(ippdrv);
  1465. if (ret < 0) {
  1466. dev_err(dev, "failed to init property list.\n");
  1467. goto err_put_clk;
  1468. }
  1469. DRM_DEBUG_KMS("id[%d]ippdrv[0x%x]\n", ctx->id, (int)ippdrv);
  1470. spin_lock_init(&ctx->lock);
  1471. platform_set_drvdata(pdev, ctx);
  1472. pm_runtime_set_active(dev);
  1473. pm_runtime_enable(dev);
  1474. ret = exynos_drm_ippdrv_register(ippdrv);
  1475. if (ret < 0) {
  1476. dev_err(dev, "failed to register drm fimc device.\n");
  1477. goto err_pm_dis;
  1478. }
  1479. dev_info(dev, "drm fimc registered successfully.\n");
  1480. return 0;
  1481. err_pm_dis:
  1482. pm_runtime_disable(dev);
  1483. err_put_clk:
  1484. fimc_put_clocks(ctx);
  1485. return ret;
  1486. }
  1487. static int fimc_remove(struct platform_device *pdev)
  1488. {
  1489. struct device *dev = &pdev->dev;
  1490. struct fimc_context *ctx = get_fimc_context(dev);
  1491. struct exynos_drm_ippdrv *ippdrv = &ctx->ippdrv;
  1492. exynos_drm_ippdrv_unregister(ippdrv);
  1493. fimc_put_clocks(ctx);
  1494. pm_runtime_set_suspended(dev);
  1495. pm_runtime_disable(dev);
  1496. return 0;
  1497. }
  1498. #ifdef CONFIG_PM_SLEEP
  1499. static int fimc_suspend(struct device *dev)
  1500. {
  1501. struct fimc_context *ctx = get_fimc_context(dev);
  1502. DRM_DEBUG_KMS("id[%d]\n", ctx->id);
  1503. if (pm_runtime_suspended(dev))
  1504. return 0;
  1505. return fimc_clk_ctrl(ctx, false);
  1506. }
  1507. static int fimc_resume(struct device *dev)
  1508. {
  1509. struct fimc_context *ctx = get_fimc_context(dev);
  1510. DRM_DEBUG_KMS("id[%d]\n", ctx->id);
  1511. if (!pm_runtime_suspended(dev))
  1512. return fimc_clk_ctrl(ctx, true);
  1513. return 0;
  1514. }
  1515. #endif
  1516. #ifdef CONFIG_PM
  1517. static int fimc_runtime_suspend(struct device *dev)
  1518. {
  1519. struct fimc_context *ctx = get_fimc_context(dev);
  1520. DRM_DEBUG_KMS("id[%d]\n", ctx->id);
  1521. return fimc_clk_ctrl(ctx, false);
  1522. }
  1523. static int fimc_runtime_resume(struct device *dev)
  1524. {
  1525. struct fimc_context *ctx = get_fimc_context(dev);
  1526. DRM_DEBUG_KMS("id[%d]\n", ctx->id);
  1527. return fimc_clk_ctrl(ctx, true);
  1528. }
  1529. #endif
  1530. static const struct dev_pm_ops fimc_pm_ops = {
  1531. SET_SYSTEM_SLEEP_PM_OPS(fimc_suspend, fimc_resume)
  1532. SET_RUNTIME_PM_OPS(fimc_runtime_suspend, fimc_runtime_resume, NULL)
  1533. };
  1534. static const struct of_device_id fimc_of_match[] = {
  1535. { .compatible = "samsung,exynos4210-fimc" },
  1536. { .compatible = "samsung,exynos4212-fimc" },
  1537. { },
  1538. };
  1539. MODULE_DEVICE_TABLE(of, fimc_of_match);
  1540. struct platform_driver fimc_driver = {
  1541. .probe = fimc_probe,
  1542. .remove = fimc_remove,
  1543. .driver = {
  1544. .of_match_table = fimc_of_match,
  1545. .name = "exynos-drm-fimc",
  1546. .owner = THIS_MODULE,
  1547. .pm = &fimc_pm_ops,
  1548. },
  1549. };