exynos_drm_dsi.c 49 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903
  1. /*
  2. * Samsung SoC MIPI DSI Master driver.
  3. *
  4. * Copyright (c) 2014 Samsung Electronics Co., Ltd
  5. *
  6. * Contacts: Tomasz Figa <t.figa@samsung.com>
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License version 2 as
  10. * published by the Free Software Foundation.
  11. */
  12. #include <asm/unaligned.h>
  13. #include <drm/drmP.h>
  14. #include <drm/drm_crtc_helper.h>
  15. #include <drm/drm_mipi_dsi.h>
  16. #include <drm/drm_panel.h>
  17. #include <drm/drm_atomic_helper.h>
  18. #include <linux/clk.h>
  19. #include <linux/gpio/consumer.h>
  20. #include <linux/irq.h>
  21. #include <linux/of_device.h>
  22. #include <linux/of_gpio.h>
  23. #include <linux/of_graph.h>
  24. #include <linux/phy/phy.h>
  25. #include <linux/regulator/consumer.h>
  26. #include <linux/component.h>
  27. #include <video/mipi_display.h>
  28. #include <video/videomode.h>
  29. #include "exynos_drm_crtc.h"
  30. #include "exynos_drm_drv.h"
  31. /* returns true iff both arguments logically differs */
  32. #define NEQV(a, b) (!(a) ^ !(b))
  33. /* DSIM_STATUS */
  34. #define DSIM_STOP_STATE_DAT(x) (((x) & 0xf) << 0)
  35. #define DSIM_STOP_STATE_CLK (1 << 8)
  36. #define DSIM_TX_READY_HS_CLK (1 << 10)
  37. #define DSIM_PLL_STABLE (1 << 31)
  38. /* DSIM_SWRST */
  39. #define DSIM_FUNCRST (1 << 16)
  40. #define DSIM_SWRST (1 << 0)
  41. /* DSIM_TIMEOUT */
  42. #define DSIM_LPDR_TIMEOUT(x) ((x) << 0)
  43. #define DSIM_BTA_TIMEOUT(x) ((x) << 16)
  44. /* DSIM_CLKCTRL */
  45. #define DSIM_ESC_PRESCALER(x) (((x) & 0xffff) << 0)
  46. #define DSIM_ESC_PRESCALER_MASK (0xffff << 0)
  47. #define DSIM_LANE_ESC_CLK_EN_CLK (1 << 19)
  48. #define DSIM_LANE_ESC_CLK_EN_DATA(x) (((x) & 0xf) << 20)
  49. #define DSIM_LANE_ESC_CLK_EN_DATA_MASK (0xf << 20)
  50. #define DSIM_BYTE_CLKEN (1 << 24)
  51. #define DSIM_BYTE_CLK_SRC(x) (((x) & 0x3) << 25)
  52. #define DSIM_BYTE_CLK_SRC_MASK (0x3 << 25)
  53. #define DSIM_PLL_BYPASS (1 << 27)
  54. #define DSIM_ESC_CLKEN (1 << 28)
  55. #define DSIM_TX_REQUEST_HSCLK (1 << 31)
  56. /* DSIM_CONFIG */
  57. #define DSIM_LANE_EN_CLK (1 << 0)
  58. #define DSIM_LANE_EN(x) (((x) & 0xf) << 1)
  59. #define DSIM_NUM_OF_DATA_LANE(x) (((x) & 0x3) << 5)
  60. #define DSIM_SUB_PIX_FORMAT(x) (((x) & 0x7) << 8)
  61. #define DSIM_MAIN_PIX_FORMAT_MASK (0x7 << 12)
  62. #define DSIM_MAIN_PIX_FORMAT_RGB888 (0x7 << 12)
  63. #define DSIM_MAIN_PIX_FORMAT_RGB666 (0x6 << 12)
  64. #define DSIM_MAIN_PIX_FORMAT_RGB666_P (0x5 << 12)
  65. #define DSIM_MAIN_PIX_FORMAT_RGB565 (0x4 << 12)
  66. #define DSIM_SUB_VC (((x) & 0x3) << 16)
  67. #define DSIM_MAIN_VC (((x) & 0x3) << 18)
  68. #define DSIM_HSA_MODE (1 << 20)
  69. #define DSIM_HBP_MODE (1 << 21)
  70. #define DSIM_HFP_MODE (1 << 22)
  71. #define DSIM_HSE_MODE (1 << 23)
  72. #define DSIM_AUTO_MODE (1 << 24)
  73. #define DSIM_VIDEO_MODE (1 << 25)
  74. #define DSIM_BURST_MODE (1 << 26)
  75. #define DSIM_SYNC_INFORM (1 << 27)
  76. #define DSIM_EOT_DISABLE (1 << 28)
  77. #define DSIM_MFLUSH_VS (1 << 29)
  78. /* This flag is valid only for exynos3250/3472/5260/5430 */
  79. #define DSIM_CLKLANE_STOP (1 << 30)
  80. /* DSIM_ESCMODE */
  81. #define DSIM_TX_TRIGGER_RST (1 << 4)
  82. #define DSIM_TX_LPDT_LP (1 << 6)
  83. #define DSIM_CMD_LPDT_LP (1 << 7)
  84. #define DSIM_FORCE_BTA (1 << 16)
  85. #define DSIM_FORCE_STOP_STATE (1 << 20)
  86. #define DSIM_STOP_STATE_CNT(x) (((x) & 0x7ff) << 21)
  87. #define DSIM_STOP_STATE_CNT_MASK (0x7ff << 21)
  88. /* DSIM_MDRESOL */
  89. #define DSIM_MAIN_STAND_BY (1 << 31)
  90. #define DSIM_MAIN_VRESOL(x, num_bits) (((x) & ((1 << (num_bits)) - 1)) << 16)
  91. #define DSIM_MAIN_HRESOL(x, num_bits) (((x) & ((1 << (num_bits)) - 1)) << 0)
  92. /* DSIM_MVPORCH */
  93. #define DSIM_CMD_ALLOW(x) ((x) << 28)
  94. #define DSIM_STABLE_VFP(x) ((x) << 16)
  95. #define DSIM_MAIN_VBP(x) ((x) << 0)
  96. #define DSIM_CMD_ALLOW_MASK (0xf << 28)
  97. #define DSIM_STABLE_VFP_MASK (0x7ff << 16)
  98. #define DSIM_MAIN_VBP_MASK (0x7ff << 0)
  99. /* DSIM_MHPORCH */
  100. #define DSIM_MAIN_HFP(x) ((x) << 16)
  101. #define DSIM_MAIN_HBP(x) ((x) << 0)
  102. #define DSIM_MAIN_HFP_MASK ((0xffff) << 16)
  103. #define DSIM_MAIN_HBP_MASK ((0xffff) << 0)
  104. /* DSIM_MSYNC */
  105. #define DSIM_MAIN_VSA(x) ((x) << 22)
  106. #define DSIM_MAIN_HSA(x) ((x) << 0)
  107. #define DSIM_MAIN_VSA_MASK ((0x3ff) << 22)
  108. #define DSIM_MAIN_HSA_MASK ((0xffff) << 0)
  109. /* DSIM_SDRESOL */
  110. #define DSIM_SUB_STANDY(x) ((x) << 31)
  111. #define DSIM_SUB_VRESOL(x) ((x) << 16)
  112. #define DSIM_SUB_HRESOL(x) ((x) << 0)
  113. #define DSIM_SUB_STANDY_MASK ((0x1) << 31)
  114. #define DSIM_SUB_VRESOL_MASK ((0x7ff) << 16)
  115. #define DSIM_SUB_HRESOL_MASK ((0x7ff) << 0)
  116. /* DSIM_INTSRC */
  117. #define DSIM_INT_PLL_STABLE (1 << 31)
  118. #define DSIM_INT_SW_RST_RELEASE (1 << 30)
  119. #define DSIM_INT_SFR_FIFO_EMPTY (1 << 29)
  120. #define DSIM_INT_SFR_HDR_FIFO_EMPTY (1 << 28)
  121. #define DSIM_INT_BTA (1 << 25)
  122. #define DSIM_INT_FRAME_DONE (1 << 24)
  123. #define DSIM_INT_RX_TIMEOUT (1 << 21)
  124. #define DSIM_INT_BTA_TIMEOUT (1 << 20)
  125. #define DSIM_INT_RX_DONE (1 << 18)
  126. #define DSIM_INT_RX_TE (1 << 17)
  127. #define DSIM_INT_RX_ACK (1 << 16)
  128. #define DSIM_INT_RX_ECC_ERR (1 << 15)
  129. #define DSIM_INT_RX_CRC_ERR (1 << 14)
  130. /* DSIM_FIFOCTRL */
  131. #define DSIM_RX_DATA_FULL (1 << 25)
  132. #define DSIM_RX_DATA_EMPTY (1 << 24)
  133. #define DSIM_SFR_HEADER_FULL (1 << 23)
  134. #define DSIM_SFR_HEADER_EMPTY (1 << 22)
  135. #define DSIM_SFR_PAYLOAD_FULL (1 << 21)
  136. #define DSIM_SFR_PAYLOAD_EMPTY (1 << 20)
  137. #define DSIM_I80_HEADER_FULL (1 << 19)
  138. #define DSIM_I80_HEADER_EMPTY (1 << 18)
  139. #define DSIM_I80_PAYLOAD_FULL (1 << 17)
  140. #define DSIM_I80_PAYLOAD_EMPTY (1 << 16)
  141. #define DSIM_SD_HEADER_FULL (1 << 15)
  142. #define DSIM_SD_HEADER_EMPTY (1 << 14)
  143. #define DSIM_SD_PAYLOAD_FULL (1 << 13)
  144. #define DSIM_SD_PAYLOAD_EMPTY (1 << 12)
  145. #define DSIM_MD_HEADER_FULL (1 << 11)
  146. #define DSIM_MD_HEADER_EMPTY (1 << 10)
  147. #define DSIM_MD_PAYLOAD_FULL (1 << 9)
  148. #define DSIM_MD_PAYLOAD_EMPTY (1 << 8)
  149. #define DSIM_RX_FIFO (1 << 4)
  150. #define DSIM_SFR_FIFO (1 << 3)
  151. #define DSIM_I80_FIFO (1 << 2)
  152. #define DSIM_SD_FIFO (1 << 1)
  153. #define DSIM_MD_FIFO (1 << 0)
  154. /* DSIM_PHYACCHR */
  155. #define DSIM_AFC_EN (1 << 14)
  156. #define DSIM_AFC_CTL(x) (((x) & 0x7) << 5)
  157. /* DSIM_PLLCTRL */
  158. #define DSIM_FREQ_BAND(x) ((x) << 24)
  159. #define DSIM_PLL_EN (1 << 23)
  160. #define DSIM_PLL_P(x) ((x) << 13)
  161. #define DSIM_PLL_M(x) ((x) << 4)
  162. #define DSIM_PLL_S(x) ((x) << 1)
  163. /* DSIM_PHYCTRL */
  164. #define DSIM_PHYCTRL_ULPS_EXIT(x) (((x) & 0x1ff) << 0)
  165. #define DSIM_PHYCTRL_B_DPHYCTL_VREG_LP (1 << 30)
  166. #define DSIM_PHYCTRL_B_DPHYCTL_SLEW_UP (1 << 14)
  167. /* DSIM_PHYTIMING */
  168. #define DSIM_PHYTIMING_LPX(x) ((x) << 8)
  169. #define DSIM_PHYTIMING_HS_EXIT(x) ((x) << 0)
  170. /* DSIM_PHYTIMING1 */
  171. #define DSIM_PHYTIMING1_CLK_PREPARE(x) ((x) << 24)
  172. #define DSIM_PHYTIMING1_CLK_ZERO(x) ((x) << 16)
  173. #define DSIM_PHYTIMING1_CLK_POST(x) ((x) << 8)
  174. #define DSIM_PHYTIMING1_CLK_TRAIL(x) ((x) << 0)
  175. /* DSIM_PHYTIMING2 */
  176. #define DSIM_PHYTIMING2_HS_PREPARE(x) ((x) << 16)
  177. #define DSIM_PHYTIMING2_HS_ZERO(x) ((x) << 8)
  178. #define DSIM_PHYTIMING2_HS_TRAIL(x) ((x) << 0)
  179. #define DSI_MAX_BUS_WIDTH 4
  180. #define DSI_NUM_VIRTUAL_CHANNELS 4
  181. #define DSI_TX_FIFO_SIZE 2048
  182. #define DSI_RX_FIFO_SIZE 256
  183. #define DSI_XFER_TIMEOUT_MS 100
  184. #define DSI_RX_FIFO_EMPTY 0x30800002
  185. #define OLD_SCLK_MIPI_CLK_NAME "pll_clk"
  186. static char *clk_names[5] = { "bus_clk", "sclk_mipi",
  187. "phyclk_mipidphy0_bitclkdiv8", "phyclk_mipidphy0_rxclkesc0",
  188. "sclk_rgb_vclk_to_dsim0" };
  189. enum exynos_dsi_transfer_type {
  190. EXYNOS_DSI_TX,
  191. EXYNOS_DSI_RX,
  192. };
  193. struct exynos_dsi_transfer {
  194. struct list_head list;
  195. struct completion completed;
  196. int result;
  197. struct mipi_dsi_packet packet;
  198. u16 flags;
  199. u16 tx_done;
  200. u8 *rx_payload;
  201. u16 rx_len;
  202. u16 rx_done;
  203. };
  204. #define DSIM_STATE_ENABLED BIT(0)
  205. #define DSIM_STATE_INITIALIZED BIT(1)
  206. #define DSIM_STATE_CMD_LPM BIT(2)
  207. #define DSIM_STATE_VIDOUT_AVAILABLE BIT(3)
  208. struct exynos_dsi_driver_data {
  209. const unsigned int *reg_ofs;
  210. unsigned int plltmr_reg;
  211. unsigned int has_freqband:1;
  212. unsigned int has_clklane_stop:1;
  213. unsigned int num_clks;
  214. unsigned int max_freq;
  215. unsigned int wait_for_reset;
  216. unsigned int num_bits_resol;
  217. const unsigned int *reg_values;
  218. };
  219. struct exynos_dsi {
  220. struct drm_encoder encoder;
  221. struct mipi_dsi_host dsi_host;
  222. struct drm_connector connector;
  223. struct device_node *panel_node;
  224. struct drm_panel *panel;
  225. struct device *dev;
  226. void __iomem *reg_base;
  227. struct phy *phy;
  228. struct clk **clks;
  229. struct regulator_bulk_data supplies[2];
  230. int irq;
  231. int te_gpio;
  232. u32 pll_clk_rate;
  233. u32 burst_clk_rate;
  234. u32 esc_clk_rate;
  235. u32 lanes;
  236. u32 mode_flags;
  237. u32 format;
  238. struct videomode vm;
  239. int state;
  240. struct drm_property *brightness;
  241. struct completion completed;
  242. spinlock_t transfer_lock; /* protects transfer_list */
  243. struct list_head transfer_list;
  244. const struct exynos_dsi_driver_data *driver_data;
  245. struct device_node *bridge_node;
  246. };
  247. #define host_to_dsi(host) container_of(host, struct exynos_dsi, dsi_host)
  248. #define connector_to_dsi(c) container_of(c, struct exynos_dsi, connector)
  249. static inline struct exynos_dsi *encoder_to_dsi(struct drm_encoder *e)
  250. {
  251. return container_of(e, struct exynos_dsi, encoder);
  252. }
  253. enum reg_idx {
  254. DSIM_STATUS_REG, /* Status register */
  255. DSIM_SWRST_REG, /* Software reset register */
  256. DSIM_CLKCTRL_REG, /* Clock control register */
  257. DSIM_TIMEOUT_REG, /* Time out register */
  258. DSIM_CONFIG_REG, /* Configuration register */
  259. DSIM_ESCMODE_REG, /* Escape mode register */
  260. DSIM_MDRESOL_REG,
  261. DSIM_MVPORCH_REG, /* Main display Vporch register */
  262. DSIM_MHPORCH_REG, /* Main display Hporch register */
  263. DSIM_MSYNC_REG, /* Main display sync area register */
  264. DSIM_INTSRC_REG, /* Interrupt source register */
  265. DSIM_INTMSK_REG, /* Interrupt mask register */
  266. DSIM_PKTHDR_REG, /* Packet Header FIFO register */
  267. DSIM_PAYLOAD_REG, /* Payload FIFO register */
  268. DSIM_RXFIFO_REG, /* Read FIFO register */
  269. DSIM_FIFOCTRL_REG, /* FIFO status and control register */
  270. DSIM_PLLCTRL_REG, /* PLL control register */
  271. DSIM_PHYCTRL_REG,
  272. DSIM_PHYTIMING_REG,
  273. DSIM_PHYTIMING1_REG,
  274. DSIM_PHYTIMING2_REG,
  275. NUM_REGS
  276. };
  277. static inline void exynos_dsi_write(struct exynos_dsi *dsi, enum reg_idx idx,
  278. u32 val)
  279. {
  280. writel(val, dsi->reg_base + dsi->driver_data->reg_ofs[idx]);
  281. }
  282. static inline u32 exynos_dsi_read(struct exynos_dsi *dsi, enum reg_idx idx)
  283. {
  284. return readl(dsi->reg_base + dsi->driver_data->reg_ofs[idx]);
  285. }
  286. static const unsigned int exynos_reg_ofs[] = {
  287. [DSIM_STATUS_REG] = 0x00,
  288. [DSIM_SWRST_REG] = 0x04,
  289. [DSIM_CLKCTRL_REG] = 0x08,
  290. [DSIM_TIMEOUT_REG] = 0x0c,
  291. [DSIM_CONFIG_REG] = 0x10,
  292. [DSIM_ESCMODE_REG] = 0x14,
  293. [DSIM_MDRESOL_REG] = 0x18,
  294. [DSIM_MVPORCH_REG] = 0x1c,
  295. [DSIM_MHPORCH_REG] = 0x20,
  296. [DSIM_MSYNC_REG] = 0x24,
  297. [DSIM_INTSRC_REG] = 0x2c,
  298. [DSIM_INTMSK_REG] = 0x30,
  299. [DSIM_PKTHDR_REG] = 0x34,
  300. [DSIM_PAYLOAD_REG] = 0x38,
  301. [DSIM_RXFIFO_REG] = 0x3c,
  302. [DSIM_FIFOCTRL_REG] = 0x44,
  303. [DSIM_PLLCTRL_REG] = 0x4c,
  304. [DSIM_PHYCTRL_REG] = 0x5c,
  305. [DSIM_PHYTIMING_REG] = 0x64,
  306. [DSIM_PHYTIMING1_REG] = 0x68,
  307. [DSIM_PHYTIMING2_REG] = 0x6c,
  308. };
  309. static const unsigned int exynos5433_reg_ofs[] = {
  310. [DSIM_STATUS_REG] = 0x04,
  311. [DSIM_SWRST_REG] = 0x0C,
  312. [DSIM_CLKCTRL_REG] = 0x10,
  313. [DSIM_TIMEOUT_REG] = 0x14,
  314. [DSIM_CONFIG_REG] = 0x18,
  315. [DSIM_ESCMODE_REG] = 0x1C,
  316. [DSIM_MDRESOL_REG] = 0x20,
  317. [DSIM_MVPORCH_REG] = 0x24,
  318. [DSIM_MHPORCH_REG] = 0x28,
  319. [DSIM_MSYNC_REG] = 0x2C,
  320. [DSIM_INTSRC_REG] = 0x34,
  321. [DSIM_INTMSK_REG] = 0x38,
  322. [DSIM_PKTHDR_REG] = 0x3C,
  323. [DSIM_PAYLOAD_REG] = 0x40,
  324. [DSIM_RXFIFO_REG] = 0x44,
  325. [DSIM_FIFOCTRL_REG] = 0x4C,
  326. [DSIM_PLLCTRL_REG] = 0x94,
  327. [DSIM_PHYCTRL_REG] = 0xA4,
  328. [DSIM_PHYTIMING_REG] = 0xB4,
  329. [DSIM_PHYTIMING1_REG] = 0xB8,
  330. [DSIM_PHYTIMING2_REG] = 0xBC,
  331. };
  332. enum reg_value_idx {
  333. RESET_TYPE,
  334. PLL_TIMER,
  335. STOP_STATE_CNT,
  336. PHYCTRL_ULPS_EXIT,
  337. PHYCTRL_VREG_LP,
  338. PHYCTRL_SLEW_UP,
  339. PHYTIMING_LPX,
  340. PHYTIMING_HS_EXIT,
  341. PHYTIMING_CLK_PREPARE,
  342. PHYTIMING_CLK_ZERO,
  343. PHYTIMING_CLK_POST,
  344. PHYTIMING_CLK_TRAIL,
  345. PHYTIMING_HS_PREPARE,
  346. PHYTIMING_HS_ZERO,
  347. PHYTIMING_HS_TRAIL
  348. };
  349. static const unsigned int reg_values[] = {
  350. [RESET_TYPE] = DSIM_SWRST,
  351. [PLL_TIMER] = 500,
  352. [STOP_STATE_CNT] = 0xf,
  353. [PHYCTRL_ULPS_EXIT] = DSIM_PHYCTRL_ULPS_EXIT(0x0af),
  354. [PHYCTRL_VREG_LP] = 0,
  355. [PHYCTRL_SLEW_UP] = 0,
  356. [PHYTIMING_LPX] = DSIM_PHYTIMING_LPX(0x06),
  357. [PHYTIMING_HS_EXIT] = DSIM_PHYTIMING_HS_EXIT(0x0b),
  358. [PHYTIMING_CLK_PREPARE] = DSIM_PHYTIMING1_CLK_PREPARE(0x07),
  359. [PHYTIMING_CLK_ZERO] = DSIM_PHYTIMING1_CLK_ZERO(0x27),
  360. [PHYTIMING_CLK_POST] = DSIM_PHYTIMING1_CLK_POST(0x0d),
  361. [PHYTIMING_CLK_TRAIL] = DSIM_PHYTIMING1_CLK_TRAIL(0x08),
  362. [PHYTIMING_HS_PREPARE] = DSIM_PHYTIMING2_HS_PREPARE(0x09),
  363. [PHYTIMING_HS_ZERO] = DSIM_PHYTIMING2_HS_ZERO(0x0d),
  364. [PHYTIMING_HS_TRAIL] = DSIM_PHYTIMING2_HS_TRAIL(0x0b),
  365. };
  366. static const unsigned int exynos5422_reg_values[] = {
  367. [RESET_TYPE] = DSIM_SWRST,
  368. [PLL_TIMER] = 500,
  369. [STOP_STATE_CNT] = 0xf,
  370. [PHYCTRL_ULPS_EXIT] = DSIM_PHYCTRL_ULPS_EXIT(0xaf),
  371. [PHYCTRL_VREG_LP] = 0,
  372. [PHYCTRL_SLEW_UP] = 0,
  373. [PHYTIMING_LPX] = DSIM_PHYTIMING_LPX(0x08),
  374. [PHYTIMING_HS_EXIT] = DSIM_PHYTIMING_HS_EXIT(0x0d),
  375. [PHYTIMING_CLK_PREPARE] = DSIM_PHYTIMING1_CLK_PREPARE(0x09),
  376. [PHYTIMING_CLK_ZERO] = DSIM_PHYTIMING1_CLK_ZERO(0x30),
  377. [PHYTIMING_CLK_POST] = DSIM_PHYTIMING1_CLK_POST(0x0e),
  378. [PHYTIMING_CLK_TRAIL] = DSIM_PHYTIMING1_CLK_TRAIL(0x0a),
  379. [PHYTIMING_HS_PREPARE] = DSIM_PHYTIMING2_HS_PREPARE(0x0c),
  380. [PHYTIMING_HS_ZERO] = DSIM_PHYTIMING2_HS_ZERO(0x11),
  381. [PHYTIMING_HS_TRAIL] = DSIM_PHYTIMING2_HS_TRAIL(0x0d),
  382. };
  383. static const unsigned int exynos5433_reg_values[] = {
  384. [RESET_TYPE] = DSIM_FUNCRST,
  385. [PLL_TIMER] = 22200,
  386. [STOP_STATE_CNT] = 0xa,
  387. [PHYCTRL_ULPS_EXIT] = DSIM_PHYCTRL_ULPS_EXIT(0x190),
  388. [PHYCTRL_VREG_LP] = DSIM_PHYCTRL_B_DPHYCTL_VREG_LP,
  389. [PHYCTRL_SLEW_UP] = DSIM_PHYCTRL_B_DPHYCTL_SLEW_UP,
  390. [PHYTIMING_LPX] = DSIM_PHYTIMING_LPX(0x07),
  391. [PHYTIMING_HS_EXIT] = DSIM_PHYTIMING_HS_EXIT(0x0c),
  392. [PHYTIMING_CLK_PREPARE] = DSIM_PHYTIMING1_CLK_PREPARE(0x09),
  393. [PHYTIMING_CLK_ZERO] = DSIM_PHYTIMING1_CLK_ZERO(0x2d),
  394. [PHYTIMING_CLK_POST] = DSIM_PHYTIMING1_CLK_POST(0x0e),
  395. [PHYTIMING_CLK_TRAIL] = DSIM_PHYTIMING1_CLK_TRAIL(0x09),
  396. [PHYTIMING_HS_PREPARE] = DSIM_PHYTIMING2_HS_PREPARE(0x0b),
  397. [PHYTIMING_HS_ZERO] = DSIM_PHYTIMING2_HS_ZERO(0x10),
  398. [PHYTIMING_HS_TRAIL] = DSIM_PHYTIMING2_HS_TRAIL(0x0c),
  399. };
  400. static const struct exynos_dsi_driver_data exynos3_dsi_driver_data = {
  401. .reg_ofs = exynos_reg_ofs,
  402. .plltmr_reg = 0x50,
  403. .has_freqband = 1,
  404. .has_clklane_stop = 1,
  405. .num_clks = 2,
  406. .max_freq = 1000,
  407. .wait_for_reset = 1,
  408. .num_bits_resol = 11,
  409. .reg_values = reg_values,
  410. };
  411. static const struct exynos_dsi_driver_data exynos4_dsi_driver_data = {
  412. .reg_ofs = exynos_reg_ofs,
  413. .plltmr_reg = 0x50,
  414. .has_freqband = 1,
  415. .has_clklane_stop = 1,
  416. .num_clks = 2,
  417. .max_freq = 1000,
  418. .wait_for_reset = 1,
  419. .num_bits_resol = 11,
  420. .reg_values = reg_values,
  421. };
  422. static const struct exynos_dsi_driver_data exynos5_dsi_driver_data = {
  423. .reg_ofs = exynos_reg_ofs,
  424. .plltmr_reg = 0x58,
  425. .num_clks = 2,
  426. .max_freq = 1000,
  427. .wait_for_reset = 1,
  428. .num_bits_resol = 11,
  429. .reg_values = reg_values,
  430. };
  431. static const struct exynos_dsi_driver_data exynos5433_dsi_driver_data = {
  432. .reg_ofs = exynos5433_reg_ofs,
  433. .plltmr_reg = 0xa0,
  434. .has_clklane_stop = 1,
  435. .num_clks = 5,
  436. .max_freq = 1500,
  437. .wait_for_reset = 0,
  438. .num_bits_resol = 12,
  439. .reg_values = exynos5433_reg_values,
  440. };
  441. static const struct exynos_dsi_driver_data exynos5422_dsi_driver_data = {
  442. .reg_ofs = exynos5433_reg_ofs,
  443. .plltmr_reg = 0xa0,
  444. .has_clklane_stop = 1,
  445. .num_clks = 2,
  446. .max_freq = 1500,
  447. .wait_for_reset = 1,
  448. .num_bits_resol = 12,
  449. .reg_values = exynos5422_reg_values,
  450. };
  451. static const struct of_device_id exynos_dsi_of_match[] = {
  452. { .compatible = "samsung,exynos3250-mipi-dsi",
  453. .data = &exynos3_dsi_driver_data },
  454. { .compatible = "samsung,exynos4210-mipi-dsi",
  455. .data = &exynos4_dsi_driver_data },
  456. { .compatible = "samsung,exynos5410-mipi-dsi",
  457. .data = &exynos5_dsi_driver_data },
  458. { .compatible = "samsung,exynos5422-mipi-dsi",
  459. .data = &exynos5422_dsi_driver_data },
  460. { .compatible = "samsung,exynos5433-mipi-dsi",
  461. .data = &exynos5433_dsi_driver_data },
  462. { }
  463. };
  464. static void exynos_dsi_wait_for_reset(struct exynos_dsi *dsi)
  465. {
  466. if (wait_for_completion_timeout(&dsi->completed, msecs_to_jiffies(300)))
  467. return;
  468. dev_err(dsi->dev, "timeout waiting for reset\n");
  469. }
  470. static void exynos_dsi_reset(struct exynos_dsi *dsi)
  471. {
  472. u32 reset_val = dsi->driver_data->reg_values[RESET_TYPE];
  473. reinit_completion(&dsi->completed);
  474. exynos_dsi_write(dsi, DSIM_SWRST_REG, reset_val);
  475. }
  476. #ifndef MHZ
  477. #define MHZ (1000*1000)
  478. #endif
  479. static unsigned long exynos_dsi_pll_find_pms(struct exynos_dsi *dsi,
  480. unsigned long fin, unsigned long fout, u8 *p, u16 *m, u8 *s)
  481. {
  482. const struct exynos_dsi_driver_data *driver_data = dsi->driver_data;
  483. unsigned long best_freq = 0;
  484. u32 min_delta = 0xffffffff;
  485. u8 p_min, p_max;
  486. u8 _p, uninitialized_var(best_p);
  487. u16 _m, uninitialized_var(best_m);
  488. u8 _s, uninitialized_var(best_s);
  489. p_min = DIV_ROUND_UP(fin, (12 * MHZ));
  490. p_max = fin / (6 * MHZ);
  491. for (_p = p_min; _p <= p_max; ++_p) {
  492. for (_s = 0; _s <= 5; ++_s) {
  493. u64 tmp;
  494. u32 delta;
  495. tmp = (u64)fout * (_p << _s);
  496. do_div(tmp, fin);
  497. _m = tmp;
  498. if (_m < 41 || _m > 125)
  499. continue;
  500. tmp = (u64)_m * fin;
  501. do_div(tmp, _p);
  502. if (tmp < 500 * MHZ ||
  503. tmp > driver_data->max_freq * MHZ)
  504. continue;
  505. tmp = (u64)_m * fin;
  506. do_div(tmp, _p << _s);
  507. delta = abs(fout - tmp);
  508. if (delta < min_delta) {
  509. best_p = _p;
  510. best_m = _m;
  511. best_s = _s;
  512. min_delta = delta;
  513. best_freq = tmp;
  514. }
  515. }
  516. }
  517. if (best_freq) {
  518. *p = best_p;
  519. *m = best_m;
  520. *s = best_s;
  521. }
  522. return best_freq;
  523. }
  524. static unsigned long exynos_dsi_set_pll(struct exynos_dsi *dsi,
  525. unsigned long freq)
  526. {
  527. const struct exynos_dsi_driver_data *driver_data = dsi->driver_data;
  528. unsigned long fin, fout;
  529. int timeout;
  530. u8 p, s;
  531. u16 m;
  532. u32 reg;
  533. fin = dsi->pll_clk_rate;
  534. fout = exynos_dsi_pll_find_pms(dsi, fin, freq, &p, &m, &s);
  535. if (!fout) {
  536. dev_err(dsi->dev,
  537. "failed to find PLL PMS for requested frequency\n");
  538. return 0;
  539. }
  540. dev_dbg(dsi->dev, "PLL freq %lu, (p %d, m %d, s %d)\n", fout, p, m, s);
  541. writel(driver_data->reg_values[PLL_TIMER],
  542. dsi->reg_base + driver_data->plltmr_reg);
  543. reg = DSIM_PLL_EN | DSIM_PLL_P(p) | DSIM_PLL_M(m) | DSIM_PLL_S(s);
  544. if (driver_data->has_freqband) {
  545. static const unsigned long freq_bands[] = {
  546. 100 * MHZ, 120 * MHZ, 160 * MHZ, 200 * MHZ,
  547. 270 * MHZ, 320 * MHZ, 390 * MHZ, 450 * MHZ,
  548. 510 * MHZ, 560 * MHZ, 640 * MHZ, 690 * MHZ,
  549. 770 * MHZ, 870 * MHZ, 950 * MHZ,
  550. };
  551. int band;
  552. for (band = 0; band < ARRAY_SIZE(freq_bands); ++band)
  553. if (fout < freq_bands[band])
  554. break;
  555. dev_dbg(dsi->dev, "band %d\n", band);
  556. reg |= DSIM_FREQ_BAND(band);
  557. }
  558. exynos_dsi_write(dsi, DSIM_PLLCTRL_REG, reg);
  559. timeout = 1000;
  560. do {
  561. if (timeout-- == 0) {
  562. dev_err(dsi->dev, "PLL failed to stabilize\n");
  563. return 0;
  564. }
  565. reg = exynos_dsi_read(dsi, DSIM_STATUS_REG);
  566. } while ((reg & DSIM_PLL_STABLE) == 0);
  567. return fout;
  568. }
  569. static int exynos_dsi_enable_clock(struct exynos_dsi *dsi)
  570. {
  571. unsigned long hs_clk, byte_clk, esc_clk;
  572. unsigned long esc_div;
  573. u32 reg;
  574. hs_clk = exynos_dsi_set_pll(dsi, dsi->burst_clk_rate);
  575. if (!hs_clk) {
  576. dev_err(dsi->dev, "failed to configure DSI PLL\n");
  577. return -EFAULT;
  578. }
  579. byte_clk = hs_clk / 8;
  580. esc_div = DIV_ROUND_UP(byte_clk, dsi->esc_clk_rate);
  581. esc_clk = byte_clk / esc_div;
  582. if (esc_clk > 20 * MHZ) {
  583. ++esc_div;
  584. esc_clk = byte_clk / esc_div;
  585. }
  586. dev_dbg(dsi->dev, "hs_clk = %lu, byte_clk = %lu, esc_clk = %lu\n",
  587. hs_clk, byte_clk, esc_clk);
  588. reg = exynos_dsi_read(dsi, DSIM_CLKCTRL_REG);
  589. reg &= ~(DSIM_ESC_PRESCALER_MASK | DSIM_LANE_ESC_CLK_EN_CLK
  590. | DSIM_LANE_ESC_CLK_EN_DATA_MASK | DSIM_PLL_BYPASS
  591. | DSIM_BYTE_CLK_SRC_MASK);
  592. reg |= DSIM_ESC_CLKEN | DSIM_BYTE_CLKEN
  593. | DSIM_ESC_PRESCALER(esc_div)
  594. | DSIM_LANE_ESC_CLK_EN_CLK
  595. | DSIM_LANE_ESC_CLK_EN_DATA(BIT(dsi->lanes) - 1)
  596. | DSIM_BYTE_CLK_SRC(0)
  597. | DSIM_TX_REQUEST_HSCLK;
  598. exynos_dsi_write(dsi, DSIM_CLKCTRL_REG, reg);
  599. return 0;
  600. }
  601. static void exynos_dsi_set_phy_ctrl(struct exynos_dsi *dsi)
  602. {
  603. const struct exynos_dsi_driver_data *driver_data = dsi->driver_data;
  604. const unsigned int *reg_values = driver_data->reg_values;
  605. u32 reg;
  606. if (driver_data->has_freqband)
  607. return;
  608. /* B D-PHY: D-PHY Master & Slave Analog Block control */
  609. reg = reg_values[PHYCTRL_ULPS_EXIT] | reg_values[PHYCTRL_VREG_LP] |
  610. reg_values[PHYCTRL_SLEW_UP];
  611. exynos_dsi_write(dsi, DSIM_PHYCTRL_REG, reg);
  612. /*
  613. * T LPX: Transmitted length of any Low-Power state period
  614. * T HS-EXIT: Time that the transmitter drives LP-11 following a HS
  615. * burst
  616. */
  617. reg = reg_values[PHYTIMING_LPX] | reg_values[PHYTIMING_HS_EXIT];
  618. exynos_dsi_write(dsi, DSIM_PHYTIMING_REG, reg);
  619. /*
  620. * T CLK-PREPARE: Time that the transmitter drives the Clock Lane LP-00
  621. * Line state immediately before the HS-0 Line state starting the
  622. * HS transmission
  623. * T CLK-ZERO: Time that the transmitter drives the HS-0 state prior to
  624. * transmitting the Clock.
  625. * T CLK_POST: Time that the transmitter continues to send HS clock
  626. * after the last associated Data Lane has transitioned to LP Mode
  627. * Interval is defined as the period from the end of T HS-TRAIL to
  628. * the beginning of T CLK-TRAIL
  629. * T CLK-TRAIL: Time that the transmitter drives the HS-0 state after
  630. * the last payload clock bit of a HS transmission burst
  631. */
  632. reg = reg_values[PHYTIMING_CLK_PREPARE] |
  633. reg_values[PHYTIMING_CLK_ZERO] |
  634. reg_values[PHYTIMING_CLK_POST] |
  635. reg_values[PHYTIMING_CLK_TRAIL];
  636. exynos_dsi_write(dsi, DSIM_PHYTIMING1_REG, reg);
  637. /*
  638. * T HS-PREPARE: Time that the transmitter drives the Data Lane LP-00
  639. * Line state immediately before the HS-0 Line state starting the
  640. * HS transmission
  641. * T HS-ZERO: Time that the transmitter drives the HS-0 state prior to
  642. * transmitting the Sync sequence.
  643. * T HS-TRAIL: Time that the transmitter drives the flipped differential
  644. * state after last payload data bit of a HS transmission burst
  645. */
  646. reg = reg_values[PHYTIMING_HS_PREPARE] | reg_values[PHYTIMING_HS_ZERO] |
  647. reg_values[PHYTIMING_HS_TRAIL];
  648. exynos_dsi_write(dsi, DSIM_PHYTIMING2_REG, reg);
  649. }
  650. static void exynos_dsi_disable_clock(struct exynos_dsi *dsi)
  651. {
  652. u32 reg;
  653. reg = exynos_dsi_read(dsi, DSIM_CLKCTRL_REG);
  654. reg &= ~(DSIM_LANE_ESC_CLK_EN_CLK | DSIM_LANE_ESC_CLK_EN_DATA_MASK
  655. | DSIM_ESC_CLKEN | DSIM_BYTE_CLKEN);
  656. exynos_dsi_write(dsi, DSIM_CLKCTRL_REG, reg);
  657. reg = exynos_dsi_read(dsi, DSIM_PLLCTRL_REG);
  658. reg &= ~DSIM_PLL_EN;
  659. exynos_dsi_write(dsi, DSIM_PLLCTRL_REG, reg);
  660. }
  661. static void exynos_dsi_enable_lane(struct exynos_dsi *dsi, u32 lane)
  662. {
  663. u32 reg = exynos_dsi_read(dsi, DSIM_CONFIG_REG);
  664. reg |= (DSIM_NUM_OF_DATA_LANE(dsi->lanes - 1) | DSIM_LANE_EN_CLK |
  665. DSIM_LANE_EN(lane));
  666. exynos_dsi_write(dsi, DSIM_CONFIG_REG, reg);
  667. }
  668. static int exynos_dsi_init_link(struct exynos_dsi *dsi)
  669. {
  670. const struct exynos_dsi_driver_data *driver_data = dsi->driver_data;
  671. int timeout;
  672. u32 reg;
  673. u32 lanes_mask;
  674. /* Initialize FIFO pointers */
  675. reg = exynos_dsi_read(dsi, DSIM_FIFOCTRL_REG);
  676. reg &= ~0x1f;
  677. exynos_dsi_write(dsi, DSIM_FIFOCTRL_REG, reg);
  678. usleep_range(9000, 11000);
  679. reg |= 0x1f;
  680. exynos_dsi_write(dsi, DSIM_FIFOCTRL_REG, reg);
  681. usleep_range(9000, 11000);
  682. /* DSI configuration */
  683. reg = 0;
  684. /*
  685. * The first bit of mode_flags specifies display configuration.
  686. * If this bit is set[= MIPI_DSI_MODE_VIDEO], dsi will support video
  687. * mode, otherwise it will support command mode.
  688. */
  689. if (dsi->mode_flags & MIPI_DSI_MODE_VIDEO) {
  690. reg |= DSIM_VIDEO_MODE;
  691. /*
  692. * The user manual describes that following bits are ignored in
  693. * command mode.
  694. */
  695. if (!(dsi->mode_flags & MIPI_DSI_MODE_VSYNC_FLUSH))
  696. reg |= DSIM_MFLUSH_VS;
  697. if (dsi->mode_flags & MIPI_DSI_MODE_VIDEO_SYNC_PULSE)
  698. reg |= DSIM_SYNC_INFORM;
  699. if (dsi->mode_flags & MIPI_DSI_MODE_VIDEO_BURST)
  700. reg |= DSIM_BURST_MODE;
  701. if (dsi->mode_flags & MIPI_DSI_MODE_VIDEO_AUTO_VERT)
  702. reg |= DSIM_AUTO_MODE;
  703. if (dsi->mode_flags & MIPI_DSI_MODE_VIDEO_HSE)
  704. reg |= DSIM_HSE_MODE;
  705. if (!(dsi->mode_flags & MIPI_DSI_MODE_VIDEO_HFP))
  706. reg |= DSIM_HFP_MODE;
  707. if (!(dsi->mode_flags & MIPI_DSI_MODE_VIDEO_HBP))
  708. reg |= DSIM_HBP_MODE;
  709. if (!(dsi->mode_flags & MIPI_DSI_MODE_VIDEO_HSA))
  710. reg |= DSIM_HSA_MODE;
  711. }
  712. if (!(dsi->mode_flags & MIPI_DSI_MODE_EOT_PACKET))
  713. reg |= DSIM_EOT_DISABLE;
  714. switch (dsi->format) {
  715. case MIPI_DSI_FMT_RGB888:
  716. reg |= DSIM_MAIN_PIX_FORMAT_RGB888;
  717. break;
  718. case MIPI_DSI_FMT_RGB666:
  719. reg |= DSIM_MAIN_PIX_FORMAT_RGB666;
  720. break;
  721. case MIPI_DSI_FMT_RGB666_PACKED:
  722. reg |= DSIM_MAIN_PIX_FORMAT_RGB666_P;
  723. break;
  724. case MIPI_DSI_FMT_RGB565:
  725. reg |= DSIM_MAIN_PIX_FORMAT_RGB565;
  726. break;
  727. default:
  728. dev_err(dsi->dev, "invalid pixel format\n");
  729. return -EINVAL;
  730. }
  731. /*
  732. * Use non-continuous clock mode if the periparal wants and
  733. * host controller supports
  734. *
  735. * In non-continous clock mode, host controller will turn off
  736. * the HS clock between high-speed transmissions to reduce
  737. * power consumption.
  738. */
  739. if (driver_data->has_clklane_stop &&
  740. dsi->mode_flags & MIPI_DSI_CLOCK_NON_CONTINUOUS) {
  741. reg |= DSIM_CLKLANE_STOP;
  742. }
  743. exynos_dsi_write(dsi, DSIM_CONFIG_REG, reg);
  744. lanes_mask = BIT(dsi->lanes) - 1;
  745. exynos_dsi_enable_lane(dsi, lanes_mask);
  746. /* Check clock and data lane state are stop state */
  747. timeout = 100;
  748. do {
  749. if (timeout-- == 0) {
  750. dev_err(dsi->dev, "waiting for bus lanes timed out\n");
  751. return -EFAULT;
  752. }
  753. reg = exynos_dsi_read(dsi, DSIM_STATUS_REG);
  754. if ((reg & DSIM_STOP_STATE_DAT(lanes_mask))
  755. != DSIM_STOP_STATE_DAT(lanes_mask))
  756. continue;
  757. } while (!(reg & (DSIM_STOP_STATE_CLK | DSIM_TX_READY_HS_CLK)));
  758. reg = exynos_dsi_read(dsi, DSIM_ESCMODE_REG);
  759. reg &= ~DSIM_STOP_STATE_CNT_MASK;
  760. reg |= DSIM_STOP_STATE_CNT(driver_data->reg_values[STOP_STATE_CNT]);
  761. exynos_dsi_write(dsi, DSIM_ESCMODE_REG, reg);
  762. reg = DSIM_BTA_TIMEOUT(0xff) | DSIM_LPDR_TIMEOUT(0xffff);
  763. exynos_dsi_write(dsi, DSIM_TIMEOUT_REG, reg);
  764. return 0;
  765. }
  766. static void exynos_dsi_set_display_mode(struct exynos_dsi *dsi)
  767. {
  768. struct videomode *vm = &dsi->vm;
  769. unsigned int num_bits_resol = dsi->driver_data->num_bits_resol;
  770. u32 reg;
  771. if (dsi->mode_flags & MIPI_DSI_MODE_VIDEO) {
  772. reg = DSIM_CMD_ALLOW(0xf)
  773. | DSIM_STABLE_VFP(vm->vfront_porch)
  774. | DSIM_MAIN_VBP(vm->vback_porch);
  775. exynos_dsi_write(dsi, DSIM_MVPORCH_REG, reg);
  776. reg = DSIM_MAIN_HFP(vm->hfront_porch)
  777. | DSIM_MAIN_HBP(vm->hback_porch);
  778. exynos_dsi_write(dsi, DSIM_MHPORCH_REG, reg);
  779. reg = DSIM_MAIN_VSA(vm->vsync_len)
  780. | DSIM_MAIN_HSA(vm->hsync_len);
  781. exynos_dsi_write(dsi, DSIM_MSYNC_REG, reg);
  782. }
  783. reg = DSIM_MAIN_HRESOL(vm->hactive, num_bits_resol) |
  784. DSIM_MAIN_VRESOL(vm->vactive, num_bits_resol);
  785. exynos_dsi_write(dsi, DSIM_MDRESOL_REG, reg);
  786. dev_dbg(dsi->dev, "LCD size = %dx%d\n", vm->hactive, vm->vactive);
  787. }
  788. static void exynos_dsi_set_display_enable(struct exynos_dsi *dsi, bool enable)
  789. {
  790. u32 reg;
  791. reg = exynos_dsi_read(dsi, DSIM_MDRESOL_REG);
  792. if (enable)
  793. reg |= DSIM_MAIN_STAND_BY;
  794. else
  795. reg &= ~DSIM_MAIN_STAND_BY;
  796. exynos_dsi_write(dsi, DSIM_MDRESOL_REG, reg);
  797. }
  798. static int exynos_dsi_wait_for_hdr_fifo(struct exynos_dsi *dsi)
  799. {
  800. int timeout = 2000;
  801. do {
  802. u32 reg = exynos_dsi_read(dsi, DSIM_FIFOCTRL_REG);
  803. if (!(reg & DSIM_SFR_HEADER_FULL))
  804. return 0;
  805. if (!cond_resched())
  806. usleep_range(950, 1050);
  807. } while (--timeout);
  808. return -ETIMEDOUT;
  809. }
  810. static void exynos_dsi_set_cmd_lpm(struct exynos_dsi *dsi, bool lpm)
  811. {
  812. u32 v = exynos_dsi_read(dsi, DSIM_ESCMODE_REG);
  813. if (lpm)
  814. v |= DSIM_CMD_LPDT_LP;
  815. else
  816. v &= ~DSIM_CMD_LPDT_LP;
  817. exynos_dsi_write(dsi, DSIM_ESCMODE_REG, v);
  818. }
  819. static void exynos_dsi_force_bta(struct exynos_dsi *dsi)
  820. {
  821. u32 v = exynos_dsi_read(dsi, DSIM_ESCMODE_REG);
  822. v |= DSIM_FORCE_BTA;
  823. exynos_dsi_write(dsi, DSIM_ESCMODE_REG, v);
  824. }
  825. static void exynos_dsi_send_to_fifo(struct exynos_dsi *dsi,
  826. struct exynos_dsi_transfer *xfer)
  827. {
  828. struct device *dev = dsi->dev;
  829. struct mipi_dsi_packet *pkt = &xfer->packet;
  830. const u8 *payload = pkt->payload + xfer->tx_done;
  831. u16 length = pkt->payload_length - xfer->tx_done;
  832. bool first = !xfer->tx_done;
  833. u32 reg;
  834. dev_dbg(dev, "< xfer %pK: tx len %u, done %u, rx len %u, done %u\n",
  835. xfer, length, xfer->tx_done, xfer->rx_len, xfer->rx_done);
  836. if (length > DSI_TX_FIFO_SIZE)
  837. length = DSI_TX_FIFO_SIZE;
  838. xfer->tx_done += length;
  839. /* Send payload */
  840. while (length >= 4) {
  841. reg = get_unaligned_le32(payload);
  842. exynos_dsi_write(dsi, DSIM_PAYLOAD_REG, reg);
  843. payload += 4;
  844. length -= 4;
  845. }
  846. reg = 0;
  847. switch (length) {
  848. case 3:
  849. reg |= payload[2] << 16;
  850. /* Fall through */
  851. case 2:
  852. reg |= payload[1] << 8;
  853. /* Fall through */
  854. case 1:
  855. reg |= payload[0];
  856. exynos_dsi_write(dsi, DSIM_PAYLOAD_REG, reg);
  857. break;
  858. }
  859. /* Send packet header */
  860. if (!first)
  861. return;
  862. reg = get_unaligned_le32(pkt->header);
  863. if (exynos_dsi_wait_for_hdr_fifo(dsi)) {
  864. dev_err(dev, "waiting for header FIFO timed out\n");
  865. return;
  866. }
  867. if (NEQV(xfer->flags & MIPI_DSI_MSG_USE_LPM,
  868. dsi->state & DSIM_STATE_CMD_LPM)) {
  869. exynos_dsi_set_cmd_lpm(dsi, xfer->flags & MIPI_DSI_MSG_USE_LPM);
  870. dsi->state ^= DSIM_STATE_CMD_LPM;
  871. }
  872. exynos_dsi_write(dsi, DSIM_PKTHDR_REG, reg);
  873. if (xfer->flags & MIPI_DSI_MSG_REQ_ACK)
  874. exynos_dsi_force_bta(dsi);
  875. }
  876. static void exynos_dsi_read_from_fifo(struct exynos_dsi *dsi,
  877. struct exynos_dsi_transfer *xfer)
  878. {
  879. u8 *payload = xfer->rx_payload + xfer->rx_done;
  880. bool first = !xfer->rx_done;
  881. struct device *dev = dsi->dev;
  882. u16 length;
  883. u32 reg;
  884. if (first) {
  885. reg = exynos_dsi_read(dsi, DSIM_RXFIFO_REG);
  886. switch (reg & 0x3f) {
  887. case MIPI_DSI_RX_GENERIC_SHORT_READ_RESPONSE_2BYTE:
  888. case MIPI_DSI_RX_DCS_SHORT_READ_RESPONSE_2BYTE:
  889. if (xfer->rx_len >= 2) {
  890. payload[1] = reg >> 16;
  891. ++xfer->rx_done;
  892. }
  893. /* Fall through */
  894. case MIPI_DSI_RX_GENERIC_SHORT_READ_RESPONSE_1BYTE:
  895. case MIPI_DSI_RX_DCS_SHORT_READ_RESPONSE_1BYTE:
  896. payload[0] = reg >> 8;
  897. ++xfer->rx_done;
  898. xfer->rx_len = xfer->rx_done;
  899. xfer->result = 0;
  900. goto clear_fifo;
  901. case MIPI_DSI_RX_ACKNOWLEDGE_AND_ERROR_REPORT:
  902. dev_err(dev, "DSI Error Report: 0x%04x\n",
  903. (reg >> 8) & 0xffff);
  904. xfer->result = 0;
  905. goto clear_fifo;
  906. }
  907. length = (reg >> 8) & 0xffff;
  908. if (length > xfer->rx_len) {
  909. dev_err(dev,
  910. "response too long (%u > %u bytes), stripping\n",
  911. xfer->rx_len, length);
  912. length = xfer->rx_len;
  913. } else if (length < xfer->rx_len)
  914. xfer->rx_len = length;
  915. }
  916. length = xfer->rx_len - xfer->rx_done;
  917. xfer->rx_done += length;
  918. /* Receive payload */
  919. while (length >= 4) {
  920. reg = exynos_dsi_read(dsi, DSIM_RXFIFO_REG);
  921. payload[0] = (reg >> 0) & 0xff;
  922. payload[1] = (reg >> 8) & 0xff;
  923. payload[2] = (reg >> 16) & 0xff;
  924. payload[3] = (reg >> 24) & 0xff;
  925. payload += 4;
  926. length -= 4;
  927. }
  928. if (length) {
  929. reg = exynos_dsi_read(dsi, DSIM_RXFIFO_REG);
  930. switch (length) {
  931. case 3:
  932. payload[2] = (reg >> 16) & 0xff;
  933. /* Fall through */
  934. case 2:
  935. payload[1] = (reg >> 8) & 0xff;
  936. /* Fall through */
  937. case 1:
  938. payload[0] = reg & 0xff;
  939. }
  940. }
  941. if (xfer->rx_done == xfer->rx_len)
  942. xfer->result = 0;
  943. clear_fifo:
  944. length = DSI_RX_FIFO_SIZE / 4;
  945. do {
  946. reg = exynos_dsi_read(dsi, DSIM_RXFIFO_REG);
  947. if (reg == DSI_RX_FIFO_EMPTY)
  948. break;
  949. } while (--length);
  950. }
  951. static void exynos_dsi_transfer_start(struct exynos_dsi *dsi)
  952. {
  953. unsigned long flags;
  954. struct exynos_dsi_transfer *xfer;
  955. bool start = false;
  956. again:
  957. spin_lock_irqsave(&dsi->transfer_lock, flags);
  958. if (list_empty(&dsi->transfer_list)) {
  959. spin_unlock_irqrestore(&dsi->transfer_lock, flags);
  960. return;
  961. }
  962. xfer = list_first_entry(&dsi->transfer_list,
  963. struct exynos_dsi_transfer, list);
  964. spin_unlock_irqrestore(&dsi->transfer_lock, flags);
  965. if (xfer->packet.payload_length &&
  966. xfer->tx_done == xfer->packet.payload_length)
  967. /* waiting for RX */
  968. return;
  969. exynos_dsi_send_to_fifo(dsi, xfer);
  970. if (xfer->packet.payload_length || xfer->rx_len)
  971. return;
  972. xfer->result = 0;
  973. complete(&xfer->completed);
  974. spin_lock_irqsave(&dsi->transfer_lock, flags);
  975. list_del_init(&xfer->list);
  976. start = !list_empty(&dsi->transfer_list);
  977. spin_unlock_irqrestore(&dsi->transfer_lock, flags);
  978. if (start)
  979. goto again;
  980. }
  981. static bool exynos_dsi_transfer_finish(struct exynos_dsi *dsi)
  982. {
  983. struct exynos_dsi_transfer *xfer;
  984. unsigned long flags;
  985. bool start = true;
  986. spin_lock_irqsave(&dsi->transfer_lock, flags);
  987. if (list_empty(&dsi->transfer_list)) {
  988. spin_unlock_irqrestore(&dsi->transfer_lock, flags);
  989. return false;
  990. }
  991. xfer = list_first_entry(&dsi->transfer_list,
  992. struct exynos_dsi_transfer, list);
  993. spin_unlock_irqrestore(&dsi->transfer_lock, flags);
  994. dev_dbg(dsi->dev,
  995. "> xfer %pK, tx_len %zu, tx_done %u, rx_len %u, rx_done %u\n",
  996. xfer, xfer->packet.payload_length, xfer->tx_done, xfer->rx_len,
  997. xfer->rx_done);
  998. if (xfer->tx_done != xfer->packet.payload_length)
  999. return true;
  1000. if (xfer->rx_done != xfer->rx_len)
  1001. exynos_dsi_read_from_fifo(dsi, xfer);
  1002. if (xfer->rx_done != xfer->rx_len)
  1003. return true;
  1004. spin_lock_irqsave(&dsi->transfer_lock, flags);
  1005. list_del_init(&xfer->list);
  1006. start = !list_empty(&dsi->transfer_list);
  1007. spin_unlock_irqrestore(&dsi->transfer_lock, flags);
  1008. if (!xfer->rx_len)
  1009. xfer->result = 0;
  1010. complete(&xfer->completed);
  1011. return start;
  1012. }
  1013. static void exynos_dsi_remove_transfer(struct exynos_dsi *dsi,
  1014. struct exynos_dsi_transfer *xfer)
  1015. {
  1016. unsigned long flags;
  1017. bool start;
  1018. spin_lock_irqsave(&dsi->transfer_lock, flags);
  1019. if (!list_empty(&dsi->transfer_list) &&
  1020. xfer == list_first_entry(&dsi->transfer_list,
  1021. struct exynos_dsi_transfer, list)) {
  1022. list_del_init(&xfer->list);
  1023. start = !list_empty(&dsi->transfer_list);
  1024. spin_unlock_irqrestore(&dsi->transfer_lock, flags);
  1025. if (start)
  1026. exynos_dsi_transfer_start(dsi);
  1027. return;
  1028. }
  1029. list_del_init(&xfer->list);
  1030. spin_unlock_irqrestore(&dsi->transfer_lock, flags);
  1031. }
  1032. static int exynos_dsi_transfer(struct exynos_dsi *dsi,
  1033. struct exynos_dsi_transfer *xfer)
  1034. {
  1035. unsigned long flags;
  1036. bool stopped;
  1037. xfer->tx_done = 0;
  1038. xfer->rx_done = 0;
  1039. xfer->result = -ETIMEDOUT;
  1040. init_completion(&xfer->completed);
  1041. spin_lock_irqsave(&dsi->transfer_lock, flags);
  1042. stopped = list_empty(&dsi->transfer_list);
  1043. list_add_tail(&xfer->list, &dsi->transfer_list);
  1044. spin_unlock_irqrestore(&dsi->transfer_lock, flags);
  1045. if (stopped)
  1046. exynos_dsi_transfer_start(dsi);
  1047. wait_for_completion_timeout(&xfer->completed,
  1048. msecs_to_jiffies(DSI_XFER_TIMEOUT_MS));
  1049. if (xfer->result == -ETIMEDOUT) {
  1050. struct mipi_dsi_packet *pkt = &xfer->packet;
  1051. exynos_dsi_remove_transfer(dsi, xfer);
  1052. dev_err(dsi->dev, "xfer timed out: %*ph %*ph\n", 4, pkt->header,
  1053. (int)pkt->payload_length, pkt->payload);
  1054. return -ETIMEDOUT;
  1055. }
  1056. /* Also covers hardware timeout condition */
  1057. return xfer->result;
  1058. }
  1059. static irqreturn_t exynos_dsi_irq(int irq, void *dev_id)
  1060. {
  1061. struct exynos_dsi *dsi = dev_id;
  1062. u32 status;
  1063. status = exynos_dsi_read(dsi, DSIM_INTSRC_REG);
  1064. if (!status) {
  1065. static unsigned long int j;
  1066. if (printk_timed_ratelimit(&j, 500))
  1067. dev_warn(dsi->dev, "spurious interrupt\n");
  1068. return IRQ_HANDLED;
  1069. }
  1070. exynos_dsi_write(dsi, DSIM_INTSRC_REG, status);
  1071. if (status & DSIM_INT_SW_RST_RELEASE) {
  1072. u32 mask = ~(DSIM_INT_RX_DONE | DSIM_INT_SFR_FIFO_EMPTY |
  1073. DSIM_INT_SFR_HDR_FIFO_EMPTY | DSIM_INT_FRAME_DONE |
  1074. DSIM_INT_RX_ECC_ERR | DSIM_INT_SW_RST_RELEASE);
  1075. exynos_dsi_write(dsi, DSIM_INTMSK_REG, mask);
  1076. complete(&dsi->completed);
  1077. return IRQ_HANDLED;
  1078. }
  1079. if (!(status & (DSIM_INT_RX_DONE | DSIM_INT_SFR_FIFO_EMPTY |
  1080. DSIM_INT_FRAME_DONE | DSIM_INT_PLL_STABLE)))
  1081. return IRQ_HANDLED;
  1082. if (exynos_dsi_transfer_finish(dsi))
  1083. exynos_dsi_transfer_start(dsi);
  1084. return IRQ_HANDLED;
  1085. }
  1086. static irqreturn_t exynos_dsi_te_irq_handler(int irq, void *dev_id)
  1087. {
  1088. struct exynos_dsi *dsi = (struct exynos_dsi *)dev_id;
  1089. struct drm_encoder *encoder = &dsi->encoder;
  1090. if (dsi->state & DSIM_STATE_VIDOUT_AVAILABLE)
  1091. exynos_drm_crtc_te_handler(encoder->crtc);
  1092. return IRQ_HANDLED;
  1093. }
  1094. static void exynos_dsi_enable_irq(struct exynos_dsi *dsi)
  1095. {
  1096. enable_irq(dsi->irq);
  1097. if (gpio_is_valid(dsi->te_gpio))
  1098. enable_irq(gpio_to_irq(dsi->te_gpio));
  1099. }
  1100. static void exynos_dsi_disable_irq(struct exynos_dsi *dsi)
  1101. {
  1102. if (gpio_is_valid(dsi->te_gpio))
  1103. disable_irq(gpio_to_irq(dsi->te_gpio));
  1104. disable_irq(dsi->irq);
  1105. }
  1106. static int exynos_dsi_init(struct exynos_dsi *dsi)
  1107. {
  1108. const struct exynos_dsi_driver_data *driver_data = dsi->driver_data;
  1109. exynos_dsi_reset(dsi);
  1110. exynos_dsi_enable_irq(dsi);
  1111. if (driver_data->reg_values[RESET_TYPE] == DSIM_FUNCRST)
  1112. exynos_dsi_enable_lane(dsi, BIT(dsi->lanes) - 1);
  1113. exynos_dsi_enable_clock(dsi);
  1114. if (driver_data->wait_for_reset)
  1115. exynos_dsi_wait_for_reset(dsi);
  1116. exynos_dsi_set_phy_ctrl(dsi);
  1117. exynos_dsi_init_link(dsi);
  1118. return 0;
  1119. }
  1120. static int exynos_dsi_register_te_irq(struct exynos_dsi *dsi)
  1121. {
  1122. int ret;
  1123. int te_gpio_irq;
  1124. dsi->te_gpio = of_get_named_gpio(dsi->panel_node, "te-gpios", 0);
  1125. if (dsi->te_gpio == -ENOENT)
  1126. return 0;
  1127. if (!gpio_is_valid(dsi->te_gpio)) {
  1128. ret = dsi->te_gpio;
  1129. dev_err(dsi->dev, "cannot get te-gpios, %d\n", ret);
  1130. goto out;
  1131. }
  1132. ret = gpio_request(dsi->te_gpio, "te_gpio");
  1133. if (ret) {
  1134. dev_err(dsi->dev, "gpio request failed with %d\n", ret);
  1135. goto out;
  1136. }
  1137. te_gpio_irq = gpio_to_irq(dsi->te_gpio);
  1138. irq_set_status_flags(te_gpio_irq, IRQ_NOAUTOEN);
  1139. ret = request_threaded_irq(te_gpio_irq, exynos_dsi_te_irq_handler, NULL,
  1140. IRQF_TRIGGER_RISING, "TE", dsi);
  1141. if (ret) {
  1142. dev_err(dsi->dev, "request interrupt failed with %d\n", ret);
  1143. gpio_free(dsi->te_gpio);
  1144. goto out;
  1145. }
  1146. out:
  1147. return ret;
  1148. }
  1149. static void exynos_dsi_unregister_te_irq(struct exynos_dsi *dsi)
  1150. {
  1151. if (gpio_is_valid(dsi->te_gpio)) {
  1152. free_irq(gpio_to_irq(dsi->te_gpio), dsi);
  1153. gpio_free(dsi->te_gpio);
  1154. dsi->te_gpio = -ENOENT;
  1155. }
  1156. }
  1157. static int exynos_dsi_host_attach(struct mipi_dsi_host *host,
  1158. struct mipi_dsi_device *device)
  1159. {
  1160. struct exynos_dsi *dsi = host_to_dsi(host);
  1161. dsi->lanes = device->lanes;
  1162. dsi->format = device->format;
  1163. dsi->mode_flags = device->mode_flags;
  1164. dsi->panel_node = device->dev.of_node;
  1165. /*
  1166. * This is a temporary solution and should be made by more generic way.
  1167. *
  1168. * If attached panel device is for command mode one, dsi should register
  1169. * TE interrupt handler.
  1170. */
  1171. if (!(dsi->mode_flags & MIPI_DSI_MODE_VIDEO)) {
  1172. int ret = exynos_dsi_register_te_irq(dsi);
  1173. if (ret)
  1174. return ret;
  1175. }
  1176. if (dsi->connector.dev)
  1177. drm_helper_hpd_irq_event(dsi->connector.dev);
  1178. return 0;
  1179. }
  1180. static int exynos_dsi_host_detach(struct mipi_dsi_host *host,
  1181. struct mipi_dsi_device *device)
  1182. {
  1183. struct exynos_dsi *dsi = host_to_dsi(host);
  1184. exynos_dsi_unregister_te_irq(dsi);
  1185. dsi->panel_node = NULL;
  1186. if (dsi->connector.dev)
  1187. drm_helper_hpd_irq_event(dsi->connector.dev);
  1188. return 0;
  1189. }
  1190. static ssize_t exynos_dsi_host_transfer(struct mipi_dsi_host *host,
  1191. const struct mipi_dsi_msg *msg)
  1192. {
  1193. struct exynos_dsi *dsi = host_to_dsi(host);
  1194. struct exynos_dsi_transfer xfer;
  1195. int ret;
  1196. if (!(dsi->state & DSIM_STATE_ENABLED))
  1197. return -EINVAL;
  1198. if (!(dsi->state & DSIM_STATE_INITIALIZED)) {
  1199. ret = exynos_dsi_init(dsi);
  1200. if (ret)
  1201. return ret;
  1202. dsi->state |= DSIM_STATE_INITIALIZED;
  1203. }
  1204. ret = mipi_dsi_create_packet(&xfer.packet, msg);
  1205. if (ret < 0)
  1206. return ret;
  1207. xfer.rx_len = msg->rx_len;
  1208. xfer.rx_payload = msg->rx_buf;
  1209. xfer.flags = msg->flags;
  1210. ret = exynos_dsi_transfer(dsi, &xfer);
  1211. return (ret < 0) ? ret : xfer.rx_done;
  1212. }
  1213. static const struct mipi_dsi_host_ops exynos_dsi_ops = {
  1214. .attach = exynos_dsi_host_attach,
  1215. .detach = exynos_dsi_host_detach,
  1216. .transfer = exynos_dsi_host_transfer,
  1217. };
  1218. static void exynos_dsi_enable(struct drm_encoder *encoder)
  1219. {
  1220. struct exynos_dsi *dsi = encoder_to_dsi(encoder);
  1221. int ret;
  1222. if (dsi->state & DSIM_STATE_ENABLED)
  1223. return;
  1224. pm_runtime_get_sync(dsi->dev);
  1225. dsi->state |= DSIM_STATE_ENABLED;
  1226. ret = drm_panel_prepare(dsi->panel);
  1227. if (ret < 0) {
  1228. dsi->state &= ~DSIM_STATE_ENABLED;
  1229. pm_runtime_put_sync(dsi->dev);
  1230. return;
  1231. }
  1232. exynos_dsi_set_display_mode(dsi);
  1233. exynos_dsi_set_display_enable(dsi, true);
  1234. ret = drm_panel_enable(dsi->panel);
  1235. if (ret < 0) {
  1236. dsi->state &= ~DSIM_STATE_ENABLED;
  1237. exynos_dsi_set_display_enable(dsi, false);
  1238. drm_panel_unprepare(dsi->panel);
  1239. pm_runtime_put_sync(dsi->dev);
  1240. return;
  1241. }
  1242. dsi->state |= DSIM_STATE_VIDOUT_AVAILABLE;
  1243. }
  1244. static void exynos_dsi_disable(struct drm_encoder *encoder)
  1245. {
  1246. struct exynos_dsi *dsi = encoder_to_dsi(encoder);
  1247. if (!(dsi->state & DSIM_STATE_ENABLED))
  1248. return;
  1249. dsi->state &= ~DSIM_STATE_VIDOUT_AVAILABLE;
  1250. drm_panel_disable(dsi->panel);
  1251. exynos_dsi_set_display_enable(dsi, false);
  1252. drm_panel_unprepare(dsi->panel);
  1253. dsi->state &= ~DSIM_STATE_ENABLED;
  1254. pm_runtime_put_sync(dsi->dev);
  1255. }
  1256. static enum drm_connector_status
  1257. exynos_dsi_detect(struct drm_connector *connector, bool force)
  1258. {
  1259. struct exynos_dsi *dsi = connector_to_dsi(connector);
  1260. if (!dsi->panel) {
  1261. dsi->panel = of_drm_find_panel(dsi->panel_node);
  1262. if (dsi->panel)
  1263. drm_panel_attach(dsi->panel, &dsi->connector);
  1264. } else if (!dsi->panel_node) {
  1265. struct drm_encoder *encoder;
  1266. encoder = platform_get_drvdata(to_platform_device(dsi->dev));
  1267. exynos_dsi_disable(encoder);
  1268. drm_panel_detach(dsi->panel);
  1269. dsi->panel = NULL;
  1270. }
  1271. if (dsi->panel)
  1272. return connector_status_connected;
  1273. return connector_status_disconnected;
  1274. }
  1275. static void exynos_dsi_connector_destroy(struct drm_connector *connector)
  1276. {
  1277. drm_connector_unregister(connector);
  1278. drm_connector_cleanup(connector);
  1279. connector->dev = NULL;
  1280. }
  1281. static const struct drm_connector_funcs exynos_dsi_connector_funcs = {
  1282. .dpms = drm_atomic_helper_connector_dpms,
  1283. .detect = exynos_dsi_detect,
  1284. .fill_modes = drm_helper_probe_single_connector_modes,
  1285. .destroy = exynos_dsi_connector_destroy,
  1286. .reset = drm_atomic_helper_connector_reset,
  1287. .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
  1288. .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
  1289. };
  1290. static int exynos_dsi_get_modes(struct drm_connector *connector)
  1291. {
  1292. struct exynos_dsi *dsi = connector_to_dsi(connector);
  1293. if (dsi->panel)
  1294. return dsi->panel->funcs->get_modes(dsi->panel);
  1295. return 0;
  1296. }
  1297. static const struct drm_connector_helper_funcs exynos_dsi_connector_helper_funcs = {
  1298. .get_modes = exynos_dsi_get_modes,
  1299. };
  1300. static int exynos_dsi_create_connector(struct drm_encoder *encoder)
  1301. {
  1302. struct exynos_dsi *dsi = encoder_to_dsi(encoder);
  1303. struct drm_connector *connector = &dsi->connector;
  1304. int ret;
  1305. connector->polled = DRM_CONNECTOR_POLL_HPD;
  1306. ret = drm_connector_init(encoder->dev, connector,
  1307. &exynos_dsi_connector_funcs,
  1308. DRM_MODE_CONNECTOR_DSI);
  1309. if (ret) {
  1310. DRM_ERROR("Failed to initialize connector with drm\n");
  1311. return ret;
  1312. }
  1313. drm_connector_helper_add(connector, &exynos_dsi_connector_helper_funcs);
  1314. drm_mode_connector_attach_encoder(connector, encoder);
  1315. return 0;
  1316. }
  1317. static void exynos_dsi_mode_set(struct drm_encoder *encoder,
  1318. struct drm_display_mode *mode,
  1319. struct drm_display_mode *adjusted_mode)
  1320. {
  1321. struct exynos_dsi *dsi = encoder_to_dsi(encoder);
  1322. struct videomode *vm = &dsi->vm;
  1323. struct drm_display_mode *m = adjusted_mode;
  1324. vm->hactive = m->hdisplay;
  1325. vm->vactive = m->vdisplay;
  1326. vm->vfront_porch = m->vsync_start - m->vdisplay;
  1327. vm->vback_porch = m->vtotal - m->vsync_end;
  1328. vm->vsync_len = m->vsync_end - m->vsync_start;
  1329. vm->hfront_porch = m->hsync_start - m->hdisplay;
  1330. vm->hback_porch = m->htotal - m->hsync_end;
  1331. vm->hsync_len = m->hsync_end - m->hsync_start;
  1332. }
  1333. static const struct drm_encoder_helper_funcs exynos_dsi_encoder_helper_funcs = {
  1334. .mode_set = exynos_dsi_mode_set,
  1335. .enable = exynos_dsi_enable,
  1336. .disable = exynos_dsi_disable,
  1337. };
  1338. static const struct drm_encoder_funcs exynos_dsi_encoder_funcs = {
  1339. .destroy = drm_encoder_cleanup,
  1340. };
  1341. MODULE_DEVICE_TABLE(of, exynos_dsi_of_match);
  1342. static int exynos_dsi_of_read_u32(const struct device_node *np,
  1343. const char *propname, u32 *out_value)
  1344. {
  1345. int ret = of_property_read_u32(np, propname, out_value);
  1346. if (ret < 0)
  1347. pr_err("%s: failed to get '%s' property\n", np->full_name,
  1348. propname);
  1349. return ret;
  1350. }
  1351. enum {
  1352. DSI_PORT_IN,
  1353. DSI_PORT_OUT
  1354. };
  1355. static int exynos_dsi_parse_dt(struct exynos_dsi *dsi)
  1356. {
  1357. struct device *dev = dsi->dev;
  1358. struct device_node *node = dev->of_node;
  1359. int ret;
  1360. ret = exynos_dsi_of_read_u32(node, "samsung,pll-clock-frequency",
  1361. &dsi->pll_clk_rate);
  1362. if (ret < 0)
  1363. return ret;
  1364. ret = exynos_dsi_of_read_u32(node, "samsung,burst-clock-frequency",
  1365. &dsi->burst_clk_rate);
  1366. if (ret < 0)
  1367. return ret;
  1368. ret = exynos_dsi_of_read_u32(node, "samsung,esc-clock-frequency",
  1369. &dsi->esc_clk_rate);
  1370. if (ret < 0)
  1371. return ret;
  1372. dsi->bridge_node = of_graph_get_remote_node(node, DSI_PORT_OUT, 0);
  1373. if (!dsi->bridge_node)
  1374. return -EINVAL;
  1375. return 0;
  1376. }
  1377. static int exynos_dsi_bind(struct device *dev, struct device *master,
  1378. void *data)
  1379. {
  1380. struct drm_encoder *encoder = dev_get_drvdata(dev);
  1381. struct exynos_dsi *dsi = encoder_to_dsi(encoder);
  1382. struct drm_device *drm_dev = data;
  1383. struct drm_bridge *bridge;
  1384. int ret;
  1385. ret = exynos_drm_crtc_get_pipe_from_type(drm_dev,
  1386. EXYNOS_DISPLAY_TYPE_LCD);
  1387. if (ret < 0)
  1388. return ret;
  1389. encoder->possible_crtcs = 1 << ret;
  1390. DRM_DEBUG_KMS("possible_crtcs = 0x%x\n", encoder->possible_crtcs);
  1391. drm_encoder_init(drm_dev, encoder, &exynos_dsi_encoder_funcs,
  1392. DRM_MODE_ENCODER_TMDS, NULL);
  1393. drm_encoder_helper_add(encoder, &exynos_dsi_encoder_helper_funcs);
  1394. ret = exynos_dsi_create_connector(encoder);
  1395. if (ret) {
  1396. DRM_ERROR("failed to create connector ret = %d\n", ret);
  1397. drm_encoder_cleanup(encoder);
  1398. return ret;
  1399. }
  1400. bridge = of_drm_find_bridge(dsi->bridge_node);
  1401. if (bridge)
  1402. drm_bridge_attach(encoder, bridge, NULL);
  1403. return mipi_dsi_host_register(&dsi->dsi_host);
  1404. }
  1405. static void exynos_dsi_unbind(struct device *dev, struct device *master,
  1406. void *data)
  1407. {
  1408. struct drm_encoder *encoder = dev_get_drvdata(dev);
  1409. struct exynos_dsi *dsi = encoder_to_dsi(encoder);
  1410. exynos_dsi_disable(encoder);
  1411. mipi_dsi_host_unregister(&dsi->dsi_host);
  1412. }
  1413. static const struct component_ops exynos_dsi_component_ops = {
  1414. .bind = exynos_dsi_bind,
  1415. .unbind = exynos_dsi_unbind,
  1416. };
  1417. static int exynos_dsi_probe(struct platform_device *pdev)
  1418. {
  1419. struct device *dev = &pdev->dev;
  1420. struct resource *res;
  1421. struct exynos_dsi *dsi;
  1422. int ret, i;
  1423. dsi = devm_kzalloc(dev, sizeof(*dsi), GFP_KERNEL);
  1424. if (!dsi)
  1425. return -ENOMEM;
  1426. /* To be checked as invalid one */
  1427. dsi->te_gpio = -ENOENT;
  1428. init_completion(&dsi->completed);
  1429. spin_lock_init(&dsi->transfer_lock);
  1430. INIT_LIST_HEAD(&dsi->transfer_list);
  1431. dsi->dsi_host.ops = &exynos_dsi_ops;
  1432. dsi->dsi_host.dev = dev;
  1433. dsi->dev = dev;
  1434. dsi->driver_data = of_device_get_match_data(dev);
  1435. ret = exynos_dsi_parse_dt(dsi);
  1436. if (ret)
  1437. return ret;
  1438. dsi->supplies[0].supply = "vddcore";
  1439. dsi->supplies[1].supply = "vddio";
  1440. ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(dsi->supplies),
  1441. dsi->supplies);
  1442. if (ret) {
  1443. dev_info(dev, "failed to get regulators: %d\n", ret);
  1444. return -EPROBE_DEFER;
  1445. }
  1446. dsi->clks = devm_kzalloc(dev,
  1447. sizeof(*dsi->clks) * dsi->driver_data->num_clks,
  1448. GFP_KERNEL);
  1449. if (!dsi->clks)
  1450. return -ENOMEM;
  1451. for (i = 0; i < dsi->driver_data->num_clks; i++) {
  1452. dsi->clks[i] = devm_clk_get(dev, clk_names[i]);
  1453. if (IS_ERR(dsi->clks[i])) {
  1454. if (strcmp(clk_names[i], "sclk_mipi") == 0) {
  1455. strcpy(clk_names[i], OLD_SCLK_MIPI_CLK_NAME);
  1456. i--;
  1457. continue;
  1458. }
  1459. dev_info(dev, "failed to get the clock: %s\n",
  1460. clk_names[i]);
  1461. return PTR_ERR(dsi->clks[i]);
  1462. }
  1463. }
  1464. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  1465. dsi->reg_base = devm_ioremap_resource(dev, res);
  1466. if (IS_ERR(dsi->reg_base)) {
  1467. dev_err(dev, "failed to remap io region\n");
  1468. return PTR_ERR(dsi->reg_base);
  1469. }
  1470. dsi->phy = devm_phy_get(dev, "dsim");
  1471. if (IS_ERR(dsi->phy)) {
  1472. dev_info(dev, "failed to get dsim phy\n");
  1473. return PTR_ERR(dsi->phy);
  1474. }
  1475. dsi->irq = platform_get_irq(pdev, 0);
  1476. if (dsi->irq < 0) {
  1477. dev_err(dev, "failed to request dsi irq resource\n");
  1478. return dsi->irq;
  1479. }
  1480. irq_set_status_flags(dsi->irq, IRQ_NOAUTOEN);
  1481. ret = devm_request_threaded_irq(dev, dsi->irq, NULL,
  1482. exynos_dsi_irq, IRQF_ONESHOT,
  1483. dev_name(dev), dsi);
  1484. if (ret) {
  1485. dev_err(dev, "failed to request dsi irq\n");
  1486. return ret;
  1487. }
  1488. platform_set_drvdata(pdev, &dsi->encoder);
  1489. pm_runtime_enable(dev);
  1490. return component_add(dev, &exynos_dsi_component_ops);
  1491. }
  1492. static int exynos_dsi_remove(struct platform_device *pdev)
  1493. {
  1494. struct exynos_dsi *dsi = platform_get_drvdata(pdev);
  1495. of_node_put(dsi->bridge_node);
  1496. pm_runtime_disable(&pdev->dev);
  1497. component_del(&pdev->dev, &exynos_dsi_component_ops);
  1498. return 0;
  1499. }
  1500. static int __maybe_unused exynos_dsi_suspend(struct device *dev)
  1501. {
  1502. struct drm_encoder *encoder = dev_get_drvdata(dev);
  1503. struct exynos_dsi *dsi = encoder_to_dsi(encoder);
  1504. const struct exynos_dsi_driver_data *driver_data = dsi->driver_data;
  1505. int ret, i;
  1506. usleep_range(10000, 20000);
  1507. if (dsi->state & DSIM_STATE_INITIALIZED) {
  1508. dsi->state &= ~DSIM_STATE_INITIALIZED;
  1509. exynos_dsi_disable_clock(dsi);
  1510. exynos_dsi_disable_irq(dsi);
  1511. }
  1512. dsi->state &= ~DSIM_STATE_CMD_LPM;
  1513. phy_power_off(dsi->phy);
  1514. for (i = driver_data->num_clks - 1; i > -1; i--)
  1515. clk_disable_unprepare(dsi->clks[i]);
  1516. ret = regulator_bulk_disable(ARRAY_SIZE(dsi->supplies), dsi->supplies);
  1517. if (ret < 0)
  1518. dev_err(dsi->dev, "cannot disable regulators %d\n", ret);
  1519. return 0;
  1520. }
  1521. static int __maybe_unused exynos_dsi_resume(struct device *dev)
  1522. {
  1523. struct drm_encoder *encoder = dev_get_drvdata(dev);
  1524. struct exynos_dsi *dsi = encoder_to_dsi(encoder);
  1525. const struct exynos_dsi_driver_data *driver_data = dsi->driver_data;
  1526. int ret, i;
  1527. ret = regulator_bulk_enable(ARRAY_SIZE(dsi->supplies), dsi->supplies);
  1528. if (ret < 0) {
  1529. dev_err(dsi->dev, "cannot enable regulators %d\n", ret);
  1530. return ret;
  1531. }
  1532. for (i = 0; i < driver_data->num_clks; i++) {
  1533. ret = clk_prepare_enable(dsi->clks[i]);
  1534. if (ret < 0)
  1535. goto err_clk;
  1536. }
  1537. ret = phy_power_on(dsi->phy);
  1538. if (ret < 0) {
  1539. dev_err(dsi->dev, "cannot enable phy %d\n", ret);
  1540. goto err_clk;
  1541. }
  1542. return 0;
  1543. err_clk:
  1544. while (--i > -1)
  1545. clk_disable_unprepare(dsi->clks[i]);
  1546. regulator_bulk_disable(ARRAY_SIZE(dsi->supplies), dsi->supplies);
  1547. return ret;
  1548. }
  1549. static const struct dev_pm_ops exynos_dsi_pm_ops = {
  1550. SET_RUNTIME_PM_OPS(exynos_dsi_suspend, exynos_dsi_resume, NULL)
  1551. };
  1552. struct platform_driver dsi_driver = {
  1553. .probe = exynos_dsi_probe,
  1554. .remove = exynos_dsi_remove,
  1555. .driver = {
  1556. .name = "exynos-dsi",
  1557. .owner = THIS_MODULE,
  1558. .pm = &exynos_dsi_pm_ops,
  1559. .of_match_table = exynos_dsi_of_match,
  1560. },
  1561. };
  1562. MODULE_AUTHOR("Tomasz Figa <t.figa@samsung.com>");
  1563. MODULE_AUTHOR("Andrzej Hajda <a.hajda@samsung.com>");
  1564. MODULE_DESCRIPTION("Samsung SoC MIPI DSI Master");
  1565. MODULE_LICENSE("GPL v2");