exynos_mixer.c 34 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358
  1. /*
  2. * Copyright (C) 2011 Samsung Electronics Co.Ltd
  3. * Authors:
  4. * Seung-Woo Kim <sw0312.kim@samsung.com>
  5. * Inki Dae <inki.dae@samsung.com>
  6. * Joonyoung Shim <jy0922.shim@samsung.com>
  7. *
  8. * Based on drivers/media/video/s5p-tv/mixer_reg.c
  9. *
  10. * This program is free software; you can redistribute it and/or modify it
  11. * under the terms of the GNU General Public License as published by the
  12. * Free Software Foundation; either version 2 of the License, or (at your
  13. * option) any later version.
  14. *
  15. */
  16. #include <drm/drmP.h>
  17. #include "regs-mixer.h"
  18. #include "regs-vp.h"
  19. #include <linux/kernel.h>
  20. #include <linux/spinlock.h>
  21. #include <linux/wait.h>
  22. #include <linux/i2c.h>
  23. #include <linux/platform_device.h>
  24. #include <linux/interrupt.h>
  25. #include <linux/irq.h>
  26. #include <linux/delay.h>
  27. #include <linux/pm_runtime.h>
  28. #include <linux/clk.h>
  29. #include <linux/regulator/consumer.h>
  30. #include <linux/of.h>
  31. #include <linux/component.h>
  32. #include <drm/exynos_drm.h>
  33. #include "exynos_drm_drv.h"
  34. #include "exynos_drm_crtc.h"
  35. #include "exynos_drm_iommu.h"
  36. #include "exynos_mixer.h"
  37. #define MIXER_WIN_NR 3
  38. #define MIXER_DEFAULT_WIN 0
  39. struct hdmi_win_data {
  40. dma_addr_t dma_addr;
  41. dma_addr_t chroma_dma_addr;
  42. uint32_t pixel_format;
  43. unsigned int bpp;
  44. unsigned int crtc_x;
  45. unsigned int crtc_y;
  46. unsigned int crtc_width;
  47. unsigned int crtc_height;
  48. unsigned int fb_x;
  49. unsigned int fb_y;
  50. unsigned int fb_width;
  51. unsigned int fb_height;
  52. unsigned int src_width;
  53. unsigned int src_height;
  54. unsigned int mode_width;
  55. unsigned int mode_height;
  56. unsigned int scan_flags;
  57. bool enabled;
  58. bool resume;
  59. };
  60. struct mixer_resources {
  61. int irq;
  62. void __iomem *mixer_regs;
  63. void __iomem *vp_regs;
  64. spinlock_t reg_slock;
  65. struct clk *mixer;
  66. struct clk *vp;
  67. struct clk *sclk_mixer;
  68. struct clk *sclk_hdmi;
  69. struct clk *mout_mixer;
  70. };
  71. enum mixer_version_id {
  72. MXR_VER_0_0_0_16,
  73. MXR_VER_16_0_33_0,
  74. MXR_VER_128_0_0_184,
  75. };
  76. struct mixer_context {
  77. struct exynos_drm_manager manager;
  78. struct platform_device *pdev;
  79. struct device *dev;
  80. struct drm_device *drm_dev;
  81. int pipe;
  82. bool interlace;
  83. bool powered;
  84. bool vp_enabled;
  85. bool has_sclk;
  86. u32 int_en;
  87. struct mutex mixer_mutex;
  88. struct mixer_resources mixer_res;
  89. struct hdmi_win_data win_data[MIXER_WIN_NR];
  90. enum mixer_version_id mxr_ver;
  91. wait_queue_head_t wait_vsync_queue;
  92. atomic_t wait_vsync_event;
  93. };
  94. static inline struct mixer_context *mgr_to_mixer(struct exynos_drm_manager *mgr)
  95. {
  96. return container_of(mgr, struct mixer_context, manager);
  97. }
  98. struct mixer_drv_data {
  99. enum mixer_version_id version;
  100. bool is_vp_enabled;
  101. bool has_sclk;
  102. };
  103. static const u8 filter_y_horiz_tap8[] = {
  104. 0, -1, -1, -1, -1, -1, -1, -1,
  105. -1, -1, -1, -1, -1, 0, 0, 0,
  106. 0, 2, 4, 5, 6, 6, 6, 6,
  107. 6, 5, 5, 4, 3, 2, 1, 1,
  108. 0, -6, -12, -16, -18, -20, -21, -20,
  109. -20, -18, -16, -13, -10, -8, -5, -2,
  110. 127, 126, 125, 121, 114, 107, 99, 89,
  111. 79, 68, 57, 46, 35, 25, 16, 8,
  112. };
  113. static const u8 filter_y_vert_tap4[] = {
  114. 0, -3, -6, -8, -8, -8, -8, -7,
  115. -6, -5, -4, -3, -2, -1, -1, 0,
  116. 127, 126, 124, 118, 111, 102, 92, 81,
  117. 70, 59, 48, 37, 27, 19, 11, 5,
  118. 0, 5, 11, 19, 27, 37, 48, 59,
  119. 70, 81, 92, 102, 111, 118, 124, 126,
  120. 0, 0, -1, -1, -2, -3, -4, -5,
  121. -6, -7, -8, -8, -8, -8, -6, -3,
  122. };
  123. static const u8 filter_cr_horiz_tap4[] = {
  124. 0, -3, -6, -8, -8, -8, -8, -7,
  125. -6, -5, -4, -3, -2, -1, -1, 0,
  126. 127, 126, 124, 118, 111, 102, 92, 81,
  127. 70, 59, 48, 37, 27, 19, 11, 5,
  128. };
  129. static inline u32 vp_reg_read(struct mixer_resources *res, u32 reg_id)
  130. {
  131. return readl(res->vp_regs + reg_id);
  132. }
  133. static inline void vp_reg_write(struct mixer_resources *res, u32 reg_id,
  134. u32 val)
  135. {
  136. writel(val, res->vp_regs + reg_id);
  137. }
  138. static inline void vp_reg_writemask(struct mixer_resources *res, u32 reg_id,
  139. u32 val, u32 mask)
  140. {
  141. u32 old = vp_reg_read(res, reg_id);
  142. val = (val & mask) | (old & ~mask);
  143. writel(val, res->vp_regs + reg_id);
  144. }
  145. static inline u32 mixer_reg_read(struct mixer_resources *res, u32 reg_id)
  146. {
  147. return readl(res->mixer_regs + reg_id);
  148. }
  149. static inline void mixer_reg_write(struct mixer_resources *res, u32 reg_id,
  150. u32 val)
  151. {
  152. writel(val, res->mixer_regs + reg_id);
  153. }
  154. static inline void mixer_reg_writemask(struct mixer_resources *res,
  155. u32 reg_id, u32 val, u32 mask)
  156. {
  157. u32 old = mixer_reg_read(res, reg_id);
  158. val = (val & mask) | (old & ~mask);
  159. writel(val, res->mixer_regs + reg_id);
  160. }
  161. static void mixer_regs_dump(struct mixer_context *ctx)
  162. {
  163. #define DUMPREG(reg_id) \
  164. do { \
  165. DRM_DEBUG_KMS(#reg_id " = %08x\n", \
  166. (u32)readl(ctx->mixer_res.mixer_regs + reg_id)); \
  167. } while (0)
  168. DUMPREG(MXR_STATUS);
  169. DUMPREG(MXR_CFG);
  170. DUMPREG(MXR_INT_EN);
  171. DUMPREG(MXR_INT_STATUS);
  172. DUMPREG(MXR_LAYER_CFG);
  173. DUMPREG(MXR_VIDEO_CFG);
  174. DUMPREG(MXR_GRAPHIC0_CFG);
  175. DUMPREG(MXR_GRAPHIC0_BASE);
  176. DUMPREG(MXR_GRAPHIC0_SPAN);
  177. DUMPREG(MXR_GRAPHIC0_WH);
  178. DUMPREG(MXR_GRAPHIC0_SXY);
  179. DUMPREG(MXR_GRAPHIC0_DXY);
  180. DUMPREG(MXR_GRAPHIC1_CFG);
  181. DUMPREG(MXR_GRAPHIC1_BASE);
  182. DUMPREG(MXR_GRAPHIC1_SPAN);
  183. DUMPREG(MXR_GRAPHIC1_WH);
  184. DUMPREG(MXR_GRAPHIC1_SXY);
  185. DUMPREG(MXR_GRAPHIC1_DXY);
  186. #undef DUMPREG
  187. }
  188. static void vp_regs_dump(struct mixer_context *ctx)
  189. {
  190. #define DUMPREG(reg_id) \
  191. do { \
  192. DRM_DEBUG_KMS(#reg_id " = %08x\n", \
  193. (u32) readl(ctx->mixer_res.vp_regs + reg_id)); \
  194. } while (0)
  195. DUMPREG(VP_ENABLE);
  196. DUMPREG(VP_SRESET);
  197. DUMPREG(VP_SHADOW_UPDATE);
  198. DUMPREG(VP_FIELD_ID);
  199. DUMPREG(VP_MODE);
  200. DUMPREG(VP_IMG_SIZE_Y);
  201. DUMPREG(VP_IMG_SIZE_C);
  202. DUMPREG(VP_PER_RATE_CTRL);
  203. DUMPREG(VP_TOP_Y_PTR);
  204. DUMPREG(VP_BOT_Y_PTR);
  205. DUMPREG(VP_TOP_C_PTR);
  206. DUMPREG(VP_BOT_C_PTR);
  207. DUMPREG(VP_ENDIAN_MODE);
  208. DUMPREG(VP_SRC_H_POSITION);
  209. DUMPREG(VP_SRC_V_POSITION);
  210. DUMPREG(VP_SRC_WIDTH);
  211. DUMPREG(VP_SRC_HEIGHT);
  212. DUMPREG(VP_DST_H_POSITION);
  213. DUMPREG(VP_DST_V_POSITION);
  214. DUMPREG(VP_DST_WIDTH);
  215. DUMPREG(VP_DST_HEIGHT);
  216. DUMPREG(VP_H_RATIO);
  217. DUMPREG(VP_V_RATIO);
  218. #undef DUMPREG
  219. }
  220. static inline void vp_filter_set(struct mixer_resources *res,
  221. int reg_id, const u8 *data, unsigned int size)
  222. {
  223. /* assure 4-byte align */
  224. BUG_ON(size & 3);
  225. for (; size; size -= 4, reg_id += 4, data += 4) {
  226. u32 val = (data[0] << 24) | (data[1] << 16) |
  227. (data[2] << 8) | data[3];
  228. vp_reg_write(res, reg_id, val);
  229. }
  230. }
  231. static void vp_default_filter(struct mixer_resources *res)
  232. {
  233. vp_filter_set(res, VP_POLY8_Y0_LL,
  234. filter_y_horiz_tap8, sizeof(filter_y_horiz_tap8));
  235. vp_filter_set(res, VP_POLY4_Y0_LL,
  236. filter_y_vert_tap4, sizeof(filter_y_vert_tap4));
  237. vp_filter_set(res, VP_POLY4_C0_LL,
  238. filter_cr_horiz_tap4, sizeof(filter_cr_horiz_tap4));
  239. }
  240. static void mixer_vsync_set_update(struct mixer_context *ctx, bool enable)
  241. {
  242. struct mixer_resources *res = &ctx->mixer_res;
  243. /* block update on vsync */
  244. mixer_reg_writemask(res, MXR_STATUS, enable ?
  245. MXR_STATUS_SYNC_ENABLE : 0, MXR_STATUS_SYNC_ENABLE);
  246. if (ctx->vp_enabled)
  247. vp_reg_write(res, VP_SHADOW_UPDATE, enable ?
  248. VP_SHADOW_UPDATE_ENABLE : 0);
  249. }
  250. static void mixer_cfg_scan(struct mixer_context *ctx, unsigned int height)
  251. {
  252. struct mixer_resources *res = &ctx->mixer_res;
  253. u32 val;
  254. /* choosing between interlace and progressive mode */
  255. val = (ctx->interlace ? MXR_CFG_SCAN_INTERLACE :
  256. MXR_CFG_SCAN_PROGRASSIVE);
  257. if (ctx->mxr_ver != MXR_VER_128_0_0_184) {
  258. /* choosing between proper HD and SD mode */
  259. if (height <= 480)
  260. val |= MXR_CFG_SCAN_NTSC | MXR_CFG_SCAN_SD;
  261. else if (height <= 576)
  262. val |= MXR_CFG_SCAN_PAL | MXR_CFG_SCAN_SD;
  263. else if (height <= 720)
  264. val |= MXR_CFG_SCAN_HD_720 | MXR_CFG_SCAN_HD;
  265. else if (height <= 1080)
  266. val |= MXR_CFG_SCAN_HD_1080 | MXR_CFG_SCAN_HD;
  267. else
  268. val |= MXR_CFG_SCAN_HD_720 | MXR_CFG_SCAN_HD;
  269. }
  270. mixer_reg_writemask(res, MXR_CFG, val, MXR_CFG_SCAN_MASK);
  271. }
  272. static void mixer_cfg_rgb_fmt(struct mixer_context *ctx, unsigned int height)
  273. {
  274. struct mixer_resources *res = &ctx->mixer_res;
  275. u32 val;
  276. if (height == 480) {
  277. val = MXR_CFG_RGB601_0_255;
  278. } else if (height == 576) {
  279. val = MXR_CFG_RGB601_0_255;
  280. } else if (height == 720) {
  281. val = MXR_CFG_RGB709_16_235;
  282. mixer_reg_write(res, MXR_CM_COEFF_Y,
  283. (1 << 30) | (94 << 20) | (314 << 10) |
  284. (32 << 0));
  285. mixer_reg_write(res, MXR_CM_COEFF_CB,
  286. (972 << 20) | (851 << 10) | (225 << 0));
  287. mixer_reg_write(res, MXR_CM_COEFF_CR,
  288. (225 << 20) | (820 << 10) | (1004 << 0));
  289. } else if (height == 1080) {
  290. val = MXR_CFG_RGB709_16_235;
  291. mixer_reg_write(res, MXR_CM_COEFF_Y,
  292. (1 << 30) | (94 << 20) | (314 << 10) |
  293. (32 << 0));
  294. mixer_reg_write(res, MXR_CM_COEFF_CB,
  295. (972 << 20) | (851 << 10) | (225 << 0));
  296. mixer_reg_write(res, MXR_CM_COEFF_CR,
  297. (225 << 20) | (820 << 10) | (1004 << 0));
  298. } else {
  299. val = MXR_CFG_RGB709_16_235;
  300. mixer_reg_write(res, MXR_CM_COEFF_Y,
  301. (1 << 30) | (94 << 20) | (314 << 10) |
  302. (32 << 0));
  303. mixer_reg_write(res, MXR_CM_COEFF_CB,
  304. (972 << 20) | (851 << 10) | (225 << 0));
  305. mixer_reg_write(res, MXR_CM_COEFF_CR,
  306. (225 << 20) | (820 << 10) | (1004 << 0));
  307. }
  308. mixer_reg_writemask(res, MXR_CFG, val, MXR_CFG_RGB_FMT_MASK);
  309. }
  310. static void mixer_cfg_layer(struct mixer_context *ctx, int win, bool enable)
  311. {
  312. struct mixer_resources *res = &ctx->mixer_res;
  313. u32 val = enable ? ~0 : 0;
  314. switch (win) {
  315. case 0:
  316. mixer_reg_writemask(res, MXR_CFG, val, MXR_CFG_GRP0_ENABLE);
  317. break;
  318. case 1:
  319. mixer_reg_writemask(res, MXR_CFG, val, MXR_CFG_GRP1_ENABLE);
  320. break;
  321. case 2:
  322. if (ctx->vp_enabled) {
  323. vp_reg_writemask(res, VP_ENABLE, val, VP_ENABLE_ON);
  324. mixer_reg_writemask(res, MXR_CFG, val,
  325. MXR_CFG_VP_ENABLE);
  326. /* control blending of graphic layer 0 */
  327. mixer_reg_writemask(res, MXR_GRAPHIC_CFG(0), val,
  328. MXR_GRP_CFG_BLEND_PRE_MUL |
  329. MXR_GRP_CFG_PIXEL_BLEND_EN);
  330. }
  331. break;
  332. }
  333. }
  334. static void mixer_run(struct mixer_context *ctx)
  335. {
  336. struct mixer_resources *res = &ctx->mixer_res;
  337. mixer_reg_writemask(res, MXR_STATUS, ~0, MXR_STATUS_REG_RUN);
  338. mixer_regs_dump(ctx);
  339. }
  340. static void mixer_stop(struct mixer_context *ctx)
  341. {
  342. struct mixer_resources *res = &ctx->mixer_res;
  343. int timeout = 20;
  344. mixer_reg_writemask(res, MXR_STATUS, 0, MXR_STATUS_REG_RUN);
  345. while (!(mixer_reg_read(res, MXR_STATUS) & MXR_STATUS_REG_IDLE) &&
  346. --timeout)
  347. usleep_range(10000, 12000);
  348. mixer_regs_dump(ctx);
  349. }
  350. static void vp_video_buffer(struct mixer_context *ctx, int win)
  351. {
  352. struct mixer_resources *res = &ctx->mixer_res;
  353. unsigned long flags;
  354. struct hdmi_win_data *win_data;
  355. unsigned int x_ratio, y_ratio;
  356. unsigned int buf_num = 1;
  357. dma_addr_t luma_addr[2], chroma_addr[2];
  358. bool tiled_mode = false;
  359. bool crcb_mode = false;
  360. u32 val;
  361. win_data = &ctx->win_data[win];
  362. switch (win_data->pixel_format) {
  363. case DRM_FORMAT_NV12MT:
  364. tiled_mode = true;
  365. case DRM_FORMAT_NV12:
  366. crcb_mode = false;
  367. buf_num = 2;
  368. break;
  369. /* TODO: single buffer format NV12, NV21 */
  370. default:
  371. /* ignore pixel format at disable time */
  372. if (!win_data->dma_addr)
  373. break;
  374. DRM_ERROR("pixel format for vp is wrong [%d].\n",
  375. win_data->pixel_format);
  376. return;
  377. }
  378. /* scaling feature: (src << 16) / dst */
  379. x_ratio = (win_data->src_width << 16) / win_data->crtc_width;
  380. y_ratio = (win_data->src_height << 16) / win_data->crtc_height;
  381. if (buf_num == 2) {
  382. luma_addr[0] = win_data->dma_addr;
  383. chroma_addr[0] = win_data->chroma_dma_addr;
  384. } else {
  385. luma_addr[0] = win_data->dma_addr;
  386. chroma_addr[0] = win_data->dma_addr
  387. + (win_data->fb_width * win_data->fb_height);
  388. }
  389. if (win_data->scan_flags & DRM_MODE_FLAG_INTERLACE) {
  390. ctx->interlace = true;
  391. if (tiled_mode) {
  392. luma_addr[1] = luma_addr[0] + 0x40;
  393. chroma_addr[1] = chroma_addr[0] + 0x40;
  394. } else {
  395. luma_addr[1] = luma_addr[0] + win_data->fb_width;
  396. chroma_addr[1] = chroma_addr[0] + win_data->fb_width;
  397. }
  398. } else {
  399. ctx->interlace = false;
  400. luma_addr[1] = 0;
  401. chroma_addr[1] = 0;
  402. }
  403. spin_lock_irqsave(&res->reg_slock, flags);
  404. mixer_vsync_set_update(ctx, false);
  405. /* interlace or progressive scan mode */
  406. val = (ctx->interlace ? ~0 : 0);
  407. vp_reg_writemask(res, VP_MODE, val, VP_MODE_LINE_SKIP);
  408. /* setup format */
  409. val = (crcb_mode ? VP_MODE_NV21 : VP_MODE_NV12);
  410. val |= (tiled_mode ? VP_MODE_MEM_TILED : VP_MODE_MEM_LINEAR);
  411. vp_reg_writemask(res, VP_MODE, val, VP_MODE_FMT_MASK);
  412. /* setting size of input image */
  413. vp_reg_write(res, VP_IMG_SIZE_Y, VP_IMG_HSIZE(win_data->fb_width) |
  414. VP_IMG_VSIZE(win_data->fb_height));
  415. /* chroma height has to reduced by 2 to avoid chroma distorions */
  416. vp_reg_write(res, VP_IMG_SIZE_C, VP_IMG_HSIZE(win_data->fb_width) |
  417. VP_IMG_VSIZE(win_data->fb_height / 2));
  418. vp_reg_write(res, VP_SRC_WIDTH, win_data->src_width);
  419. vp_reg_write(res, VP_SRC_HEIGHT, win_data->src_height);
  420. vp_reg_write(res, VP_SRC_H_POSITION,
  421. VP_SRC_H_POSITION_VAL(win_data->fb_x));
  422. vp_reg_write(res, VP_SRC_V_POSITION, win_data->fb_y);
  423. vp_reg_write(res, VP_DST_WIDTH, win_data->crtc_width);
  424. vp_reg_write(res, VP_DST_H_POSITION, win_data->crtc_x);
  425. if (ctx->interlace) {
  426. vp_reg_write(res, VP_DST_HEIGHT, win_data->crtc_height / 2);
  427. vp_reg_write(res, VP_DST_V_POSITION, win_data->crtc_y / 2);
  428. } else {
  429. vp_reg_write(res, VP_DST_HEIGHT, win_data->crtc_height);
  430. vp_reg_write(res, VP_DST_V_POSITION, win_data->crtc_y);
  431. }
  432. vp_reg_write(res, VP_H_RATIO, x_ratio);
  433. vp_reg_write(res, VP_V_RATIO, y_ratio);
  434. vp_reg_write(res, VP_ENDIAN_MODE, VP_ENDIAN_MODE_LITTLE);
  435. /* set buffer address to vp */
  436. vp_reg_write(res, VP_TOP_Y_PTR, luma_addr[0]);
  437. vp_reg_write(res, VP_BOT_Y_PTR, luma_addr[1]);
  438. vp_reg_write(res, VP_TOP_C_PTR, chroma_addr[0]);
  439. vp_reg_write(res, VP_BOT_C_PTR, chroma_addr[1]);
  440. mixer_cfg_scan(ctx, win_data->mode_height);
  441. mixer_cfg_rgb_fmt(ctx, win_data->mode_height);
  442. mixer_cfg_layer(ctx, win, true);
  443. mixer_run(ctx);
  444. mixer_vsync_set_update(ctx, true);
  445. spin_unlock_irqrestore(&res->reg_slock, flags);
  446. vp_regs_dump(ctx);
  447. }
  448. static void mixer_layer_update(struct mixer_context *ctx)
  449. {
  450. struct mixer_resources *res = &ctx->mixer_res;
  451. mixer_reg_writemask(res, MXR_CFG, ~0, MXR_CFG_LAYER_UPDATE);
  452. }
  453. static void mixer_graph_buffer(struct mixer_context *ctx, int win)
  454. {
  455. struct mixer_resources *res = &ctx->mixer_res;
  456. unsigned long flags;
  457. struct hdmi_win_data *win_data;
  458. unsigned int x_ratio, y_ratio;
  459. unsigned int src_x_offset, src_y_offset, dst_x_offset, dst_y_offset;
  460. dma_addr_t dma_addr;
  461. unsigned int fmt;
  462. u32 val;
  463. win_data = &ctx->win_data[win];
  464. #define RGB565 4
  465. #define ARGB1555 5
  466. #define ARGB4444 6
  467. #define ARGB8888 7
  468. switch (win_data->bpp) {
  469. case 16:
  470. fmt = ARGB4444;
  471. break;
  472. case 32:
  473. fmt = ARGB8888;
  474. break;
  475. default:
  476. fmt = ARGB8888;
  477. }
  478. /* 2x scaling feature */
  479. x_ratio = 0;
  480. y_ratio = 0;
  481. dst_x_offset = win_data->crtc_x;
  482. dst_y_offset = win_data->crtc_y;
  483. /* converting dma address base and source offset */
  484. dma_addr = win_data->dma_addr
  485. + (win_data->fb_x * win_data->bpp >> 3)
  486. + (win_data->fb_y * win_data->fb_width * win_data->bpp >> 3);
  487. src_x_offset = 0;
  488. src_y_offset = 0;
  489. if (win_data->scan_flags & DRM_MODE_FLAG_INTERLACE)
  490. ctx->interlace = true;
  491. else
  492. ctx->interlace = false;
  493. spin_lock_irqsave(&res->reg_slock, flags);
  494. mixer_vsync_set_update(ctx, false);
  495. /* setup format */
  496. mixer_reg_writemask(res, MXR_GRAPHIC_CFG(win),
  497. MXR_GRP_CFG_FORMAT_VAL(fmt), MXR_GRP_CFG_FORMAT_MASK);
  498. /* setup geometry */
  499. mixer_reg_write(res, MXR_GRAPHIC_SPAN(win), win_data->fb_width);
  500. /* setup display size */
  501. if (ctx->mxr_ver == MXR_VER_128_0_0_184 &&
  502. win == MIXER_DEFAULT_WIN) {
  503. val = MXR_MXR_RES_HEIGHT(win_data->fb_height);
  504. val |= MXR_MXR_RES_WIDTH(win_data->fb_width);
  505. mixer_reg_write(res, MXR_RESOLUTION, val);
  506. }
  507. val = MXR_GRP_WH_WIDTH(win_data->crtc_width);
  508. val |= MXR_GRP_WH_HEIGHT(win_data->crtc_height);
  509. val |= MXR_GRP_WH_H_SCALE(x_ratio);
  510. val |= MXR_GRP_WH_V_SCALE(y_ratio);
  511. mixer_reg_write(res, MXR_GRAPHIC_WH(win), val);
  512. /* setup offsets in source image */
  513. val = MXR_GRP_SXY_SX(src_x_offset);
  514. val |= MXR_GRP_SXY_SY(src_y_offset);
  515. mixer_reg_write(res, MXR_GRAPHIC_SXY(win), val);
  516. /* setup offsets in display image */
  517. val = MXR_GRP_DXY_DX(dst_x_offset);
  518. val |= MXR_GRP_DXY_DY(dst_y_offset);
  519. mixer_reg_write(res, MXR_GRAPHIC_DXY(win), val);
  520. /* set buffer address to mixer */
  521. mixer_reg_write(res, MXR_GRAPHIC_BASE(win), dma_addr);
  522. mixer_cfg_scan(ctx, win_data->mode_height);
  523. mixer_cfg_rgb_fmt(ctx, win_data->mode_height);
  524. mixer_cfg_layer(ctx, win, true);
  525. /* layer update mandatory for mixer 16.0.33.0 */
  526. if (ctx->mxr_ver == MXR_VER_16_0_33_0 ||
  527. ctx->mxr_ver == MXR_VER_128_0_0_184)
  528. mixer_layer_update(ctx);
  529. mixer_run(ctx);
  530. mixer_vsync_set_update(ctx, true);
  531. spin_unlock_irqrestore(&res->reg_slock, flags);
  532. }
  533. static void vp_win_reset(struct mixer_context *ctx)
  534. {
  535. struct mixer_resources *res = &ctx->mixer_res;
  536. int tries = 100;
  537. vp_reg_write(res, VP_SRESET, VP_SRESET_PROCESSING);
  538. for (tries = 100; tries; --tries) {
  539. /* waiting until VP_SRESET_PROCESSING is 0 */
  540. if (~vp_reg_read(res, VP_SRESET) & VP_SRESET_PROCESSING)
  541. break;
  542. usleep_range(10000, 12000);
  543. }
  544. WARN(tries == 0, "failed to reset Video Processor\n");
  545. }
  546. static void mixer_win_reset(struct mixer_context *ctx)
  547. {
  548. struct mixer_resources *res = &ctx->mixer_res;
  549. unsigned long flags;
  550. u32 val; /* value stored to register */
  551. spin_lock_irqsave(&res->reg_slock, flags);
  552. mixer_vsync_set_update(ctx, false);
  553. mixer_reg_writemask(res, MXR_CFG, MXR_CFG_DST_HDMI, MXR_CFG_DST_MASK);
  554. /* set output in RGB888 mode */
  555. mixer_reg_writemask(res, MXR_CFG, MXR_CFG_OUT_RGB888, MXR_CFG_OUT_MASK);
  556. /* 16 beat burst in DMA */
  557. mixer_reg_writemask(res, MXR_STATUS, MXR_STATUS_16_BURST,
  558. MXR_STATUS_BURST_MASK);
  559. /* setting default layer priority: layer1 > layer0 > video
  560. * because typical usage scenario would be
  561. * layer1 - OSD
  562. * layer0 - framebuffer
  563. * video - video overlay
  564. */
  565. val = MXR_LAYER_CFG_GRP1_VAL(3);
  566. val |= MXR_LAYER_CFG_GRP0_VAL(2);
  567. if (ctx->vp_enabled)
  568. val |= MXR_LAYER_CFG_VP_VAL(1);
  569. mixer_reg_write(res, MXR_LAYER_CFG, val);
  570. /* setting background color */
  571. mixer_reg_write(res, MXR_BG_COLOR0, 0x008080);
  572. mixer_reg_write(res, MXR_BG_COLOR1, 0x008080);
  573. mixer_reg_write(res, MXR_BG_COLOR2, 0x008080);
  574. /* setting graphical layers */
  575. val = MXR_GRP_CFG_COLOR_KEY_DISABLE; /* no blank key */
  576. val |= MXR_GRP_CFG_WIN_BLEND_EN;
  577. val |= MXR_GRP_CFG_ALPHA_VAL(0xff); /* non-transparent alpha */
  578. /* Don't blend layer 0 onto the mixer background */
  579. mixer_reg_write(res, MXR_GRAPHIC_CFG(0), val);
  580. /* Blend layer 1 into layer 0 */
  581. val |= MXR_GRP_CFG_BLEND_PRE_MUL;
  582. val |= MXR_GRP_CFG_PIXEL_BLEND_EN;
  583. mixer_reg_write(res, MXR_GRAPHIC_CFG(1), val);
  584. /* setting video layers */
  585. val = MXR_GRP_CFG_ALPHA_VAL(0);
  586. mixer_reg_write(res, MXR_VIDEO_CFG, val);
  587. if (ctx->vp_enabled) {
  588. /* configuration of Video Processor Registers */
  589. vp_win_reset(ctx);
  590. vp_default_filter(res);
  591. }
  592. /* disable all layers */
  593. mixer_reg_writemask(res, MXR_CFG, 0, MXR_CFG_GRP0_ENABLE);
  594. mixer_reg_writemask(res, MXR_CFG, 0, MXR_CFG_GRP1_ENABLE);
  595. if (ctx->vp_enabled)
  596. mixer_reg_writemask(res, MXR_CFG, 0, MXR_CFG_VP_ENABLE);
  597. mixer_vsync_set_update(ctx, true);
  598. spin_unlock_irqrestore(&res->reg_slock, flags);
  599. }
  600. static irqreturn_t mixer_irq_handler(int irq, void *arg)
  601. {
  602. struct mixer_context *ctx = arg;
  603. struct mixer_resources *res = &ctx->mixer_res;
  604. u32 val, base, shadow;
  605. spin_lock(&res->reg_slock);
  606. /* read interrupt status for handling and clearing flags for VSYNC */
  607. val = mixer_reg_read(res, MXR_INT_STATUS);
  608. /* handling VSYNC */
  609. if (val & MXR_INT_STATUS_VSYNC) {
  610. /* interlace scan need to check shadow register */
  611. if (ctx->interlace) {
  612. base = mixer_reg_read(res, MXR_GRAPHIC_BASE(0));
  613. shadow = mixer_reg_read(res, MXR_GRAPHIC_BASE_S(0));
  614. if (base != shadow)
  615. goto out;
  616. base = mixer_reg_read(res, MXR_GRAPHIC_BASE(1));
  617. shadow = mixer_reg_read(res, MXR_GRAPHIC_BASE_S(1));
  618. if (base != shadow)
  619. goto out;
  620. }
  621. drm_handle_vblank(ctx->drm_dev, ctx->pipe);
  622. exynos_drm_crtc_finish_pageflip(ctx->drm_dev, ctx->pipe);
  623. /* set wait vsync event to zero and wake up queue. */
  624. if (atomic_read(&ctx->wait_vsync_event)) {
  625. atomic_set(&ctx->wait_vsync_event, 0);
  626. wake_up(&ctx->wait_vsync_queue);
  627. }
  628. }
  629. out:
  630. /* clear interrupts */
  631. if (~val & MXR_INT_EN_VSYNC) {
  632. /* vsync interrupt use different bit for read and clear */
  633. val &= ~MXR_INT_EN_VSYNC;
  634. val |= MXR_INT_CLEAR_VSYNC;
  635. }
  636. mixer_reg_write(res, MXR_INT_STATUS, val);
  637. spin_unlock(&res->reg_slock);
  638. return IRQ_HANDLED;
  639. }
  640. static int mixer_resources_init(struct mixer_context *mixer_ctx)
  641. {
  642. struct device *dev = &mixer_ctx->pdev->dev;
  643. struct mixer_resources *mixer_res = &mixer_ctx->mixer_res;
  644. struct resource *res;
  645. int ret;
  646. spin_lock_init(&mixer_res->reg_slock);
  647. mixer_res->mixer = devm_clk_get(dev, "mixer");
  648. if (IS_ERR(mixer_res->mixer)) {
  649. dev_err(dev, "failed to get clock 'mixer'\n");
  650. return -ENODEV;
  651. }
  652. mixer_res->sclk_hdmi = devm_clk_get(dev, "sclk_hdmi");
  653. if (IS_ERR(mixer_res->sclk_hdmi)) {
  654. dev_err(dev, "failed to get clock 'sclk_hdmi'\n");
  655. return -ENODEV;
  656. }
  657. res = platform_get_resource(mixer_ctx->pdev, IORESOURCE_MEM, 0);
  658. if (res == NULL) {
  659. dev_err(dev, "get memory resource failed.\n");
  660. return -ENXIO;
  661. }
  662. mixer_res->mixer_regs = devm_ioremap(dev, res->start,
  663. resource_size(res));
  664. if (mixer_res->mixer_regs == NULL) {
  665. dev_err(dev, "register mapping failed.\n");
  666. return -ENXIO;
  667. }
  668. res = platform_get_resource(mixer_ctx->pdev, IORESOURCE_IRQ, 0);
  669. if (res == NULL) {
  670. dev_err(dev, "get interrupt resource failed.\n");
  671. return -ENXIO;
  672. }
  673. ret = devm_request_irq(dev, res->start, mixer_irq_handler,
  674. 0, "drm_mixer", mixer_ctx);
  675. if (ret) {
  676. dev_err(dev, "request interrupt failed.\n");
  677. return ret;
  678. }
  679. mixer_res->irq = res->start;
  680. return 0;
  681. }
  682. static int vp_resources_init(struct mixer_context *mixer_ctx)
  683. {
  684. struct device *dev = &mixer_ctx->pdev->dev;
  685. struct mixer_resources *mixer_res = &mixer_ctx->mixer_res;
  686. struct resource *res;
  687. mixer_res->vp = devm_clk_get(dev, "vp");
  688. if (IS_ERR(mixer_res->vp)) {
  689. dev_err(dev, "failed to get clock 'vp'\n");
  690. return -ENODEV;
  691. }
  692. if (mixer_ctx->has_sclk) {
  693. mixer_res->sclk_mixer = devm_clk_get(dev, "sclk_mixer");
  694. if (IS_ERR(mixer_res->sclk_mixer)) {
  695. dev_err(dev, "failed to get clock 'sclk_mixer'\n");
  696. return -ENODEV;
  697. }
  698. mixer_res->mout_mixer = devm_clk_get(dev, "mout_mixer");
  699. if (IS_ERR(mixer_res->mout_mixer)) {
  700. dev_err(dev, "failed to get clock 'mout_mixer'\n");
  701. return -ENODEV;
  702. }
  703. if (mixer_res->sclk_hdmi && mixer_res->mout_mixer)
  704. clk_set_parent(mixer_res->mout_mixer,
  705. mixer_res->sclk_hdmi);
  706. }
  707. res = platform_get_resource(mixer_ctx->pdev, IORESOURCE_MEM, 1);
  708. if (res == NULL) {
  709. dev_err(dev, "get memory resource failed.\n");
  710. return -ENXIO;
  711. }
  712. mixer_res->vp_regs = devm_ioremap(dev, res->start,
  713. resource_size(res));
  714. if (mixer_res->vp_regs == NULL) {
  715. dev_err(dev, "register mapping failed.\n");
  716. return -ENXIO;
  717. }
  718. return 0;
  719. }
  720. static int mixer_initialize(struct exynos_drm_manager *mgr,
  721. struct drm_device *drm_dev)
  722. {
  723. int ret;
  724. struct mixer_context *mixer_ctx = mgr_to_mixer(mgr);
  725. struct exynos_drm_private *priv;
  726. priv = drm_dev->dev_private;
  727. mgr->drm_dev = mixer_ctx->drm_dev = drm_dev;
  728. mgr->pipe = mixer_ctx->pipe = priv->pipe++;
  729. /* acquire resources: regs, irqs, clocks */
  730. ret = mixer_resources_init(mixer_ctx);
  731. if (ret) {
  732. DRM_ERROR("mixer_resources_init failed ret=%d\n", ret);
  733. return ret;
  734. }
  735. if (mixer_ctx->vp_enabled) {
  736. /* acquire vp resources: regs, irqs, clocks */
  737. ret = vp_resources_init(mixer_ctx);
  738. if (ret) {
  739. DRM_ERROR("vp_resources_init failed ret=%d\n", ret);
  740. return ret;
  741. }
  742. }
  743. if (!is_drm_iommu_supported(mixer_ctx->drm_dev))
  744. return 0;
  745. return drm_iommu_attach_device(mixer_ctx->drm_dev, mixer_ctx->dev);
  746. }
  747. static void mixer_mgr_remove(struct exynos_drm_manager *mgr)
  748. {
  749. struct mixer_context *mixer_ctx = mgr_to_mixer(mgr);
  750. if (is_drm_iommu_supported(mixer_ctx->drm_dev))
  751. drm_iommu_detach_device(mixer_ctx->drm_dev, mixer_ctx->dev);
  752. }
  753. static int mixer_enable_vblank(struct exynos_drm_manager *mgr)
  754. {
  755. struct mixer_context *mixer_ctx = mgr_to_mixer(mgr);
  756. struct mixer_resources *res = &mixer_ctx->mixer_res;
  757. if (!mixer_ctx->powered) {
  758. mixer_ctx->int_en |= MXR_INT_EN_VSYNC;
  759. return 0;
  760. }
  761. /* enable vsync interrupt */
  762. mixer_reg_writemask(res, MXR_INT_EN, MXR_INT_EN_VSYNC,
  763. MXR_INT_EN_VSYNC);
  764. return 0;
  765. }
  766. static void mixer_disable_vblank(struct exynos_drm_manager *mgr)
  767. {
  768. struct mixer_context *mixer_ctx = mgr_to_mixer(mgr);
  769. struct mixer_resources *res = &mixer_ctx->mixer_res;
  770. /* disable vsync interrupt */
  771. mixer_reg_writemask(res, MXR_INT_EN, 0, MXR_INT_EN_VSYNC);
  772. }
  773. static void mixer_win_mode_set(struct exynos_drm_manager *mgr,
  774. struct exynos_drm_overlay *overlay)
  775. {
  776. struct mixer_context *mixer_ctx = mgr_to_mixer(mgr);
  777. struct hdmi_win_data *win_data;
  778. int win;
  779. if (!overlay) {
  780. DRM_ERROR("overlay is NULL\n");
  781. return;
  782. }
  783. DRM_DEBUG_KMS("set [%d]x[%d] at (%d,%d) to [%d]x[%d] at (%d,%d)\n",
  784. overlay->fb_width, overlay->fb_height,
  785. overlay->fb_x, overlay->fb_y,
  786. overlay->crtc_width, overlay->crtc_height,
  787. overlay->crtc_x, overlay->crtc_y);
  788. win = overlay->zpos;
  789. if (win == DEFAULT_ZPOS)
  790. win = MIXER_DEFAULT_WIN;
  791. if (win < 0 || win >= MIXER_WIN_NR) {
  792. DRM_ERROR("mixer window[%d] is wrong\n", win);
  793. return;
  794. }
  795. win_data = &mixer_ctx->win_data[win];
  796. win_data->dma_addr = overlay->dma_addr[0];
  797. win_data->chroma_dma_addr = overlay->dma_addr[1];
  798. win_data->pixel_format = overlay->pixel_format;
  799. win_data->bpp = overlay->bpp;
  800. win_data->crtc_x = overlay->crtc_x;
  801. win_data->crtc_y = overlay->crtc_y;
  802. win_data->crtc_width = overlay->crtc_width;
  803. win_data->crtc_height = overlay->crtc_height;
  804. win_data->fb_x = overlay->fb_x;
  805. win_data->fb_y = overlay->fb_y;
  806. win_data->fb_width = overlay->fb_width;
  807. win_data->fb_height = overlay->fb_height;
  808. win_data->src_width = overlay->src_width;
  809. win_data->src_height = overlay->src_height;
  810. win_data->mode_width = overlay->mode_width;
  811. win_data->mode_height = overlay->mode_height;
  812. win_data->scan_flags = overlay->scan_flag;
  813. }
  814. static void mixer_win_commit(struct exynos_drm_manager *mgr, int zpos)
  815. {
  816. struct mixer_context *mixer_ctx = mgr_to_mixer(mgr);
  817. int win = zpos == DEFAULT_ZPOS ? MIXER_DEFAULT_WIN : zpos;
  818. DRM_DEBUG_KMS("win: %d\n", win);
  819. mutex_lock(&mixer_ctx->mixer_mutex);
  820. if (!mixer_ctx->powered) {
  821. mutex_unlock(&mixer_ctx->mixer_mutex);
  822. return;
  823. }
  824. mutex_unlock(&mixer_ctx->mixer_mutex);
  825. if (win > 1 && mixer_ctx->vp_enabled)
  826. vp_video_buffer(mixer_ctx, win);
  827. else
  828. mixer_graph_buffer(mixer_ctx, win);
  829. mixer_ctx->win_data[win].enabled = true;
  830. }
  831. static void mixer_win_disable(struct exynos_drm_manager *mgr, int zpos)
  832. {
  833. struct mixer_context *mixer_ctx = mgr_to_mixer(mgr);
  834. struct mixer_resources *res = &mixer_ctx->mixer_res;
  835. int win = zpos == DEFAULT_ZPOS ? MIXER_DEFAULT_WIN : zpos;
  836. unsigned long flags;
  837. DRM_DEBUG_KMS("win: %d\n", win);
  838. mutex_lock(&mixer_ctx->mixer_mutex);
  839. if (!mixer_ctx->powered) {
  840. mutex_unlock(&mixer_ctx->mixer_mutex);
  841. mixer_ctx->win_data[win].resume = false;
  842. return;
  843. }
  844. mutex_unlock(&mixer_ctx->mixer_mutex);
  845. spin_lock_irqsave(&res->reg_slock, flags);
  846. mixer_vsync_set_update(mixer_ctx, false);
  847. mixer_cfg_layer(mixer_ctx, win, false);
  848. mixer_vsync_set_update(mixer_ctx, true);
  849. spin_unlock_irqrestore(&res->reg_slock, flags);
  850. mixer_ctx->win_data[win].enabled = false;
  851. }
  852. static void mixer_wait_for_vblank(struct exynos_drm_manager *mgr)
  853. {
  854. struct mixer_context *mixer_ctx = mgr_to_mixer(mgr);
  855. int err;
  856. mutex_lock(&mixer_ctx->mixer_mutex);
  857. if (!mixer_ctx->powered) {
  858. mutex_unlock(&mixer_ctx->mixer_mutex);
  859. return;
  860. }
  861. mutex_unlock(&mixer_ctx->mixer_mutex);
  862. err = drm_vblank_get(mgr->crtc->dev, mixer_ctx->pipe);
  863. if (err < 0) {
  864. DRM_DEBUG_KMS("failed to acquire vblank counter\n");
  865. return;
  866. }
  867. atomic_set(&mixer_ctx->wait_vsync_event, 1);
  868. /*
  869. * wait for MIXER to signal VSYNC interrupt or return after
  870. * timeout which is set to 50ms (refresh rate of 20).
  871. */
  872. if (!wait_event_timeout(mixer_ctx->wait_vsync_queue,
  873. !atomic_read(&mixer_ctx->wait_vsync_event),
  874. HZ/20))
  875. DRM_DEBUG_KMS("vblank wait timed out.\n");
  876. drm_vblank_put(mgr->crtc->dev, mixer_ctx->pipe);
  877. }
  878. static void mixer_window_suspend(struct exynos_drm_manager *mgr)
  879. {
  880. struct mixer_context *ctx = mgr_to_mixer(mgr);
  881. struct hdmi_win_data *win_data;
  882. int i;
  883. for (i = 0; i < MIXER_WIN_NR; i++) {
  884. win_data = &ctx->win_data[i];
  885. win_data->resume = win_data->enabled;
  886. mixer_win_disable(mgr, i);
  887. }
  888. mixer_wait_for_vblank(mgr);
  889. }
  890. static void mixer_window_resume(struct exynos_drm_manager *mgr)
  891. {
  892. struct mixer_context *ctx = mgr_to_mixer(mgr);
  893. struct hdmi_win_data *win_data;
  894. int i;
  895. for (i = 0; i < MIXER_WIN_NR; i++) {
  896. win_data = &ctx->win_data[i];
  897. win_data->enabled = win_data->resume;
  898. win_data->resume = false;
  899. if (win_data->enabled)
  900. mixer_win_commit(mgr, i);
  901. }
  902. }
  903. static void mixer_poweron(struct exynos_drm_manager *mgr)
  904. {
  905. struct mixer_context *ctx = mgr_to_mixer(mgr);
  906. struct mixer_resources *res = &ctx->mixer_res;
  907. mutex_lock(&ctx->mixer_mutex);
  908. if (ctx->powered) {
  909. mutex_unlock(&ctx->mixer_mutex);
  910. return;
  911. }
  912. mutex_unlock(&ctx->mixer_mutex);
  913. pm_runtime_get_sync(ctx->dev);
  914. clk_prepare_enable(res->mixer);
  915. if (ctx->vp_enabled) {
  916. clk_prepare_enable(res->vp);
  917. if (ctx->has_sclk)
  918. clk_prepare_enable(res->sclk_mixer);
  919. }
  920. mutex_lock(&ctx->mixer_mutex);
  921. ctx->powered = true;
  922. mutex_unlock(&ctx->mixer_mutex);
  923. mixer_reg_writemask(res, MXR_STATUS, ~0, MXR_STATUS_SOFT_RESET);
  924. mixer_reg_write(res, MXR_INT_EN, ctx->int_en);
  925. mixer_win_reset(ctx);
  926. mixer_window_resume(mgr);
  927. }
  928. static void mixer_poweroff(struct exynos_drm_manager *mgr)
  929. {
  930. struct mixer_context *ctx = mgr_to_mixer(mgr);
  931. struct mixer_resources *res = &ctx->mixer_res;
  932. mutex_lock(&ctx->mixer_mutex);
  933. if (!ctx->powered) {
  934. mutex_unlock(&ctx->mixer_mutex);
  935. return;
  936. }
  937. mutex_unlock(&ctx->mixer_mutex);
  938. mixer_stop(ctx);
  939. mixer_window_suspend(mgr);
  940. ctx->int_en = mixer_reg_read(res, MXR_INT_EN);
  941. mutex_lock(&ctx->mixer_mutex);
  942. ctx->powered = false;
  943. mutex_unlock(&ctx->mixer_mutex);
  944. clk_disable_unprepare(res->mixer);
  945. if (ctx->vp_enabled) {
  946. clk_disable_unprepare(res->vp);
  947. if (ctx->has_sclk)
  948. clk_disable_unprepare(res->sclk_mixer);
  949. }
  950. pm_runtime_put_sync(ctx->dev);
  951. }
  952. static void mixer_dpms(struct exynos_drm_manager *mgr, int mode)
  953. {
  954. switch (mode) {
  955. case DRM_MODE_DPMS_ON:
  956. mixer_poweron(mgr);
  957. break;
  958. case DRM_MODE_DPMS_STANDBY:
  959. case DRM_MODE_DPMS_SUSPEND:
  960. case DRM_MODE_DPMS_OFF:
  961. mixer_poweroff(mgr);
  962. break;
  963. default:
  964. DRM_DEBUG_KMS("unknown dpms mode: %d\n", mode);
  965. break;
  966. }
  967. }
  968. /* Only valid for Mixer version 16.0.33.0 */
  969. int mixer_check_mode(struct drm_display_mode *mode)
  970. {
  971. u32 w, h;
  972. w = mode->hdisplay;
  973. h = mode->vdisplay;
  974. DRM_DEBUG_KMS("xres=%d, yres=%d, refresh=%d, intl=%d\n",
  975. mode->hdisplay, mode->vdisplay, mode->vrefresh,
  976. (mode->flags & DRM_MODE_FLAG_INTERLACE) ? 1 : 0);
  977. if ((w >= 464 && w <= 720 && h >= 261 && h <= 576) ||
  978. (w >= 1024 && w <= 1280 && h >= 576 && h <= 720) ||
  979. (w >= 1664 && w <= 1920 && h >= 936 && h <= 1080))
  980. return 0;
  981. return -EINVAL;
  982. }
  983. static struct exynos_drm_manager_ops mixer_manager_ops = {
  984. .dpms = mixer_dpms,
  985. .enable_vblank = mixer_enable_vblank,
  986. .disable_vblank = mixer_disable_vblank,
  987. .wait_for_vblank = mixer_wait_for_vblank,
  988. .win_mode_set = mixer_win_mode_set,
  989. .win_commit = mixer_win_commit,
  990. .win_disable = mixer_win_disable,
  991. };
  992. static struct mixer_drv_data exynos5420_mxr_drv_data = {
  993. .version = MXR_VER_128_0_0_184,
  994. .is_vp_enabled = 0,
  995. };
  996. static struct mixer_drv_data exynos5250_mxr_drv_data = {
  997. .version = MXR_VER_16_0_33_0,
  998. .is_vp_enabled = 0,
  999. };
  1000. static struct mixer_drv_data exynos4212_mxr_drv_data = {
  1001. .version = MXR_VER_0_0_0_16,
  1002. .is_vp_enabled = 1,
  1003. };
  1004. static struct mixer_drv_data exynos4210_mxr_drv_data = {
  1005. .version = MXR_VER_0_0_0_16,
  1006. .is_vp_enabled = 1,
  1007. .has_sclk = 1,
  1008. };
  1009. static struct platform_device_id mixer_driver_types[] = {
  1010. {
  1011. .name = "s5p-mixer",
  1012. .driver_data = (unsigned long)&exynos4210_mxr_drv_data,
  1013. }, {
  1014. .name = "exynos5-mixer",
  1015. .driver_data = (unsigned long)&exynos5250_mxr_drv_data,
  1016. }, {
  1017. /* end node */
  1018. }
  1019. };
  1020. static struct of_device_id mixer_match_types[] = {
  1021. {
  1022. .compatible = "samsung,exynos4210-mixer",
  1023. .data = &exynos4210_mxr_drv_data,
  1024. }, {
  1025. .compatible = "samsung,exynos4212-mixer",
  1026. .data = &exynos4212_mxr_drv_data,
  1027. }, {
  1028. .compatible = "samsung,exynos5-mixer",
  1029. .data = &exynos5250_mxr_drv_data,
  1030. }, {
  1031. .compatible = "samsung,exynos5250-mixer",
  1032. .data = &exynos5250_mxr_drv_data,
  1033. }, {
  1034. .compatible = "samsung,exynos5420-mixer",
  1035. .data = &exynos5420_mxr_drv_data,
  1036. }, {
  1037. /* end node */
  1038. }
  1039. };
  1040. MODULE_DEVICE_TABLE(of, mixer_match_types);
  1041. static int mixer_bind(struct device *dev, struct device *manager, void *data)
  1042. {
  1043. struct mixer_context *ctx = dev_get_drvdata(dev);
  1044. struct drm_device *drm_dev = data;
  1045. int ret;
  1046. ret = mixer_initialize(&ctx->manager, drm_dev);
  1047. if (ret)
  1048. return ret;
  1049. ret = exynos_drm_crtc_create(&ctx->manager);
  1050. if (ret) {
  1051. mixer_mgr_remove(&ctx->manager);
  1052. return ret;
  1053. }
  1054. return 0;
  1055. }
  1056. static void mixer_unbind(struct device *dev, struct device *master, void *data)
  1057. {
  1058. struct mixer_context *ctx = dev_get_drvdata(dev);
  1059. mixer_mgr_remove(&ctx->manager);
  1060. }
  1061. static const struct component_ops mixer_component_ops = {
  1062. .bind = mixer_bind,
  1063. .unbind = mixer_unbind,
  1064. };
  1065. static int mixer_probe(struct platform_device *pdev)
  1066. {
  1067. struct device *dev = &pdev->dev;
  1068. struct mixer_drv_data *drv;
  1069. struct mixer_context *ctx;
  1070. int ret;
  1071. ctx = devm_kzalloc(&pdev->dev, sizeof(*ctx), GFP_KERNEL);
  1072. if (!ctx) {
  1073. DRM_ERROR("failed to alloc mixer context.\n");
  1074. return -ENOMEM;
  1075. }
  1076. mutex_init(&ctx->mixer_mutex);
  1077. ctx->manager.type = EXYNOS_DISPLAY_TYPE_HDMI;
  1078. ctx->manager.ops = &mixer_manager_ops;
  1079. if (dev->of_node) {
  1080. const struct of_device_id *match;
  1081. match = of_match_node(mixer_match_types, dev->of_node);
  1082. drv = (struct mixer_drv_data *)match->data;
  1083. } else {
  1084. drv = (struct mixer_drv_data *)
  1085. platform_get_device_id(pdev)->driver_data;
  1086. }
  1087. ctx->pdev = pdev;
  1088. ctx->dev = dev;
  1089. ctx->vp_enabled = drv->is_vp_enabled;
  1090. ctx->has_sclk = drv->has_sclk;
  1091. ctx->mxr_ver = drv->version;
  1092. init_waitqueue_head(&ctx->wait_vsync_queue);
  1093. atomic_set(&ctx->wait_vsync_event, 0);
  1094. platform_set_drvdata(pdev, ctx);
  1095. ret = exynos_drm_component_add(&pdev->dev, EXYNOS_DEVICE_TYPE_CRTC,
  1096. ctx->manager.type);
  1097. if (ret)
  1098. return ret;
  1099. ret = component_add(&pdev->dev, &mixer_component_ops);
  1100. if (ret) {
  1101. exynos_drm_component_del(&pdev->dev, EXYNOS_DEVICE_TYPE_CRTC);
  1102. return ret;
  1103. }
  1104. pm_runtime_enable(dev);
  1105. return ret;
  1106. }
  1107. static int mixer_remove(struct platform_device *pdev)
  1108. {
  1109. pm_runtime_disable(&pdev->dev);
  1110. component_del(&pdev->dev, &mixer_component_ops);
  1111. exynos_drm_component_del(&pdev->dev, EXYNOS_DEVICE_TYPE_CRTC);
  1112. return 0;
  1113. }
  1114. struct platform_driver mixer_driver = {
  1115. .driver = {
  1116. .name = "exynos-mixer",
  1117. .owner = THIS_MODULE,
  1118. .of_match_table = mixer_match_types,
  1119. },
  1120. .probe = mixer_probe,
  1121. .remove = mixer_remove,
  1122. .id_table = mixer_driver_types,
  1123. };