exynos_hdmi.c 51 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917
  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/hdmi_drv.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 <drm/drm_edid.h>
  18. #include <drm/drm_crtc_helper.h>
  19. #include <drm/drm_atomic_helper.h>
  20. #include "regs-hdmi.h"
  21. #include <linux/kernel.h>
  22. #include <linux/wait.h>
  23. #include <linux/i2c.h>
  24. #include <linux/platform_device.h>
  25. #include <linux/interrupt.h>
  26. #include <linux/irq.h>
  27. #include <linux/delay.h>
  28. #include <linux/pm_runtime.h>
  29. #include <linux/clk.h>
  30. #include <linux/gpio/consumer.h>
  31. #include <linux/regulator/consumer.h>
  32. #include <linux/io.h>
  33. #include <linux/of_address.h>
  34. #include <linux/of_device.h>
  35. #include <linux/hdmi.h>
  36. #include <linux/component.h>
  37. #include <linux/mfd/syscon.h>
  38. #include <linux/regmap.h>
  39. #include <drm/exynos_drm.h>
  40. #include "exynos_drm_drv.h"
  41. #include "exynos_drm_crtc.h"
  42. #define HOTPLUG_DEBOUNCE_MS 1100
  43. enum hdmi_type {
  44. HDMI_TYPE13,
  45. HDMI_TYPE14,
  46. HDMI_TYPE_COUNT
  47. };
  48. #define HDMI_MAPPED_BASE 0xffff0000
  49. enum hdmi_mapped_regs {
  50. HDMI_PHY_STATUS = HDMI_MAPPED_BASE,
  51. HDMI_PHY_RSTOUT,
  52. HDMI_ACR_CON,
  53. HDMI_ACR_MCTS0,
  54. HDMI_ACR_CTS0,
  55. HDMI_ACR_N0
  56. };
  57. static const u32 hdmi_reg_map[][HDMI_TYPE_COUNT] = {
  58. { HDMI_V13_PHY_STATUS, HDMI_PHY_STATUS_0 },
  59. { HDMI_V13_PHY_RSTOUT, HDMI_V14_PHY_RSTOUT },
  60. { HDMI_V13_ACR_CON, HDMI_V14_ACR_CON },
  61. { HDMI_V13_ACR_MCTS0, HDMI_V14_ACR_MCTS0 },
  62. { HDMI_V13_ACR_CTS0, HDMI_V14_ACR_CTS0 },
  63. { HDMI_V13_ACR_N0, HDMI_V14_ACR_N0 },
  64. };
  65. static const char * const supply[] = {
  66. "vdd",
  67. "vdd_osc",
  68. "vdd_pll",
  69. };
  70. struct hdmiphy_config {
  71. int pixel_clock;
  72. u8 conf[32];
  73. };
  74. struct hdmiphy_configs {
  75. int count;
  76. const struct hdmiphy_config *data;
  77. };
  78. struct string_array_spec {
  79. int count;
  80. const char * const *data;
  81. };
  82. #define INIT_ARRAY_SPEC(a) { .count = ARRAY_SIZE(a), .data = a }
  83. struct hdmi_driver_data {
  84. unsigned int type;
  85. unsigned int is_apb_phy:1;
  86. unsigned int has_sysreg:1;
  87. struct hdmiphy_configs phy_confs;
  88. struct string_array_spec clk_gates;
  89. /*
  90. * Array of triplets (p_off, p_on, clock), where p_off and p_on are
  91. * required parents of clock when HDMI-PHY is respectively off or on.
  92. */
  93. struct string_array_spec clk_muxes;
  94. };
  95. struct hdmi_context {
  96. struct drm_encoder encoder;
  97. struct device *dev;
  98. struct drm_device *drm_dev;
  99. struct drm_connector connector;
  100. bool powered;
  101. bool dvi_mode;
  102. struct delayed_work hotplug_work;
  103. struct drm_display_mode current_mode;
  104. const struct hdmi_driver_data *drv_data;
  105. void __iomem *regs;
  106. void __iomem *regs_hdmiphy;
  107. struct i2c_client *hdmiphy_port;
  108. struct i2c_adapter *ddc_adpt;
  109. struct gpio_desc *hpd_gpio;
  110. int irq;
  111. struct regmap *pmureg;
  112. struct regmap *sysreg;
  113. struct clk **clk_gates;
  114. struct clk **clk_muxes;
  115. struct regulator_bulk_data regul_bulk[ARRAY_SIZE(supply)];
  116. struct regulator *reg_hdmi_en;
  117. struct exynos_drm_clk phy_clk;
  118. };
  119. static inline struct hdmi_context *encoder_to_hdmi(struct drm_encoder *e)
  120. {
  121. return container_of(e, struct hdmi_context, encoder);
  122. }
  123. static inline struct hdmi_context *connector_to_hdmi(struct drm_connector *c)
  124. {
  125. return container_of(c, struct hdmi_context, connector);
  126. }
  127. static const struct hdmiphy_config hdmiphy_v13_configs[] = {
  128. {
  129. .pixel_clock = 27000000,
  130. .conf = {
  131. 0x01, 0x05, 0x00, 0xD8, 0x10, 0x1C, 0x30, 0x40,
  132. 0x6B, 0x10, 0x02, 0x51, 0xDF, 0xF2, 0x54, 0x87,
  133. 0x84, 0x00, 0x30, 0x38, 0x00, 0x08, 0x10, 0xE0,
  134. 0x22, 0x40, 0xE3, 0x26, 0x00, 0x00, 0x00, 0x80,
  135. },
  136. },
  137. {
  138. .pixel_clock = 27027000,
  139. .conf = {
  140. 0x01, 0x05, 0x00, 0xD4, 0x10, 0x9C, 0x09, 0x64,
  141. 0x6B, 0x10, 0x02, 0x51, 0xDF, 0xF2, 0x54, 0x87,
  142. 0x84, 0x00, 0x30, 0x38, 0x00, 0x08, 0x10, 0xE0,
  143. 0x22, 0x40, 0xE3, 0x26, 0x00, 0x00, 0x00, 0x80,
  144. },
  145. },
  146. {
  147. .pixel_clock = 74176000,
  148. .conf = {
  149. 0x01, 0x05, 0x00, 0xD8, 0x10, 0x9C, 0xef, 0x5B,
  150. 0x6D, 0x10, 0x01, 0x51, 0xef, 0xF3, 0x54, 0xb9,
  151. 0x84, 0x00, 0x30, 0x38, 0x00, 0x08, 0x10, 0xE0,
  152. 0x22, 0x40, 0xa5, 0x26, 0x01, 0x00, 0x00, 0x80,
  153. },
  154. },
  155. {
  156. .pixel_clock = 74250000,
  157. .conf = {
  158. 0x01, 0x05, 0x00, 0xd8, 0x10, 0x9c, 0xf8, 0x40,
  159. 0x6a, 0x10, 0x01, 0x51, 0xff, 0xf1, 0x54, 0xba,
  160. 0x84, 0x00, 0x10, 0x38, 0x00, 0x08, 0x10, 0xe0,
  161. 0x22, 0x40, 0xa4, 0x26, 0x01, 0x00, 0x00, 0x80,
  162. },
  163. },
  164. {
  165. .pixel_clock = 148500000,
  166. .conf = {
  167. 0x01, 0x05, 0x00, 0xD8, 0x10, 0x9C, 0xf8, 0x40,
  168. 0x6A, 0x18, 0x00, 0x51, 0xff, 0xF1, 0x54, 0xba,
  169. 0x84, 0x00, 0x10, 0x38, 0x00, 0x08, 0x10, 0xE0,
  170. 0x22, 0x40, 0xa4, 0x26, 0x02, 0x00, 0x00, 0x80,
  171. },
  172. },
  173. };
  174. static const struct hdmiphy_config hdmiphy_v14_configs[] = {
  175. {
  176. .pixel_clock = 25200000,
  177. .conf = {
  178. 0x01, 0x51, 0x2A, 0x75, 0x40, 0x01, 0x00, 0x08,
  179. 0x82, 0x80, 0xfc, 0xd8, 0x45, 0xa0, 0xac, 0x80,
  180. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  181. 0x54, 0xf4, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  182. },
  183. },
  184. {
  185. .pixel_clock = 27000000,
  186. .conf = {
  187. 0x01, 0xd1, 0x22, 0x51, 0x40, 0x08, 0xfc, 0x20,
  188. 0x98, 0xa0, 0xcb, 0xd8, 0x45, 0xa0, 0xac, 0x80,
  189. 0x06, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  190. 0x54, 0xe4, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  191. },
  192. },
  193. {
  194. .pixel_clock = 27027000,
  195. .conf = {
  196. 0x01, 0xd1, 0x2d, 0x72, 0x40, 0x64, 0x12, 0x08,
  197. 0x43, 0xa0, 0x0e, 0xd9, 0x45, 0xa0, 0xac, 0x80,
  198. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  199. 0x54, 0xe3, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  200. },
  201. },
  202. {
  203. .pixel_clock = 36000000,
  204. .conf = {
  205. 0x01, 0x51, 0x2d, 0x55, 0x40, 0x01, 0x00, 0x08,
  206. 0x82, 0x80, 0x0e, 0xd9, 0x45, 0xa0, 0xac, 0x80,
  207. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  208. 0x54, 0xab, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  209. },
  210. },
  211. {
  212. .pixel_clock = 40000000,
  213. .conf = {
  214. 0x01, 0x51, 0x32, 0x55, 0x40, 0x01, 0x00, 0x08,
  215. 0x82, 0x80, 0x2c, 0xd9, 0x45, 0xa0, 0xac, 0x80,
  216. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  217. 0x54, 0x9a, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  218. },
  219. },
  220. {
  221. .pixel_clock = 65000000,
  222. .conf = {
  223. 0x01, 0xd1, 0x36, 0x34, 0x40, 0x1e, 0x0a, 0x08,
  224. 0x82, 0xa0, 0x45, 0xd9, 0x45, 0xa0, 0xac, 0x80,
  225. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  226. 0x54, 0xbd, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  227. },
  228. },
  229. {
  230. .pixel_clock = 71000000,
  231. .conf = {
  232. 0x01, 0xd1, 0x3b, 0x35, 0x40, 0x0c, 0x04, 0x08,
  233. 0x85, 0xa0, 0x63, 0xd9, 0x45, 0xa0, 0xac, 0x80,
  234. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  235. 0x54, 0xad, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  236. },
  237. },
  238. {
  239. .pixel_clock = 73250000,
  240. .conf = {
  241. 0x01, 0xd1, 0x3d, 0x35, 0x40, 0x18, 0x02, 0x08,
  242. 0x83, 0xa0, 0x6e, 0xd9, 0x45, 0xa0, 0xac, 0x80,
  243. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  244. 0x54, 0xa8, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  245. },
  246. },
  247. {
  248. .pixel_clock = 74176000,
  249. .conf = {
  250. 0x01, 0xd1, 0x3e, 0x35, 0x40, 0x5b, 0xde, 0x08,
  251. 0x82, 0xa0, 0x73, 0xd9, 0x45, 0xa0, 0xac, 0x80,
  252. 0x56, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  253. 0x54, 0xa6, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  254. },
  255. },
  256. {
  257. .pixel_clock = 74250000,
  258. .conf = {
  259. 0x01, 0xd1, 0x1f, 0x10, 0x40, 0x40, 0xf8, 0x08,
  260. 0x81, 0xa0, 0xba, 0xd8, 0x45, 0xa0, 0xac, 0x80,
  261. 0x3c, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  262. 0x54, 0xa5, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  263. },
  264. },
  265. {
  266. .pixel_clock = 83500000,
  267. .conf = {
  268. 0x01, 0xd1, 0x23, 0x11, 0x40, 0x0c, 0xfb, 0x08,
  269. 0x85, 0xa0, 0xd1, 0xd8, 0x45, 0xa0, 0xac, 0x80,
  270. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  271. 0x54, 0x93, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  272. },
  273. },
  274. {
  275. .pixel_clock = 106500000,
  276. .conf = {
  277. 0x01, 0xd1, 0x2c, 0x12, 0x40, 0x0c, 0x09, 0x08,
  278. 0x84, 0xa0, 0x0a, 0xd9, 0x45, 0xa0, 0xac, 0x80,
  279. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  280. 0x54, 0x73, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  281. },
  282. },
  283. {
  284. .pixel_clock = 108000000,
  285. .conf = {
  286. 0x01, 0x51, 0x2d, 0x15, 0x40, 0x01, 0x00, 0x08,
  287. 0x82, 0x80, 0x0e, 0xd9, 0x45, 0xa0, 0xac, 0x80,
  288. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  289. 0x54, 0xc7, 0x25, 0x03, 0x00, 0x00, 0x01, 0x80,
  290. },
  291. },
  292. {
  293. .pixel_clock = 115500000,
  294. .conf = {
  295. 0x01, 0xd1, 0x30, 0x12, 0x40, 0x40, 0x10, 0x08,
  296. 0x80, 0x80, 0x21, 0xd9, 0x45, 0xa0, 0xac, 0x80,
  297. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  298. 0x54, 0xaa, 0x25, 0x03, 0x00, 0x00, 0x01, 0x80,
  299. },
  300. },
  301. {
  302. .pixel_clock = 119000000,
  303. .conf = {
  304. 0x01, 0xd1, 0x32, 0x1a, 0x40, 0x30, 0xd8, 0x08,
  305. 0x04, 0xa0, 0x2a, 0xd9, 0x45, 0xa0, 0xac, 0x80,
  306. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  307. 0x54, 0x9d, 0x25, 0x03, 0x00, 0x00, 0x01, 0x80,
  308. },
  309. },
  310. {
  311. .pixel_clock = 146250000,
  312. .conf = {
  313. 0x01, 0xd1, 0x3d, 0x15, 0x40, 0x18, 0xfd, 0x08,
  314. 0x83, 0xa0, 0x6e, 0xd9, 0x45, 0xa0, 0xac, 0x80,
  315. 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  316. 0x54, 0x50, 0x25, 0x03, 0x00, 0x00, 0x01, 0x80,
  317. },
  318. },
  319. {
  320. .pixel_clock = 148500000,
  321. .conf = {
  322. 0x01, 0xd1, 0x1f, 0x00, 0x40, 0x40, 0xf8, 0x08,
  323. 0x81, 0xa0, 0xba, 0xd8, 0x45, 0xa0, 0xac, 0x80,
  324. 0x3c, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
  325. 0x54, 0x4b, 0x25, 0x03, 0x00, 0x00, 0x01, 0x80,
  326. },
  327. },
  328. };
  329. static const struct hdmiphy_config hdmiphy_5420_configs[] = {
  330. {
  331. .pixel_clock = 25200000,
  332. .conf = {
  333. 0x01, 0x52, 0x3F, 0x55, 0x40, 0x01, 0x00, 0xC8,
  334. 0x82, 0xC8, 0xBD, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
  335. 0x06, 0x80, 0x01, 0x84, 0x05, 0x02, 0x24, 0x66,
  336. 0x54, 0xF4, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  337. },
  338. },
  339. {
  340. .pixel_clock = 27000000,
  341. .conf = {
  342. 0x01, 0xD1, 0x22, 0x51, 0x40, 0x08, 0xFC, 0xE0,
  343. 0x98, 0xE8, 0xCB, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
  344. 0x06, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  345. 0x54, 0xE4, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  346. },
  347. },
  348. {
  349. .pixel_clock = 27027000,
  350. .conf = {
  351. 0x01, 0xD1, 0x2D, 0x72, 0x40, 0x64, 0x12, 0xC8,
  352. 0x43, 0xE8, 0x0E, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
  353. 0x26, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  354. 0x54, 0xE3, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  355. },
  356. },
  357. {
  358. .pixel_clock = 36000000,
  359. .conf = {
  360. 0x01, 0x51, 0x2D, 0x55, 0x40, 0x40, 0x00, 0xC8,
  361. 0x02, 0xC8, 0x0E, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
  362. 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  363. 0x54, 0xAB, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  364. },
  365. },
  366. {
  367. .pixel_clock = 40000000,
  368. .conf = {
  369. 0x01, 0xD1, 0x21, 0x31, 0x40, 0x3C, 0x28, 0xC8,
  370. 0x87, 0xE8, 0xC8, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
  371. 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  372. 0x54, 0x9A, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  373. },
  374. },
  375. {
  376. .pixel_clock = 65000000,
  377. .conf = {
  378. 0x01, 0xD1, 0x36, 0x34, 0x40, 0x0C, 0x04, 0xC8,
  379. 0x82, 0xE8, 0x45, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
  380. 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  381. 0x54, 0xBD, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  382. },
  383. },
  384. {
  385. .pixel_clock = 71000000,
  386. .conf = {
  387. 0x01, 0xD1, 0x3B, 0x35, 0x40, 0x0C, 0x04, 0xC8,
  388. 0x85, 0xE8, 0x63, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
  389. 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  390. 0x54, 0x57, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  391. },
  392. },
  393. {
  394. .pixel_clock = 73250000,
  395. .conf = {
  396. 0x01, 0xD1, 0x1F, 0x10, 0x40, 0x78, 0x8D, 0xC8,
  397. 0x81, 0xE8, 0xB7, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
  398. 0x56, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  399. 0x54, 0xA8, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  400. },
  401. },
  402. {
  403. .pixel_clock = 74176000,
  404. .conf = {
  405. 0x01, 0xD1, 0x1F, 0x10, 0x40, 0x5B, 0xEF, 0xC8,
  406. 0x81, 0xE8, 0xB9, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
  407. 0x56, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  408. 0x54, 0xA6, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  409. },
  410. },
  411. {
  412. .pixel_clock = 74250000,
  413. .conf = {
  414. 0x01, 0xD1, 0x1F, 0x10, 0x40, 0x40, 0xF8, 0x08,
  415. 0x81, 0xE8, 0xBA, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
  416. 0x26, 0x80, 0x09, 0x84, 0x05, 0x22, 0x24, 0x66,
  417. 0x54, 0xA5, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  418. },
  419. },
  420. {
  421. .pixel_clock = 83500000,
  422. .conf = {
  423. 0x01, 0xD1, 0x23, 0x11, 0x40, 0x0C, 0xFB, 0xC8,
  424. 0x85, 0xE8, 0xD1, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
  425. 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  426. 0x54, 0x4A, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  427. },
  428. },
  429. {
  430. .pixel_clock = 88750000,
  431. .conf = {
  432. 0x01, 0xD1, 0x25, 0x11, 0x40, 0x18, 0xFF, 0xC8,
  433. 0x83, 0xE8, 0xDE, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
  434. 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  435. 0x54, 0x45, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
  436. },
  437. },
  438. {
  439. .pixel_clock = 106500000,
  440. .conf = {
  441. 0x01, 0xD1, 0x2C, 0x12, 0x40, 0x0C, 0x09, 0xC8,
  442. 0x84, 0xE8, 0x0A, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
  443. 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  444. 0x54, 0x73, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  445. },
  446. },
  447. {
  448. .pixel_clock = 108000000,
  449. .conf = {
  450. 0x01, 0x51, 0x2D, 0x15, 0x40, 0x01, 0x00, 0xC8,
  451. 0x82, 0xC8, 0x0E, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
  452. 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  453. 0x54, 0xC7, 0x25, 0x03, 0x00, 0x00, 0x01, 0x80,
  454. },
  455. },
  456. {
  457. .pixel_clock = 115500000,
  458. .conf = {
  459. 0x01, 0xD1, 0x30, 0x14, 0x40, 0x0C, 0x03, 0xC8,
  460. 0x88, 0xE8, 0x21, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
  461. 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  462. 0x54, 0x6A, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  463. },
  464. },
  465. {
  466. .pixel_clock = 146250000,
  467. .conf = {
  468. 0x01, 0xD1, 0x3D, 0x15, 0x40, 0x18, 0xFD, 0xC8,
  469. 0x83, 0xE8, 0x6E, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
  470. 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
  471. 0x54, 0x54, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
  472. },
  473. },
  474. {
  475. .pixel_clock = 148500000,
  476. .conf = {
  477. 0x01, 0xD1, 0x1F, 0x00, 0x40, 0x40, 0xF8, 0x08,
  478. 0x81, 0xE8, 0xBA, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
  479. 0x26, 0x80, 0x09, 0x84, 0x05, 0x22, 0x24, 0x66,
  480. 0x54, 0x4B, 0x25, 0x03, 0x00, 0x80, 0x01, 0x80,
  481. },
  482. },
  483. };
  484. static const struct hdmiphy_config hdmiphy_5433_configs[] = {
  485. {
  486. .pixel_clock = 27000000,
  487. .conf = {
  488. 0x01, 0x51, 0x22, 0x51, 0x08, 0xfc, 0x88, 0x46,
  489. 0x72, 0x50, 0x24, 0x0c, 0x24, 0x0f, 0x7c, 0xa5,
  490. 0xd4, 0x2b, 0x87, 0x00, 0x00, 0x04, 0x00, 0x30,
  491. 0x08, 0x10, 0x01, 0x01, 0x48, 0x40, 0x00, 0x40,
  492. },
  493. },
  494. {
  495. .pixel_clock = 27027000,
  496. .conf = {
  497. 0x01, 0x51, 0x2d, 0x72, 0x64, 0x09, 0x88, 0xc3,
  498. 0x71, 0x50, 0x24, 0x14, 0x24, 0x0f, 0x7c, 0xa5,
  499. 0xd4, 0x2b, 0x87, 0x00, 0x00, 0x04, 0x00, 0x30,
  500. 0x28, 0x10, 0x01, 0x01, 0x48, 0x40, 0x00, 0x40,
  501. },
  502. },
  503. {
  504. .pixel_clock = 40000000,
  505. .conf = {
  506. 0x01, 0x51, 0x32, 0x55, 0x01, 0x00, 0x88, 0x02,
  507. 0x4d, 0x50, 0x44, 0x8C, 0x27, 0x00, 0x7C, 0xAC,
  508. 0xD6, 0x2B, 0x67, 0x00, 0x00, 0x04, 0x00, 0x30,
  509. 0x08, 0x10, 0x01, 0x01, 0x48, 0x40, 0x00, 0x40,
  510. },
  511. },
  512. {
  513. .pixel_clock = 50000000,
  514. .conf = {
  515. 0x01, 0x51, 0x34, 0x40, 0x64, 0x09, 0x88, 0xc3,
  516. 0x3d, 0x50, 0x44, 0x8C, 0x27, 0x00, 0x7C, 0xAC,
  517. 0xD6, 0x2B, 0x67, 0x00, 0x00, 0x04, 0x00, 0x30,
  518. 0x08, 0x10, 0x01, 0x01, 0x48, 0x40, 0x00, 0x40,
  519. },
  520. },
  521. {
  522. .pixel_clock = 65000000,
  523. .conf = {
  524. 0x01, 0x51, 0x36, 0x31, 0x40, 0x10, 0x04, 0xc6,
  525. 0x2e, 0xe8, 0x44, 0x8C, 0x27, 0x00, 0x7C, 0xAC,
  526. 0xD6, 0x2B, 0x67, 0x00, 0x00, 0x04, 0x00, 0x30,
  527. 0x08, 0x10, 0x01, 0x01, 0x48, 0x40, 0x00, 0x40,
  528. },
  529. },
  530. {
  531. .pixel_clock = 74176000,
  532. .conf = {
  533. 0x01, 0x51, 0x3E, 0x35, 0x5B, 0xDE, 0x88, 0x42,
  534. 0x53, 0x51, 0x44, 0x8C, 0x27, 0x00, 0x7C, 0xAC,
  535. 0xD6, 0x2B, 0x67, 0x00, 0x00, 0x04, 0x00, 0x30,
  536. 0x08, 0x10, 0x01, 0x01, 0x48, 0x40, 0x00, 0x40,
  537. },
  538. },
  539. {
  540. .pixel_clock = 74250000,
  541. .conf = {
  542. 0x01, 0x51, 0x3E, 0x35, 0x40, 0xF0, 0x88, 0xC2,
  543. 0x52, 0x51, 0x44, 0x8C, 0x27, 0x00, 0x7C, 0xAC,
  544. 0xD6, 0x2B, 0x67, 0x00, 0x00, 0x04, 0x00, 0x30,
  545. 0x08, 0x10, 0x01, 0x01, 0x48, 0x40, 0x00, 0x40,
  546. },
  547. },
  548. {
  549. .pixel_clock = 108000000,
  550. .conf = {
  551. 0x01, 0x51, 0x2d, 0x15, 0x01, 0x00, 0x88, 0x02,
  552. 0x72, 0x52, 0x44, 0x8C, 0x27, 0x00, 0x7C, 0xAC,
  553. 0xD6, 0x2B, 0x67, 0x00, 0x00, 0x04, 0x00, 0x30,
  554. 0x08, 0x10, 0x01, 0x01, 0x48, 0x40, 0x00, 0x40,
  555. },
  556. },
  557. {
  558. .pixel_clock = 148500000,
  559. .conf = {
  560. 0x01, 0x51, 0x1f, 0x00, 0x40, 0xf8, 0x88, 0xc1,
  561. 0x52, 0x52, 0x24, 0x0c, 0x24, 0x0f, 0x7c, 0xa5,
  562. 0xd4, 0x2b, 0x87, 0x00, 0x00, 0x04, 0x00, 0x30,
  563. 0x08, 0x10, 0x01, 0x01, 0x48, 0x4a, 0x00, 0x40,
  564. },
  565. },
  566. };
  567. static const char * const hdmi_clk_gates4[] = {
  568. "hdmi", "sclk_hdmi"
  569. };
  570. static const char * const hdmi_clk_muxes4[] = {
  571. "sclk_pixel", "sclk_hdmiphy", "mout_hdmi"
  572. };
  573. static const char * const hdmi_clk_gates5433[] = {
  574. "hdmi_pclk", "hdmi_i_pclk", "i_tmds_clk", "i_pixel_clk", "i_spdif_clk"
  575. };
  576. static const char * const hdmi_clk_muxes5433[] = {
  577. "oscclk", "tmds_clko", "tmds_clko_user",
  578. "oscclk", "pixel_clko", "pixel_clko_user"
  579. };
  580. static const struct hdmi_driver_data exynos4210_hdmi_driver_data = {
  581. .type = HDMI_TYPE13,
  582. .phy_confs = INIT_ARRAY_SPEC(hdmiphy_v13_configs),
  583. .clk_gates = INIT_ARRAY_SPEC(hdmi_clk_gates4),
  584. .clk_muxes = INIT_ARRAY_SPEC(hdmi_clk_muxes4),
  585. };
  586. static const struct hdmi_driver_data exynos4212_hdmi_driver_data = {
  587. .type = HDMI_TYPE14,
  588. .phy_confs = INIT_ARRAY_SPEC(hdmiphy_v14_configs),
  589. .clk_gates = INIT_ARRAY_SPEC(hdmi_clk_gates4),
  590. .clk_muxes = INIT_ARRAY_SPEC(hdmi_clk_muxes4),
  591. };
  592. static const struct hdmi_driver_data exynos5420_hdmi_driver_data = {
  593. .type = HDMI_TYPE14,
  594. .is_apb_phy = 1,
  595. .phy_confs = INIT_ARRAY_SPEC(hdmiphy_5420_configs),
  596. .clk_gates = INIT_ARRAY_SPEC(hdmi_clk_gates4),
  597. .clk_muxes = INIT_ARRAY_SPEC(hdmi_clk_muxes4),
  598. };
  599. static const struct hdmi_driver_data exynos5433_hdmi_driver_data = {
  600. .type = HDMI_TYPE14,
  601. .is_apb_phy = 1,
  602. .has_sysreg = 1,
  603. .phy_confs = INIT_ARRAY_SPEC(hdmiphy_5433_configs),
  604. .clk_gates = INIT_ARRAY_SPEC(hdmi_clk_gates5433),
  605. .clk_muxes = INIT_ARRAY_SPEC(hdmi_clk_muxes5433),
  606. };
  607. static inline u32 hdmi_map_reg(struct hdmi_context *hdata, u32 reg_id)
  608. {
  609. if ((reg_id & 0xffff0000) == HDMI_MAPPED_BASE)
  610. return hdmi_reg_map[reg_id & 0xffff][hdata->drv_data->type];
  611. return reg_id;
  612. }
  613. static inline u32 hdmi_reg_read(struct hdmi_context *hdata, u32 reg_id)
  614. {
  615. return readl(hdata->regs + hdmi_map_reg(hdata, reg_id));
  616. }
  617. static inline void hdmi_reg_writeb(struct hdmi_context *hdata,
  618. u32 reg_id, u8 value)
  619. {
  620. writel(value, hdata->regs + hdmi_map_reg(hdata, reg_id));
  621. }
  622. static inline void hdmi_reg_writev(struct hdmi_context *hdata, u32 reg_id,
  623. int bytes, u32 val)
  624. {
  625. reg_id = hdmi_map_reg(hdata, reg_id);
  626. while (--bytes >= 0) {
  627. writel(val & 0xff, hdata->regs + reg_id);
  628. val >>= 8;
  629. reg_id += 4;
  630. }
  631. }
  632. static inline void hdmi_reg_write_buf(struct hdmi_context *hdata, u32 reg_id,
  633. u8 *buf, int size)
  634. {
  635. for (reg_id = hdmi_map_reg(hdata, reg_id); size; --size, reg_id += 4)
  636. writel(*buf++, hdata->regs + reg_id);
  637. }
  638. static inline void hdmi_reg_writemask(struct hdmi_context *hdata,
  639. u32 reg_id, u32 value, u32 mask)
  640. {
  641. u32 old;
  642. reg_id = hdmi_map_reg(hdata, reg_id);
  643. old = readl(hdata->regs + reg_id);
  644. value = (value & mask) | (old & ~mask);
  645. writel(value, hdata->regs + reg_id);
  646. }
  647. static int hdmiphy_reg_write_buf(struct hdmi_context *hdata,
  648. u32 reg_offset, const u8 *buf, u32 len)
  649. {
  650. if ((reg_offset + len) > 32)
  651. return -EINVAL;
  652. if (hdata->hdmiphy_port) {
  653. int ret;
  654. ret = i2c_master_send(hdata->hdmiphy_port, buf, len);
  655. if (ret == len)
  656. return 0;
  657. return ret;
  658. } else {
  659. int i;
  660. for (i = 0; i < len; i++)
  661. writel(buf[i], hdata->regs_hdmiphy +
  662. ((reg_offset + i)<<2));
  663. return 0;
  664. }
  665. }
  666. static int hdmi_clk_enable_gates(struct hdmi_context *hdata)
  667. {
  668. int i, ret;
  669. for (i = 0; i < hdata->drv_data->clk_gates.count; ++i) {
  670. ret = clk_prepare_enable(hdata->clk_gates[i]);
  671. if (!ret)
  672. continue;
  673. dev_err(hdata->dev, "Cannot enable clock '%s', %d\n",
  674. hdata->drv_data->clk_gates.data[i], ret);
  675. while (i--)
  676. clk_disable_unprepare(hdata->clk_gates[i]);
  677. return ret;
  678. }
  679. return 0;
  680. }
  681. static void hdmi_clk_disable_gates(struct hdmi_context *hdata)
  682. {
  683. int i = hdata->drv_data->clk_gates.count;
  684. while (i--)
  685. clk_disable_unprepare(hdata->clk_gates[i]);
  686. }
  687. static int hdmi_clk_set_parents(struct hdmi_context *hdata, bool to_phy)
  688. {
  689. struct device *dev = hdata->dev;
  690. int ret = 0;
  691. int i;
  692. for (i = 0; i < hdata->drv_data->clk_muxes.count; i += 3) {
  693. struct clk **c = &hdata->clk_muxes[i];
  694. ret = clk_set_parent(c[2], c[to_phy]);
  695. if (!ret)
  696. continue;
  697. dev_err(dev, "Cannot set clock parent of '%s' to '%s', %d\n",
  698. hdata->drv_data->clk_muxes.data[i + 2],
  699. hdata->drv_data->clk_muxes.data[i + to_phy], ret);
  700. }
  701. return ret;
  702. }
  703. static void hdmi_reg_infoframes(struct hdmi_context *hdata)
  704. {
  705. union hdmi_infoframe frm;
  706. u8 buf[25];
  707. int ret;
  708. if (hdata->dvi_mode) {
  709. hdmi_reg_writeb(hdata, HDMI_AVI_CON,
  710. HDMI_AVI_CON_DO_NOT_TRANSMIT);
  711. hdmi_reg_writeb(hdata, HDMI_VSI_CON,
  712. HDMI_VSI_CON_DO_NOT_TRANSMIT);
  713. hdmi_reg_writeb(hdata, HDMI_AUI_CON, HDMI_AUI_CON_NO_TRAN);
  714. return;
  715. }
  716. ret = drm_hdmi_avi_infoframe_from_display_mode(&frm.avi,
  717. &hdata->current_mode);
  718. if (!ret)
  719. ret = hdmi_avi_infoframe_pack(&frm.avi, buf, sizeof(buf));
  720. if (ret > 0) {
  721. hdmi_reg_writeb(hdata, HDMI_AVI_CON, HDMI_AVI_CON_EVERY_VSYNC);
  722. hdmi_reg_write_buf(hdata, HDMI_AVI_HEADER0, buf, ret);
  723. } else {
  724. DRM_INFO("%s: invalid AVI infoframe (%d)\n", __func__, ret);
  725. }
  726. ret = drm_hdmi_vendor_infoframe_from_display_mode(&frm.vendor.hdmi,
  727. &hdata->current_mode);
  728. if (!ret)
  729. ret = hdmi_vendor_infoframe_pack(&frm.vendor.hdmi, buf,
  730. sizeof(buf));
  731. if (ret > 0) {
  732. hdmi_reg_writeb(hdata, HDMI_VSI_CON, HDMI_VSI_CON_EVERY_VSYNC);
  733. hdmi_reg_write_buf(hdata, HDMI_VSI_HEADER0, buf, ret);
  734. }
  735. ret = hdmi_audio_infoframe_init(&frm.audio);
  736. if (!ret) {
  737. frm.audio.channels = 2;
  738. ret = hdmi_audio_infoframe_pack(&frm.audio, buf, sizeof(buf));
  739. }
  740. if (ret > 0) {
  741. hdmi_reg_writeb(hdata, HDMI_AUI_CON, HDMI_AUI_CON_EVERY_VSYNC);
  742. hdmi_reg_write_buf(hdata, HDMI_AUI_HEADER0, buf, ret);
  743. }
  744. }
  745. static enum drm_connector_status hdmi_detect(struct drm_connector *connector,
  746. bool force)
  747. {
  748. struct hdmi_context *hdata = connector_to_hdmi(connector);
  749. if (gpiod_get_value(hdata->hpd_gpio))
  750. return connector_status_connected;
  751. return connector_status_disconnected;
  752. }
  753. static void hdmi_connector_destroy(struct drm_connector *connector)
  754. {
  755. drm_connector_unregister(connector);
  756. drm_connector_cleanup(connector);
  757. }
  758. static const struct drm_connector_funcs hdmi_connector_funcs = {
  759. .dpms = drm_atomic_helper_connector_dpms,
  760. .fill_modes = drm_helper_probe_single_connector_modes,
  761. .detect = hdmi_detect,
  762. .destroy = hdmi_connector_destroy,
  763. .reset = drm_atomic_helper_connector_reset,
  764. .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
  765. .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
  766. };
  767. static int hdmi_get_modes(struct drm_connector *connector)
  768. {
  769. struct hdmi_context *hdata = connector_to_hdmi(connector);
  770. struct edid *edid;
  771. int ret;
  772. if (!hdata->ddc_adpt)
  773. return -ENODEV;
  774. edid = drm_get_edid(connector, hdata->ddc_adpt);
  775. if (!edid)
  776. return -ENODEV;
  777. hdata->dvi_mode = !drm_detect_hdmi_monitor(edid);
  778. DRM_DEBUG_KMS("%s : width[%d] x height[%d]\n",
  779. (hdata->dvi_mode ? "dvi monitor" : "hdmi monitor"),
  780. edid->width_cm, edid->height_cm);
  781. drm_mode_connector_update_edid_property(connector, edid);
  782. ret = drm_add_edid_modes(connector, edid);
  783. kfree(edid);
  784. return ret;
  785. }
  786. static int hdmi_find_phy_conf(struct hdmi_context *hdata, u32 pixel_clock)
  787. {
  788. const struct hdmiphy_configs *confs = &hdata->drv_data->phy_confs;
  789. int i;
  790. for (i = 0; i < confs->count; i++)
  791. if (confs->data[i].pixel_clock == pixel_clock)
  792. return i;
  793. DRM_DEBUG_KMS("Could not find phy config for %d\n", pixel_clock);
  794. return -EINVAL;
  795. }
  796. static int hdmi_mode_valid(struct drm_connector *connector,
  797. struct drm_display_mode *mode)
  798. {
  799. struct hdmi_context *hdata = connector_to_hdmi(connector);
  800. int ret;
  801. DRM_DEBUG_KMS("xres=%d, yres=%d, refresh=%d, intl=%d clock=%d\n",
  802. mode->hdisplay, mode->vdisplay, mode->vrefresh,
  803. (mode->flags & DRM_MODE_FLAG_INTERLACE) ? true :
  804. false, mode->clock * 1000);
  805. ret = hdmi_find_phy_conf(hdata, mode->clock * 1000);
  806. if (ret < 0)
  807. return MODE_BAD;
  808. return MODE_OK;
  809. }
  810. static const struct drm_connector_helper_funcs hdmi_connector_helper_funcs = {
  811. .get_modes = hdmi_get_modes,
  812. .mode_valid = hdmi_mode_valid,
  813. };
  814. static int hdmi_create_connector(struct drm_encoder *encoder)
  815. {
  816. struct hdmi_context *hdata = encoder_to_hdmi(encoder);
  817. struct drm_connector *connector = &hdata->connector;
  818. int ret;
  819. connector->interlace_allowed = true;
  820. connector->polled = DRM_CONNECTOR_POLL_HPD;
  821. ret = drm_connector_init(hdata->drm_dev, connector,
  822. &hdmi_connector_funcs, DRM_MODE_CONNECTOR_HDMIA);
  823. if (ret) {
  824. DRM_ERROR("Failed to initialize connector with drm\n");
  825. return ret;
  826. }
  827. drm_connector_helper_add(connector, &hdmi_connector_helper_funcs);
  828. drm_connector_register(connector);
  829. drm_mode_connector_attach_encoder(connector, encoder);
  830. return 0;
  831. }
  832. static bool hdmi_mode_fixup(struct drm_encoder *encoder,
  833. const struct drm_display_mode *mode,
  834. struct drm_display_mode *adjusted_mode)
  835. {
  836. struct drm_device *dev = encoder->dev;
  837. struct drm_connector *connector;
  838. struct drm_display_mode *m;
  839. int mode_ok;
  840. drm_mode_set_crtcinfo(adjusted_mode, 0);
  841. list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
  842. if (connector->encoder == encoder)
  843. break;
  844. }
  845. if (connector->encoder != encoder)
  846. return true;
  847. mode_ok = hdmi_mode_valid(connector, adjusted_mode);
  848. if (mode_ok == MODE_OK)
  849. return true;
  850. /*
  851. * Find the most suitable mode and copy it to adjusted_mode.
  852. */
  853. list_for_each_entry(m, &connector->modes, head) {
  854. mode_ok = hdmi_mode_valid(connector, m);
  855. if (mode_ok == MODE_OK) {
  856. DRM_INFO("desired mode doesn't exist so\n");
  857. DRM_INFO("use the most suitable mode among modes.\n");
  858. DRM_DEBUG_KMS("Adjusted Mode: [%d]x[%d] [%d]Hz\n",
  859. m->hdisplay, m->vdisplay, m->vrefresh);
  860. drm_mode_copy(adjusted_mode, m);
  861. break;
  862. }
  863. }
  864. return true;
  865. }
  866. static void hdmi_reg_acr(struct hdmi_context *hdata, u32 freq)
  867. {
  868. u32 n, cts;
  869. cts = (freq % 9) ? 27000 : 30000;
  870. n = 128 * freq / (27000000 / cts);
  871. hdmi_reg_writev(hdata, HDMI_ACR_N0, 3, n);
  872. hdmi_reg_writev(hdata, HDMI_ACR_MCTS0, 3, cts);
  873. hdmi_reg_writev(hdata, HDMI_ACR_CTS0, 3, cts);
  874. hdmi_reg_writeb(hdata, HDMI_ACR_CON, 4);
  875. }
  876. static void hdmi_audio_init(struct hdmi_context *hdata)
  877. {
  878. u32 sample_rate, bits_per_sample;
  879. u32 data_num, bit_ch, sample_frq;
  880. u32 val;
  881. sample_rate = 44100;
  882. bits_per_sample = 16;
  883. switch (bits_per_sample) {
  884. case 20:
  885. data_num = 2;
  886. bit_ch = 1;
  887. break;
  888. case 24:
  889. data_num = 3;
  890. bit_ch = 1;
  891. break;
  892. default:
  893. data_num = 1;
  894. bit_ch = 0;
  895. break;
  896. }
  897. hdmi_reg_acr(hdata, sample_rate);
  898. hdmi_reg_writeb(hdata, HDMI_I2S_MUX_CON, HDMI_I2S_IN_DISABLE
  899. | HDMI_I2S_AUD_I2S | HDMI_I2S_CUV_I2S_ENABLE
  900. | HDMI_I2S_MUX_ENABLE);
  901. hdmi_reg_writeb(hdata, HDMI_I2S_MUX_CH, HDMI_I2S_CH0_EN
  902. | HDMI_I2S_CH1_EN | HDMI_I2S_CH2_EN);
  903. hdmi_reg_writeb(hdata, HDMI_I2S_MUX_CUV, HDMI_I2S_CUV_RL_EN);
  904. sample_frq = (sample_rate == 44100) ? 0 :
  905. (sample_rate == 48000) ? 2 :
  906. (sample_rate == 32000) ? 3 :
  907. (sample_rate == 96000) ? 0xa : 0x0;
  908. hdmi_reg_writeb(hdata, HDMI_I2S_CLK_CON, HDMI_I2S_CLK_DIS);
  909. hdmi_reg_writeb(hdata, HDMI_I2S_CLK_CON, HDMI_I2S_CLK_EN);
  910. val = hdmi_reg_read(hdata, HDMI_I2S_DSD_CON) | 0x01;
  911. hdmi_reg_writeb(hdata, HDMI_I2S_DSD_CON, val);
  912. /* Configuration I2S input ports. Configure I2S_PIN_SEL_0~4 */
  913. hdmi_reg_writeb(hdata, HDMI_I2S_PIN_SEL_0, HDMI_I2S_SEL_SCLK(5)
  914. | HDMI_I2S_SEL_LRCK(6));
  915. hdmi_reg_writeb(hdata, HDMI_I2S_PIN_SEL_1, HDMI_I2S_SEL_SDATA1(1)
  916. | HDMI_I2S_SEL_SDATA2(4));
  917. hdmi_reg_writeb(hdata, HDMI_I2S_PIN_SEL_2, HDMI_I2S_SEL_SDATA3(1)
  918. | HDMI_I2S_SEL_SDATA2(2));
  919. hdmi_reg_writeb(hdata, HDMI_I2S_PIN_SEL_3, HDMI_I2S_SEL_DSD(0));
  920. /* I2S_CON_1 & 2 */
  921. hdmi_reg_writeb(hdata, HDMI_I2S_CON_1, HDMI_I2S_SCLK_FALLING_EDGE
  922. | HDMI_I2S_L_CH_LOW_POL);
  923. hdmi_reg_writeb(hdata, HDMI_I2S_CON_2, HDMI_I2S_MSB_FIRST_MODE
  924. | HDMI_I2S_SET_BIT_CH(bit_ch)
  925. | HDMI_I2S_SET_SDATA_BIT(data_num)
  926. | HDMI_I2S_BASIC_FORMAT);
  927. /* Configure register related to CUV information */
  928. hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_0, HDMI_I2S_CH_STATUS_MODE_0
  929. | HDMI_I2S_2AUD_CH_WITHOUT_PREEMPH
  930. | HDMI_I2S_COPYRIGHT
  931. | HDMI_I2S_LINEAR_PCM
  932. | HDMI_I2S_CONSUMER_FORMAT);
  933. hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_1, HDMI_I2S_CD_PLAYER);
  934. hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_2, HDMI_I2S_SET_SOURCE_NUM(0));
  935. hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_3, HDMI_I2S_CLK_ACCUR_LEVEL_2
  936. | HDMI_I2S_SET_SMP_FREQ(sample_frq));
  937. hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_4,
  938. HDMI_I2S_ORG_SMP_FREQ_44_1
  939. | HDMI_I2S_WORD_LEN_MAX24_24BITS
  940. | HDMI_I2S_WORD_LEN_MAX_24BITS);
  941. hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_CON, HDMI_I2S_CH_STATUS_RELOAD);
  942. }
  943. static void hdmi_audio_control(struct hdmi_context *hdata, bool onoff)
  944. {
  945. if (hdata->dvi_mode)
  946. return;
  947. hdmi_reg_writeb(hdata, HDMI_AUI_CON, onoff ? 2 : 0);
  948. hdmi_reg_writemask(hdata, HDMI_CON_0, onoff ?
  949. HDMI_ASP_EN : HDMI_ASP_DIS, HDMI_ASP_MASK);
  950. }
  951. static void hdmi_start(struct hdmi_context *hdata, bool start)
  952. {
  953. u32 val = start ? HDMI_TG_EN : 0;
  954. if (hdata->current_mode.flags & DRM_MODE_FLAG_INTERLACE)
  955. val |= HDMI_FIELD_EN;
  956. hdmi_reg_writemask(hdata, HDMI_CON_0, val, HDMI_EN);
  957. hdmi_reg_writemask(hdata, HDMI_TG_CMD, val, HDMI_TG_EN | HDMI_FIELD_EN);
  958. }
  959. static void hdmi_conf_init(struct hdmi_context *hdata)
  960. {
  961. /* disable HPD interrupts from HDMI IP block, use GPIO instead */
  962. hdmi_reg_writemask(hdata, HDMI_INTC_CON, 0, HDMI_INTC_EN_GLOBAL |
  963. HDMI_INTC_EN_HPD_PLUG | HDMI_INTC_EN_HPD_UNPLUG);
  964. /* choose HDMI mode */
  965. hdmi_reg_writemask(hdata, HDMI_MODE_SEL,
  966. HDMI_MODE_HDMI_EN, HDMI_MODE_MASK);
  967. /* apply video pre-amble and guard band in HDMI mode only */
  968. hdmi_reg_writeb(hdata, HDMI_CON_2, 0);
  969. /* disable bluescreen */
  970. hdmi_reg_writemask(hdata, HDMI_CON_0, 0, HDMI_BLUE_SCR_EN);
  971. if (hdata->dvi_mode) {
  972. hdmi_reg_writemask(hdata, HDMI_MODE_SEL,
  973. HDMI_MODE_DVI_EN, HDMI_MODE_MASK);
  974. hdmi_reg_writeb(hdata, HDMI_CON_2,
  975. HDMI_VID_PREAMBLE_DIS | HDMI_GUARD_BAND_DIS);
  976. }
  977. if (hdata->drv_data->type == HDMI_TYPE13) {
  978. /* choose bluescreen (fecal) color */
  979. hdmi_reg_writeb(hdata, HDMI_V13_BLUE_SCREEN_0, 0x12);
  980. hdmi_reg_writeb(hdata, HDMI_V13_BLUE_SCREEN_1, 0x34);
  981. hdmi_reg_writeb(hdata, HDMI_V13_BLUE_SCREEN_2, 0x56);
  982. /* enable AVI packet every vsync, fixes purple line problem */
  983. hdmi_reg_writeb(hdata, HDMI_V13_AVI_CON, 0x02);
  984. /* force RGB, look to CEA-861-D, table 7 for more detail */
  985. hdmi_reg_writeb(hdata, HDMI_V13_AVI_BYTE(0), 0 << 5);
  986. hdmi_reg_writemask(hdata, HDMI_CON_1, 0x10 << 5, 0x11 << 5);
  987. hdmi_reg_writeb(hdata, HDMI_V13_SPD_CON, 0x02);
  988. hdmi_reg_writeb(hdata, HDMI_V13_AUI_CON, 0x02);
  989. hdmi_reg_writeb(hdata, HDMI_V13_ACR_CON, 0x04);
  990. } else {
  991. hdmi_reg_infoframes(hdata);
  992. /* enable AVI packet every vsync, fixes purple line problem */
  993. hdmi_reg_writemask(hdata, HDMI_CON_1, 2, 3 << 5);
  994. }
  995. }
  996. static void hdmiphy_wait_for_pll(struct hdmi_context *hdata)
  997. {
  998. int tries;
  999. for (tries = 0; tries < 10; ++tries) {
  1000. u32 val = hdmi_reg_read(hdata, HDMI_PHY_STATUS);
  1001. if (val & HDMI_PHY_STATUS_READY) {
  1002. DRM_DEBUG_KMS("PLL stabilized after %d tries\n", tries);
  1003. return;
  1004. }
  1005. usleep_range(10, 20);
  1006. }
  1007. DRM_ERROR("PLL could not reach steady state\n");
  1008. }
  1009. static void hdmi_v13_mode_apply(struct hdmi_context *hdata)
  1010. {
  1011. struct drm_display_mode *m = &hdata->current_mode;
  1012. unsigned int val;
  1013. hdmi_reg_writev(hdata, HDMI_H_BLANK_0, 2, m->htotal - m->hdisplay);
  1014. hdmi_reg_writev(hdata, HDMI_V13_H_V_LINE_0, 3,
  1015. (m->htotal << 12) | m->vtotal);
  1016. val = (m->flags & DRM_MODE_FLAG_NVSYNC) ? 1 : 0;
  1017. hdmi_reg_writev(hdata, HDMI_VSYNC_POL, 1, val);
  1018. val = (m->flags & DRM_MODE_FLAG_INTERLACE) ? 1 : 0;
  1019. hdmi_reg_writev(hdata, HDMI_INT_PRO_MODE, 1, val);
  1020. val = (m->hsync_start - m->hdisplay - 2);
  1021. val |= ((m->hsync_end - m->hdisplay - 2) << 10);
  1022. val |= ((m->flags & DRM_MODE_FLAG_NHSYNC) ? 1 : 0)<<20;
  1023. hdmi_reg_writev(hdata, HDMI_V13_H_SYNC_GEN_0, 3, val);
  1024. /*
  1025. * Quirk requirement for exynos HDMI IP design,
  1026. * 2 pixels less than the actual calculation for hsync_start
  1027. * and end.
  1028. */
  1029. /* Following values & calculations differ for different type of modes */
  1030. if (m->flags & DRM_MODE_FLAG_INTERLACE) {
  1031. val = ((m->vsync_end - m->vdisplay) / 2);
  1032. val |= ((m->vsync_start - m->vdisplay) / 2) << 12;
  1033. hdmi_reg_writev(hdata, HDMI_V13_V_SYNC_GEN_1_0, 3, val);
  1034. val = m->vtotal / 2;
  1035. val |= ((m->vtotal - m->vdisplay) / 2) << 11;
  1036. hdmi_reg_writev(hdata, HDMI_V13_V_BLANK_0, 3, val);
  1037. val = (m->vtotal +
  1038. ((m->vsync_end - m->vsync_start) * 4) + 5) / 2;
  1039. val |= m->vtotal << 11;
  1040. hdmi_reg_writev(hdata, HDMI_V13_V_BLANK_F_0, 3, val);
  1041. val = ((m->vtotal / 2) + 7);
  1042. val |= ((m->vtotal / 2) + 2) << 12;
  1043. hdmi_reg_writev(hdata, HDMI_V13_V_SYNC_GEN_2_0, 3, val);
  1044. val = ((m->htotal / 2) + (m->hsync_start - m->hdisplay));
  1045. val |= ((m->htotal / 2) +
  1046. (m->hsync_start - m->hdisplay)) << 12;
  1047. hdmi_reg_writev(hdata, HDMI_V13_V_SYNC_GEN_3_0, 3, val);
  1048. hdmi_reg_writev(hdata, HDMI_TG_VACT_ST_L, 2,
  1049. (m->vtotal - m->vdisplay) / 2);
  1050. hdmi_reg_writev(hdata, HDMI_TG_VACT_SZ_L, 2, m->vdisplay / 2);
  1051. hdmi_reg_writev(hdata, HDMI_TG_VACT_ST2_L, 2, 0x249);
  1052. } else {
  1053. val = m->vtotal;
  1054. val |= (m->vtotal - m->vdisplay) << 11;
  1055. hdmi_reg_writev(hdata, HDMI_V13_V_BLANK_0, 3, val);
  1056. hdmi_reg_writev(hdata, HDMI_V13_V_BLANK_F_0, 3, 0);
  1057. val = (m->vsync_end - m->vdisplay);
  1058. val |= ((m->vsync_start - m->vdisplay) << 12);
  1059. hdmi_reg_writev(hdata, HDMI_V13_V_SYNC_GEN_1_0, 3, val);
  1060. hdmi_reg_writev(hdata, HDMI_V13_V_SYNC_GEN_2_0, 3, 0x1001);
  1061. hdmi_reg_writev(hdata, HDMI_V13_V_SYNC_GEN_3_0, 3, 0x1001);
  1062. hdmi_reg_writev(hdata, HDMI_TG_VACT_ST_L, 2,
  1063. m->vtotal - m->vdisplay);
  1064. hdmi_reg_writev(hdata, HDMI_TG_VACT_SZ_L, 2, m->vdisplay);
  1065. }
  1066. hdmi_reg_writev(hdata, HDMI_TG_H_FSZ_L, 2, m->htotal);
  1067. hdmi_reg_writev(hdata, HDMI_TG_HACT_ST_L, 2, m->htotal - m->hdisplay);
  1068. hdmi_reg_writev(hdata, HDMI_TG_HACT_SZ_L, 2, m->hdisplay);
  1069. hdmi_reg_writev(hdata, HDMI_TG_V_FSZ_L, 2, m->vtotal);
  1070. }
  1071. static void hdmi_v14_mode_apply(struct hdmi_context *hdata)
  1072. {
  1073. struct drm_display_mode *m = &hdata->current_mode;
  1074. hdmi_reg_writev(hdata, HDMI_H_BLANK_0, 2, m->htotal - m->hdisplay);
  1075. hdmi_reg_writev(hdata, HDMI_V_LINE_0, 2, m->vtotal);
  1076. hdmi_reg_writev(hdata, HDMI_H_LINE_0, 2, m->htotal);
  1077. hdmi_reg_writev(hdata, HDMI_HSYNC_POL, 1,
  1078. (m->flags & DRM_MODE_FLAG_NHSYNC) ? 1 : 0);
  1079. hdmi_reg_writev(hdata, HDMI_VSYNC_POL, 1,
  1080. (m->flags & DRM_MODE_FLAG_NVSYNC) ? 1 : 0);
  1081. hdmi_reg_writev(hdata, HDMI_INT_PRO_MODE, 1,
  1082. (m->flags & DRM_MODE_FLAG_INTERLACE) ? 1 : 0);
  1083. /*
  1084. * Quirk requirement for exynos 5 HDMI IP design,
  1085. * 2 pixels less than the actual calculation for hsync_start
  1086. * and end.
  1087. */
  1088. /* Following values & calculations differ for different type of modes */
  1089. if (m->flags & DRM_MODE_FLAG_INTERLACE) {
  1090. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_BEF_2_0, 2,
  1091. (m->vsync_end - m->vdisplay) / 2);
  1092. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_BEF_1_0, 2,
  1093. (m->vsync_start - m->vdisplay) / 2);
  1094. hdmi_reg_writev(hdata, HDMI_V2_BLANK_0, 2, m->vtotal / 2);
  1095. hdmi_reg_writev(hdata, HDMI_V1_BLANK_0, 2,
  1096. (m->vtotal - m->vdisplay) / 2);
  1097. hdmi_reg_writev(hdata, HDMI_V_BLANK_F0_0, 2,
  1098. m->vtotal - m->vdisplay / 2);
  1099. hdmi_reg_writev(hdata, HDMI_V_BLANK_F1_0, 2, m->vtotal);
  1100. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_2_0, 2,
  1101. (m->vtotal / 2) + 7);
  1102. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_1_0, 2,
  1103. (m->vtotal / 2) + 2);
  1104. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_PXL_2_0, 2,
  1105. (m->htotal / 2) + (m->hsync_start - m->hdisplay));
  1106. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_PXL_1_0, 2,
  1107. (m->htotal / 2) + (m->hsync_start - m->hdisplay));
  1108. hdmi_reg_writev(hdata, HDMI_TG_VACT_ST_L, 2,
  1109. (m->vtotal - m->vdisplay) / 2);
  1110. hdmi_reg_writev(hdata, HDMI_TG_VACT_SZ_L, 2, m->vdisplay / 2);
  1111. hdmi_reg_writev(hdata, HDMI_TG_VACT_ST2_L, 2,
  1112. m->vtotal - m->vdisplay / 2);
  1113. hdmi_reg_writev(hdata, HDMI_TG_VSYNC2_L, 2,
  1114. (m->vtotal / 2) + 1);
  1115. hdmi_reg_writev(hdata, HDMI_TG_VSYNC_BOT_HDMI_L, 2,
  1116. (m->vtotal / 2) + 1);
  1117. hdmi_reg_writev(hdata, HDMI_TG_FIELD_BOT_HDMI_L, 2,
  1118. (m->vtotal / 2) + 1);
  1119. hdmi_reg_writev(hdata, HDMI_TG_VACT_ST3_L, 2, 0x0);
  1120. hdmi_reg_writev(hdata, HDMI_TG_VACT_ST4_L, 2, 0x0);
  1121. } else {
  1122. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_BEF_2_0, 2,
  1123. m->vsync_end - m->vdisplay);
  1124. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_BEF_1_0, 2,
  1125. m->vsync_start - m->vdisplay);
  1126. hdmi_reg_writev(hdata, HDMI_V2_BLANK_0, 2, m->vtotal);
  1127. hdmi_reg_writev(hdata, HDMI_V1_BLANK_0, 2,
  1128. m->vtotal - m->vdisplay);
  1129. hdmi_reg_writev(hdata, HDMI_V_BLANK_F0_0, 2, 0xffff);
  1130. hdmi_reg_writev(hdata, HDMI_V_BLANK_F1_0, 2, 0xffff);
  1131. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_2_0, 2, 0xffff);
  1132. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_1_0, 2, 0xffff);
  1133. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_PXL_2_0, 2, 0xffff);
  1134. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_PXL_1_0, 2, 0xffff);
  1135. hdmi_reg_writev(hdata, HDMI_TG_VACT_ST_L, 2,
  1136. m->vtotal - m->vdisplay);
  1137. hdmi_reg_writev(hdata, HDMI_TG_VACT_SZ_L, 2, m->vdisplay);
  1138. }
  1139. hdmi_reg_writev(hdata, HDMI_H_SYNC_START_0, 2,
  1140. m->hsync_start - m->hdisplay - 2);
  1141. hdmi_reg_writev(hdata, HDMI_H_SYNC_END_0, 2,
  1142. m->hsync_end - m->hdisplay - 2);
  1143. hdmi_reg_writev(hdata, HDMI_VACT_SPACE_1_0, 2, 0xffff);
  1144. hdmi_reg_writev(hdata, HDMI_VACT_SPACE_2_0, 2, 0xffff);
  1145. hdmi_reg_writev(hdata, HDMI_VACT_SPACE_3_0, 2, 0xffff);
  1146. hdmi_reg_writev(hdata, HDMI_VACT_SPACE_4_0, 2, 0xffff);
  1147. hdmi_reg_writev(hdata, HDMI_VACT_SPACE_5_0, 2, 0xffff);
  1148. hdmi_reg_writev(hdata, HDMI_VACT_SPACE_6_0, 2, 0xffff);
  1149. hdmi_reg_writev(hdata, HDMI_V_BLANK_F2_0, 2, 0xffff);
  1150. hdmi_reg_writev(hdata, HDMI_V_BLANK_F3_0, 2, 0xffff);
  1151. hdmi_reg_writev(hdata, HDMI_V_BLANK_F4_0, 2, 0xffff);
  1152. hdmi_reg_writev(hdata, HDMI_V_BLANK_F5_0, 2, 0xffff);
  1153. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_3_0, 2, 0xffff);
  1154. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_4_0, 2, 0xffff);
  1155. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_5_0, 2, 0xffff);
  1156. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_6_0, 2, 0xffff);
  1157. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_PXL_3_0, 2, 0xffff);
  1158. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_PXL_4_0, 2, 0xffff);
  1159. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_PXL_5_0, 2, 0xffff);
  1160. hdmi_reg_writev(hdata, HDMI_V_SYNC_LINE_AFT_PXL_6_0, 2, 0xffff);
  1161. hdmi_reg_writev(hdata, HDMI_TG_H_FSZ_L, 2, m->htotal);
  1162. hdmi_reg_writev(hdata, HDMI_TG_HACT_ST_L, 2, m->htotal - m->hdisplay);
  1163. hdmi_reg_writev(hdata, HDMI_TG_HACT_SZ_L, 2, m->hdisplay);
  1164. hdmi_reg_writev(hdata, HDMI_TG_V_FSZ_L, 2, m->vtotal);
  1165. if (hdata->drv_data == &exynos5433_hdmi_driver_data)
  1166. hdmi_reg_writeb(hdata, HDMI_TG_DECON_EN, 1);
  1167. }
  1168. static void hdmi_mode_apply(struct hdmi_context *hdata)
  1169. {
  1170. if (hdata->drv_data->type == HDMI_TYPE13)
  1171. hdmi_v13_mode_apply(hdata);
  1172. else
  1173. hdmi_v14_mode_apply(hdata);
  1174. hdmi_start(hdata, true);
  1175. }
  1176. static void hdmiphy_conf_reset(struct hdmi_context *hdata)
  1177. {
  1178. hdmi_reg_writemask(hdata, HDMI_CORE_RSTOUT, 0, 1);
  1179. usleep_range(10000, 12000);
  1180. hdmi_reg_writemask(hdata, HDMI_CORE_RSTOUT, ~0, 1);
  1181. usleep_range(10000, 12000);
  1182. hdmi_reg_writemask(hdata, HDMI_PHY_RSTOUT, ~0, HDMI_PHY_SW_RSTOUT);
  1183. usleep_range(10000, 12000);
  1184. hdmi_reg_writemask(hdata, HDMI_PHY_RSTOUT, 0, HDMI_PHY_SW_RSTOUT);
  1185. usleep_range(10000, 12000);
  1186. }
  1187. static void hdmiphy_enable_mode_set(struct hdmi_context *hdata, bool enable)
  1188. {
  1189. u8 v = enable ? HDMI_PHY_ENABLE_MODE_SET : HDMI_PHY_DISABLE_MODE_SET;
  1190. if (hdata->drv_data == &exynos5433_hdmi_driver_data)
  1191. writel(v, hdata->regs_hdmiphy + HDMIPHY5433_MODE_SET_DONE);
  1192. }
  1193. static void hdmiphy_conf_apply(struct hdmi_context *hdata)
  1194. {
  1195. int ret;
  1196. const u8 *phy_conf;
  1197. ret = hdmi_find_phy_conf(hdata, hdata->current_mode.clock * 1000);
  1198. if (ret < 0) {
  1199. DRM_ERROR("failed to find hdmiphy conf\n");
  1200. return;
  1201. }
  1202. phy_conf = hdata->drv_data->phy_confs.data[ret].conf;
  1203. hdmi_clk_set_parents(hdata, false);
  1204. hdmiphy_conf_reset(hdata);
  1205. hdmiphy_enable_mode_set(hdata, true);
  1206. ret = hdmiphy_reg_write_buf(hdata, 0, phy_conf, 32);
  1207. if (ret) {
  1208. DRM_ERROR("failed to configure hdmiphy\n");
  1209. return;
  1210. }
  1211. hdmiphy_enable_mode_set(hdata, false);
  1212. hdmi_clk_set_parents(hdata, true);
  1213. usleep_range(10000, 12000);
  1214. hdmiphy_wait_for_pll(hdata);
  1215. }
  1216. static void hdmi_conf_apply(struct hdmi_context *hdata)
  1217. {
  1218. hdmi_start(hdata, false);
  1219. hdmi_conf_init(hdata);
  1220. hdmi_audio_init(hdata);
  1221. hdmi_mode_apply(hdata);
  1222. hdmi_audio_control(hdata, true);
  1223. }
  1224. static void hdmi_mode_set(struct drm_encoder *encoder,
  1225. struct drm_display_mode *mode,
  1226. struct drm_display_mode *adjusted_mode)
  1227. {
  1228. struct hdmi_context *hdata = encoder_to_hdmi(encoder);
  1229. struct drm_display_mode *m = adjusted_mode;
  1230. DRM_DEBUG_KMS("xres=%d, yres=%d, refresh=%d, intl=%s\n",
  1231. m->hdisplay, m->vdisplay,
  1232. m->vrefresh, (m->flags & DRM_MODE_FLAG_INTERLACE) ?
  1233. "INTERLACED" : "PROGRESSIVE");
  1234. drm_mode_copy(&hdata->current_mode, m);
  1235. }
  1236. static void hdmi_set_refclk(struct hdmi_context *hdata, bool on)
  1237. {
  1238. if (!hdata->sysreg)
  1239. return;
  1240. regmap_update_bits(hdata->sysreg, EXYNOS5433_SYSREG_DISP_HDMI_PHY,
  1241. SYSREG_HDMI_REFCLK_INT_CLK, on ? ~0 : 0);
  1242. }
  1243. static void hdmiphy_enable(struct hdmi_context *hdata)
  1244. {
  1245. if (hdata->powered)
  1246. return;
  1247. pm_runtime_get_sync(hdata->dev);
  1248. if (regulator_bulk_enable(ARRAY_SIZE(supply), hdata->regul_bulk))
  1249. DRM_DEBUG_KMS("failed to enable regulator bulk\n");
  1250. regmap_update_bits(hdata->pmureg, PMU_HDMI_PHY_CONTROL,
  1251. PMU_HDMI_PHY_ENABLE_BIT, 1);
  1252. hdmi_set_refclk(hdata, true);
  1253. hdmi_reg_writemask(hdata, HDMI_PHY_CON_0, 0, HDMI_PHY_POWER_OFF_EN);
  1254. hdmiphy_conf_apply(hdata);
  1255. hdata->powered = true;
  1256. }
  1257. static void hdmiphy_disable(struct hdmi_context *hdata)
  1258. {
  1259. if (!hdata->powered)
  1260. return;
  1261. hdmi_reg_writemask(hdata, HDMI_CON_0, 0, HDMI_EN);
  1262. hdmi_reg_writemask(hdata, HDMI_PHY_CON_0, ~0, HDMI_PHY_POWER_OFF_EN);
  1263. hdmi_set_refclk(hdata, false);
  1264. regmap_update_bits(hdata->pmureg, PMU_HDMI_PHY_CONTROL,
  1265. PMU_HDMI_PHY_ENABLE_BIT, 0);
  1266. regulator_bulk_disable(ARRAY_SIZE(supply), hdata->regul_bulk);
  1267. pm_runtime_put_sync(hdata->dev);
  1268. hdata->powered = false;
  1269. }
  1270. static void hdmi_enable(struct drm_encoder *encoder)
  1271. {
  1272. struct hdmi_context *hdata = encoder_to_hdmi(encoder);
  1273. hdmiphy_enable(hdata);
  1274. hdmi_conf_apply(hdata);
  1275. }
  1276. static void hdmi_disable(struct drm_encoder *encoder)
  1277. {
  1278. struct hdmi_context *hdata = encoder_to_hdmi(encoder);
  1279. struct drm_crtc *crtc = encoder->crtc;
  1280. const struct drm_crtc_helper_funcs *funcs = NULL;
  1281. if (!hdata->powered)
  1282. return;
  1283. /*
  1284. * The SFRs of VP and Mixer are updated by Vertical Sync of
  1285. * Timing generator which is a part of HDMI so the sequence
  1286. * to disable TV Subsystem should be as following,
  1287. * VP -> Mixer -> HDMI
  1288. *
  1289. * Below codes will try to disable Mixer and VP(if used)
  1290. * prior to disabling HDMI.
  1291. */
  1292. if (crtc)
  1293. funcs = crtc->helper_private;
  1294. if (funcs && funcs->disable)
  1295. (*funcs->disable)(crtc);
  1296. cancel_delayed_work(&hdata->hotplug_work);
  1297. hdmiphy_disable(hdata);
  1298. }
  1299. static const struct drm_encoder_helper_funcs exynos_hdmi_encoder_helper_funcs = {
  1300. .mode_fixup = hdmi_mode_fixup,
  1301. .mode_set = hdmi_mode_set,
  1302. .enable = hdmi_enable,
  1303. .disable = hdmi_disable,
  1304. };
  1305. static const struct drm_encoder_funcs exynos_hdmi_encoder_funcs = {
  1306. .destroy = drm_encoder_cleanup,
  1307. };
  1308. static void hdmi_hotplug_work_func(struct work_struct *work)
  1309. {
  1310. struct hdmi_context *hdata;
  1311. hdata = container_of(work, struct hdmi_context, hotplug_work.work);
  1312. if (hdata->drm_dev)
  1313. drm_helper_hpd_irq_event(hdata->drm_dev);
  1314. }
  1315. static irqreturn_t hdmi_irq_thread(int irq, void *arg)
  1316. {
  1317. struct hdmi_context *hdata = arg;
  1318. mod_delayed_work(system_wq, &hdata->hotplug_work,
  1319. msecs_to_jiffies(HOTPLUG_DEBOUNCE_MS));
  1320. return IRQ_HANDLED;
  1321. }
  1322. static int hdmi_clks_get(struct hdmi_context *hdata,
  1323. const struct string_array_spec *names,
  1324. struct clk **clks)
  1325. {
  1326. struct device *dev = hdata->dev;
  1327. int i;
  1328. for (i = 0; i < names->count; ++i) {
  1329. struct clk *clk = devm_clk_get(dev, names->data[i]);
  1330. if (IS_ERR(clk)) {
  1331. int ret = PTR_ERR(clk);
  1332. dev_err(dev, "Cannot get clock %s, %d\n",
  1333. names->data[i], ret);
  1334. return ret;
  1335. }
  1336. clks[i] = clk;
  1337. }
  1338. return 0;
  1339. }
  1340. static int hdmi_clk_init(struct hdmi_context *hdata)
  1341. {
  1342. const struct hdmi_driver_data *drv_data = hdata->drv_data;
  1343. int count = drv_data->clk_gates.count + drv_data->clk_muxes.count;
  1344. struct device *dev = hdata->dev;
  1345. struct clk **clks;
  1346. int ret;
  1347. if (!count)
  1348. return 0;
  1349. clks = devm_kzalloc(dev, sizeof(*clks) * count, GFP_KERNEL);
  1350. if (!clks)
  1351. return -ENOMEM;
  1352. hdata->clk_gates = clks;
  1353. hdata->clk_muxes = clks + drv_data->clk_gates.count;
  1354. ret = hdmi_clks_get(hdata, &drv_data->clk_gates, hdata->clk_gates);
  1355. if (ret)
  1356. return ret;
  1357. return hdmi_clks_get(hdata, &drv_data->clk_muxes, hdata->clk_muxes);
  1358. }
  1359. static void hdmiphy_clk_enable(struct exynos_drm_clk *clk, bool enable)
  1360. {
  1361. struct hdmi_context *hdata = container_of(clk, struct hdmi_context,
  1362. phy_clk);
  1363. if (enable)
  1364. hdmiphy_enable(hdata);
  1365. else
  1366. hdmiphy_disable(hdata);
  1367. }
  1368. static int hdmi_resources_init(struct hdmi_context *hdata)
  1369. {
  1370. struct device *dev = hdata->dev;
  1371. int i, ret;
  1372. DRM_DEBUG_KMS("HDMI resource init\n");
  1373. hdata->hpd_gpio = devm_gpiod_get(dev, "hpd", GPIOD_IN);
  1374. if (IS_ERR(hdata->hpd_gpio)) {
  1375. DRM_ERROR("cannot get hpd gpio property\n");
  1376. return PTR_ERR(hdata->hpd_gpio);
  1377. }
  1378. hdata->irq = gpiod_to_irq(hdata->hpd_gpio);
  1379. if (hdata->irq < 0) {
  1380. DRM_ERROR("failed to get GPIO irq\n");
  1381. return hdata->irq;
  1382. }
  1383. ret = hdmi_clk_init(hdata);
  1384. if (ret)
  1385. return ret;
  1386. ret = hdmi_clk_set_parents(hdata, false);
  1387. if (ret)
  1388. return ret;
  1389. for (i = 0; i < ARRAY_SIZE(supply); ++i)
  1390. hdata->regul_bulk[i].supply = supply[i];
  1391. ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(supply), hdata->regul_bulk);
  1392. if (ret) {
  1393. if (ret != -EPROBE_DEFER)
  1394. DRM_ERROR("failed to get regulators\n");
  1395. return ret;
  1396. }
  1397. hdata->reg_hdmi_en = devm_regulator_get_optional(dev, "hdmi-en");
  1398. if (PTR_ERR(hdata->reg_hdmi_en) == -ENODEV)
  1399. return 0;
  1400. if (IS_ERR(hdata->reg_hdmi_en))
  1401. return PTR_ERR(hdata->reg_hdmi_en);
  1402. ret = regulator_enable(hdata->reg_hdmi_en);
  1403. if (ret)
  1404. DRM_ERROR("failed to enable hdmi-en regulator\n");
  1405. return ret;
  1406. }
  1407. static struct of_device_id hdmi_match_types[] = {
  1408. {
  1409. .compatible = "samsung,exynos4210-hdmi",
  1410. .data = &exynos4210_hdmi_driver_data,
  1411. }, {
  1412. .compatible = "samsung,exynos4212-hdmi",
  1413. .data = &exynos4212_hdmi_driver_data,
  1414. }, {
  1415. .compatible = "samsung,exynos5420-hdmi",
  1416. .data = &exynos5420_hdmi_driver_data,
  1417. }, {
  1418. .compatible = "samsung,exynos5433-hdmi",
  1419. .data = &exynos5433_hdmi_driver_data,
  1420. }, {
  1421. /* end node */
  1422. }
  1423. };
  1424. MODULE_DEVICE_TABLE (of, hdmi_match_types);
  1425. static int hdmi_bind(struct device *dev, struct device *master, void *data)
  1426. {
  1427. struct drm_device *drm_dev = data;
  1428. struct hdmi_context *hdata = dev_get_drvdata(dev);
  1429. struct drm_encoder *encoder = &hdata->encoder;
  1430. int ret, pipe;
  1431. hdata->drm_dev = drm_dev;
  1432. pipe = exynos_drm_crtc_get_pipe_from_type(drm_dev,
  1433. EXYNOS_DISPLAY_TYPE_HDMI);
  1434. if (pipe < 0)
  1435. return pipe;
  1436. hdata->phy_clk.enable = hdmiphy_clk_enable;
  1437. exynos_drm_crtc_from_pipe(drm_dev, pipe)->pipe_clk = &hdata->phy_clk;
  1438. encoder->possible_crtcs = 1 << pipe;
  1439. DRM_DEBUG_KMS("possible_crtcs = 0x%x\n", encoder->possible_crtcs);
  1440. drm_encoder_init(drm_dev, encoder, &exynos_hdmi_encoder_funcs,
  1441. DRM_MODE_ENCODER_TMDS, NULL);
  1442. drm_encoder_helper_add(encoder, &exynos_hdmi_encoder_helper_funcs);
  1443. ret = hdmi_create_connector(encoder);
  1444. if (ret) {
  1445. DRM_ERROR("failed to create connector ret = %d\n", ret);
  1446. drm_encoder_cleanup(encoder);
  1447. return ret;
  1448. }
  1449. return 0;
  1450. }
  1451. static void hdmi_unbind(struct device *dev, struct device *master, void *data)
  1452. {
  1453. }
  1454. static const struct component_ops hdmi_component_ops = {
  1455. .bind = hdmi_bind,
  1456. .unbind = hdmi_unbind,
  1457. };
  1458. static int hdmi_get_ddc_adapter(struct hdmi_context *hdata)
  1459. {
  1460. const char *compatible_str = "samsung,exynos4210-hdmiddc";
  1461. struct device_node *np;
  1462. struct i2c_adapter *adpt;
  1463. np = of_find_compatible_node(NULL, NULL, compatible_str);
  1464. if (np)
  1465. np = of_get_next_parent(np);
  1466. else
  1467. np = of_parse_phandle(hdata->dev->of_node, "ddc", 0);
  1468. if (!np) {
  1469. DRM_ERROR("Failed to find ddc node in device tree\n");
  1470. return -ENODEV;
  1471. }
  1472. adpt = of_find_i2c_adapter_by_node(np);
  1473. of_node_put(np);
  1474. if (!adpt) {
  1475. DRM_INFO("Failed to get ddc i2c adapter by node\n");
  1476. return -EPROBE_DEFER;
  1477. }
  1478. hdata->ddc_adpt = adpt;
  1479. return 0;
  1480. }
  1481. static int hdmi_get_phy_io(struct hdmi_context *hdata)
  1482. {
  1483. const char *compatible_str = "samsung,exynos4212-hdmiphy";
  1484. struct device_node *np;
  1485. int ret = 0;
  1486. np = of_find_compatible_node(NULL, NULL, compatible_str);
  1487. if (!np) {
  1488. np = of_parse_phandle(hdata->dev->of_node, "phy", 0);
  1489. if (!np) {
  1490. DRM_ERROR("Failed to find hdmiphy node in device tree\n");
  1491. return -ENODEV;
  1492. }
  1493. }
  1494. if (hdata->drv_data->is_apb_phy) {
  1495. hdata->regs_hdmiphy = of_iomap(np, 0);
  1496. if (!hdata->regs_hdmiphy) {
  1497. DRM_ERROR("failed to ioremap hdmi phy\n");
  1498. ret = -ENOMEM;
  1499. goto out;
  1500. }
  1501. } else {
  1502. hdata->hdmiphy_port = of_find_i2c_device_by_node(np);
  1503. if (!hdata->hdmiphy_port) {
  1504. DRM_INFO("Failed to get hdmi phy i2c client\n");
  1505. ret = -EPROBE_DEFER;
  1506. goto out;
  1507. }
  1508. }
  1509. out:
  1510. of_node_put(np);
  1511. return ret;
  1512. }
  1513. static int hdmi_probe(struct platform_device *pdev)
  1514. {
  1515. struct device *dev = &pdev->dev;
  1516. struct hdmi_context *hdata;
  1517. struct resource *res;
  1518. int ret;
  1519. hdata = devm_kzalloc(dev, sizeof(struct hdmi_context), GFP_KERNEL);
  1520. if (!hdata)
  1521. return -ENOMEM;
  1522. hdata->drv_data = of_device_get_match_data(dev);
  1523. platform_set_drvdata(pdev, hdata);
  1524. hdata->dev = dev;
  1525. ret = hdmi_resources_init(hdata);
  1526. if (ret) {
  1527. if (ret != -EPROBE_DEFER)
  1528. DRM_ERROR("hdmi_resources_init failed\n");
  1529. return ret;
  1530. }
  1531. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  1532. hdata->regs = devm_ioremap_resource(dev, res);
  1533. if (IS_ERR(hdata->regs)) {
  1534. ret = PTR_ERR(hdata->regs);
  1535. return ret;
  1536. }
  1537. ret = hdmi_get_ddc_adapter(hdata);
  1538. if (ret)
  1539. return ret;
  1540. ret = hdmi_get_phy_io(hdata);
  1541. if (ret)
  1542. goto err_ddc;
  1543. INIT_DELAYED_WORK(&hdata->hotplug_work, hdmi_hotplug_work_func);
  1544. ret = devm_request_threaded_irq(dev, hdata->irq, NULL,
  1545. hdmi_irq_thread, IRQF_TRIGGER_RISING |
  1546. IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
  1547. "hdmi", hdata);
  1548. if (ret) {
  1549. DRM_ERROR("failed to register hdmi interrupt\n");
  1550. goto err_hdmiphy;
  1551. }
  1552. hdata->pmureg = syscon_regmap_lookup_by_phandle(dev->of_node,
  1553. "samsung,syscon-phandle");
  1554. if (IS_ERR(hdata->pmureg)) {
  1555. DRM_ERROR("syscon regmap lookup failed.\n");
  1556. ret = -EPROBE_DEFER;
  1557. goto err_hdmiphy;
  1558. }
  1559. if (hdata->drv_data->has_sysreg) {
  1560. hdata->sysreg = syscon_regmap_lookup_by_phandle(dev->of_node,
  1561. "samsung,sysreg-phandle");
  1562. if (IS_ERR(hdata->sysreg)) {
  1563. DRM_ERROR("sysreg regmap lookup failed.\n");
  1564. ret = -EPROBE_DEFER;
  1565. goto err_hdmiphy;
  1566. }
  1567. }
  1568. pm_runtime_enable(dev);
  1569. ret = component_add(&pdev->dev, &hdmi_component_ops);
  1570. if (ret)
  1571. goto err_disable_pm_runtime;
  1572. return ret;
  1573. err_disable_pm_runtime:
  1574. pm_runtime_disable(dev);
  1575. err_hdmiphy:
  1576. if (hdata->hdmiphy_port)
  1577. put_device(&hdata->hdmiphy_port->dev);
  1578. if (hdata->regs_hdmiphy)
  1579. iounmap(hdata->regs_hdmiphy);
  1580. err_ddc:
  1581. put_device(&hdata->ddc_adpt->dev);
  1582. return ret;
  1583. }
  1584. static int hdmi_remove(struct platform_device *pdev)
  1585. {
  1586. struct hdmi_context *hdata = platform_get_drvdata(pdev);
  1587. cancel_delayed_work_sync(&hdata->hotplug_work);
  1588. component_del(&pdev->dev, &hdmi_component_ops);
  1589. pm_runtime_disable(&pdev->dev);
  1590. if (!IS_ERR(hdata->reg_hdmi_en))
  1591. regulator_disable(hdata->reg_hdmi_en);
  1592. if (hdata->hdmiphy_port)
  1593. put_device(&hdata->hdmiphy_port->dev);
  1594. if (hdata->regs_hdmiphy)
  1595. iounmap(hdata->regs_hdmiphy);
  1596. put_device(&hdata->ddc_adpt->dev);
  1597. return 0;
  1598. }
  1599. #ifdef CONFIG_PM
  1600. static int exynos_hdmi_suspend(struct device *dev)
  1601. {
  1602. struct hdmi_context *hdata = dev_get_drvdata(dev);
  1603. hdmi_clk_disable_gates(hdata);
  1604. return 0;
  1605. }
  1606. static int exynos_hdmi_resume(struct device *dev)
  1607. {
  1608. struct hdmi_context *hdata = dev_get_drvdata(dev);
  1609. int ret;
  1610. ret = hdmi_clk_enable_gates(hdata);
  1611. if (ret < 0)
  1612. return ret;
  1613. return 0;
  1614. }
  1615. #endif
  1616. static const struct dev_pm_ops exynos_hdmi_pm_ops = {
  1617. SET_RUNTIME_PM_OPS(exynos_hdmi_suspend, exynos_hdmi_resume, NULL)
  1618. };
  1619. struct platform_driver hdmi_driver = {
  1620. .probe = hdmi_probe,
  1621. .remove = hdmi_remove,
  1622. .driver = {
  1623. .name = "exynos-hdmi",
  1624. .owner = THIS_MODULE,
  1625. .pm = &exynos_hdmi_pm_ops,
  1626. .of_match_table = hdmi_match_types,
  1627. },
  1628. };