imx-tve.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729
  1. /*
  2. * i.MX drm driver - Television Encoder (TVEv2)
  3. *
  4. * Copyright (C) 2013 Philipp Zabel, Pengutronix
  5. *
  6. * This program is free software; you can redistribute it and/or
  7. * modify it under the terms of the GNU General Public License
  8. * as published by the Free Software Foundation; either version 2
  9. * of the License, or (at your option) any later version.
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. */
  15. #include <linux/clk.h>
  16. #include <linux/clk-provider.h>
  17. #include <linux/component.h>
  18. #include <linux/module.h>
  19. #include <linux/i2c.h>
  20. #include <linux/regmap.h>
  21. #include <linux/regulator/consumer.h>
  22. #include <linux/spinlock.h>
  23. #include <linux/videodev2.h>
  24. #include <drm/drmP.h>
  25. #include <drm/drm_atomic_helper.h>
  26. #include <drm/drm_fb_helper.h>
  27. #include <drm/drm_crtc_helper.h>
  28. #include <video/imx-ipu-v3.h>
  29. #include "imx-drm.h"
  30. #define TVE_COM_CONF_REG 0x00
  31. #define TVE_TVDAC0_CONT_REG 0x28
  32. #define TVE_TVDAC1_CONT_REG 0x2c
  33. #define TVE_TVDAC2_CONT_REG 0x30
  34. #define TVE_CD_CONT_REG 0x34
  35. #define TVE_INT_CONT_REG 0x64
  36. #define TVE_STAT_REG 0x68
  37. #define TVE_TST_MODE_REG 0x6c
  38. #define TVE_MV_CONT_REG 0xdc
  39. /* TVE_COM_CONF_REG */
  40. #define TVE_SYNC_CH_2_EN BIT(22)
  41. #define TVE_SYNC_CH_1_EN BIT(21)
  42. #define TVE_SYNC_CH_0_EN BIT(20)
  43. #define TVE_TV_OUT_MODE_MASK (0x7 << 12)
  44. #define TVE_TV_OUT_DISABLE (0x0 << 12)
  45. #define TVE_TV_OUT_CVBS_0 (0x1 << 12)
  46. #define TVE_TV_OUT_CVBS_2 (0x2 << 12)
  47. #define TVE_TV_OUT_CVBS_0_2 (0x3 << 12)
  48. #define TVE_TV_OUT_SVIDEO_0_1 (0x4 << 12)
  49. #define TVE_TV_OUT_SVIDEO_0_1_CVBS2_2 (0x5 << 12)
  50. #define TVE_TV_OUT_YPBPR (0x6 << 12)
  51. #define TVE_TV_OUT_RGB (0x7 << 12)
  52. #define TVE_TV_STAND_MASK (0xf << 8)
  53. #define TVE_TV_STAND_HD_1080P30 (0xc << 8)
  54. #define TVE_P2I_CONV_EN BIT(7)
  55. #define TVE_INP_VIDEO_FORM BIT(6)
  56. #define TVE_INP_YCBCR_422 (0x0 << 6)
  57. #define TVE_INP_YCBCR_444 (0x1 << 6)
  58. #define TVE_DATA_SOURCE_MASK (0x3 << 4)
  59. #define TVE_DATA_SOURCE_BUS1 (0x0 << 4)
  60. #define TVE_DATA_SOURCE_BUS2 (0x1 << 4)
  61. #define TVE_DATA_SOURCE_EXT (0x2 << 4)
  62. #define TVE_DATA_SOURCE_TESTGEN (0x3 << 4)
  63. #define TVE_IPU_CLK_EN_OFS 3
  64. #define TVE_IPU_CLK_EN BIT(3)
  65. #define TVE_DAC_SAMP_RATE_OFS 1
  66. #define TVE_DAC_SAMP_RATE_WIDTH 2
  67. #define TVE_DAC_SAMP_RATE_MASK (0x3 << 1)
  68. #define TVE_DAC_FULL_RATE (0x0 << 1)
  69. #define TVE_DAC_DIV2_RATE (0x1 << 1)
  70. #define TVE_DAC_DIV4_RATE (0x2 << 1)
  71. #define TVE_EN BIT(0)
  72. /* TVE_TVDACx_CONT_REG */
  73. #define TVE_TVDAC_GAIN_MASK (0x3f << 0)
  74. /* TVE_CD_CONT_REG */
  75. #define TVE_CD_CH_2_SM_EN BIT(22)
  76. #define TVE_CD_CH_1_SM_EN BIT(21)
  77. #define TVE_CD_CH_0_SM_EN BIT(20)
  78. #define TVE_CD_CH_2_LM_EN BIT(18)
  79. #define TVE_CD_CH_1_LM_EN BIT(17)
  80. #define TVE_CD_CH_0_LM_EN BIT(16)
  81. #define TVE_CD_CH_2_REF_LVL BIT(10)
  82. #define TVE_CD_CH_1_REF_LVL BIT(9)
  83. #define TVE_CD_CH_0_REF_LVL BIT(8)
  84. #define TVE_CD_EN BIT(0)
  85. /* TVE_INT_CONT_REG */
  86. #define TVE_FRAME_END_IEN BIT(13)
  87. #define TVE_CD_MON_END_IEN BIT(2)
  88. #define TVE_CD_SM_IEN BIT(1)
  89. #define TVE_CD_LM_IEN BIT(0)
  90. /* TVE_TST_MODE_REG */
  91. #define TVE_TVDAC_TEST_MODE_MASK (0x7 << 0)
  92. #define IMX_TVE_DAC_VOLTAGE 2750000
  93. enum {
  94. TVE_MODE_TVOUT,
  95. TVE_MODE_VGA,
  96. };
  97. struct imx_tve {
  98. struct drm_connector connector;
  99. struct drm_encoder encoder;
  100. struct device *dev;
  101. spinlock_t lock; /* register lock */
  102. bool enabled;
  103. int mode;
  104. int di_hsync_pin;
  105. int di_vsync_pin;
  106. struct regmap *regmap;
  107. struct regulator *dac_reg;
  108. struct i2c_adapter *ddc;
  109. struct clk *clk;
  110. struct clk *di_sel_clk;
  111. struct clk_hw clk_hw_di;
  112. struct clk *di_clk;
  113. };
  114. static inline struct imx_tve *con_to_tve(struct drm_connector *c)
  115. {
  116. return container_of(c, struct imx_tve, connector);
  117. }
  118. static inline struct imx_tve *enc_to_tve(struct drm_encoder *e)
  119. {
  120. return container_of(e, struct imx_tve, encoder);
  121. }
  122. static void tve_lock(void *__tve)
  123. __acquires(&tve->lock)
  124. {
  125. struct imx_tve *tve = __tve;
  126. spin_lock(&tve->lock);
  127. }
  128. static void tve_unlock(void *__tve)
  129. __releases(&tve->lock)
  130. {
  131. struct imx_tve *tve = __tve;
  132. spin_unlock(&tve->lock);
  133. }
  134. static void tve_enable(struct imx_tve *tve)
  135. {
  136. int ret;
  137. if (!tve->enabled) {
  138. tve->enabled = true;
  139. clk_prepare_enable(tve->clk);
  140. ret = regmap_update_bits(tve->regmap, TVE_COM_CONF_REG,
  141. TVE_EN, TVE_EN);
  142. }
  143. /* clear interrupt status register */
  144. regmap_write(tve->regmap, TVE_STAT_REG, 0xffffffff);
  145. /* cable detection irq disabled in VGA mode, enabled in TVOUT mode */
  146. if (tve->mode == TVE_MODE_VGA)
  147. regmap_write(tve->regmap, TVE_INT_CONT_REG, 0);
  148. else
  149. regmap_write(tve->regmap, TVE_INT_CONT_REG,
  150. TVE_CD_SM_IEN |
  151. TVE_CD_LM_IEN |
  152. TVE_CD_MON_END_IEN);
  153. }
  154. static void tve_disable(struct imx_tve *tve)
  155. {
  156. int ret;
  157. if (tve->enabled) {
  158. tve->enabled = false;
  159. ret = regmap_update_bits(tve->regmap, TVE_COM_CONF_REG,
  160. TVE_EN, 0);
  161. clk_disable_unprepare(tve->clk);
  162. }
  163. }
  164. static int tve_setup_tvout(struct imx_tve *tve)
  165. {
  166. return -ENOTSUPP;
  167. }
  168. static int tve_setup_vga(struct imx_tve *tve)
  169. {
  170. unsigned int mask;
  171. unsigned int val;
  172. int ret;
  173. /* set gain to (1 + 10/128) to provide 0.7V peak-to-peak amplitude */
  174. ret = regmap_update_bits(tve->regmap, TVE_TVDAC0_CONT_REG,
  175. TVE_TVDAC_GAIN_MASK, 0x0a);
  176. if (ret)
  177. return ret;
  178. ret = regmap_update_bits(tve->regmap, TVE_TVDAC1_CONT_REG,
  179. TVE_TVDAC_GAIN_MASK, 0x0a);
  180. if (ret)
  181. return ret;
  182. ret = regmap_update_bits(tve->regmap, TVE_TVDAC2_CONT_REG,
  183. TVE_TVDAC_GAIN_MASK, 0x0a);
  184. if (ret)
  185. return ret;
  186. /* set configuration register */
  187. mask = TVE_DATA_SOURCE_MASK | TVE_INP_VIDEO_FORM;
  188. val = TVE_DATA_SOURCE_BUS2 | TVE_INP_YCBCR_444;
  189. mask |= TVE_TV_STAND_MASK | TVE_P2I_CONV_EN;
  190. val |= TVE_TV_STAND_HD_1080P30 | 0;
  191. mask |= TVE_TV_OUT_MODE_MASK | TVE_SYNC_CH_0_EN;
  192. val |= TVE_TV_OUT_RGB | TVE_SYNC_CH_0_EN;
  193. ret = regmap_update_bits(tve->regmap, TVE_COM_CONF_REG, mask, val);
  194. if (ret)
  195. return ret;
  196. /* set test mode (as documented) */
  197. return regmap_update_bits(tve->regmap, TVE_TST_MODE_REG,
  198. TVE_TVDAC_TEST_MODE_MASK, 1);
  199. }
  200. static enum drm_connector_status imx_tve_connector_detect(
  201. struct drm_connector *connector, bool force)
  202. {
  203. return connector_status_connected;
  204. }
  205. static int imx_tve_connector_get_modes(struct drm_connector *connector)
  206. {
  207. struct imx_tve *tve = con_to_tve(connector);
  208. struct edid *edid;
  209. int ret = 0;
  210. if (!tve->ddc)
  211. return 0;
  212. edid = drm_get_edid(connector, tve->ddc);
  213. if (edid) {
  214. drm_mode_connector_update_edid_property(connector, edid);
  215. ret = drm_add_edid_modes(connector, edid);
  216. kfree(edid);
  217. }
  218. return ret;
  219. }
  220. static int imx_tve_connector_mode_valid(struct drm_connector *connector,
  221. struct drm_display_mode *mode)
  222. {
  223. struct imx_tve *tve = con_to_tve(connector);
  224. unsigned long rate;
  225. /* pixel clock with 2x oversampling */
  226. rate = clk_round_rate(tve->clk, 2000UL * mode->clock) / 2000;
  227. if (rate == mode->clock)
  228. return MODE_OK;
  229. /* pixel clock without oversampling */
  230. rate = clk_round_rate(tve->clk, 1000UL * mode->clock) / 1000;
  231. if (rate == mode->clock)
  232. return MODE_OK;
  233. dev_warn(tve->dev, "ignoring mode %dx%d\n",
  234. mode->hdisplay, mode->vdisplay);
  235. return MODE_BAD;
  236. }
  237. static struct drm_encoder *imx_tve_connector_best_encoder(
  238. struct drm_connector *connector)
  239. {
  240. struct imx_tve *tve = con_to_tve(connector);
  241. return &tve->encoder;
  242. }
  243. static void imx_tve_encoder_mode_set(struct drm_encoder *encoder,
  244. struct drm_display_mode *orig_mode,
  245. struct drm_display_mode *mode)
  246. {
  247. struct imx_tve *tve = enc_to_tve(encoder);
  248. unsigned long rounded_rate;
  249. unsigned long rate;
  250. int div = 1;
  251. int ret;
  252. /*
  253. * FIXME
  254. * we should try 4k * mode->clock first,
  255. * and enable 4x oversampling for lower resolutions
  256. */
  257. rate = 2000UL * mode->clock;
  258. clk_set_rate(tve->clk, rate);
  259. rounded_rate = clk_get_rate(tve->clk);
  260. if (rounded_rate >= rate)
  261. div = 2;
  262. clk_set_rate(tve->di_clk, rounded_rate / div);
  263. ret = clk_set_parent(tve->di_sel_clk, tve->di_clk);
  264. if (ret < 0) {
  265. dev_err(tve->dev, "failed to set di_sel parent to tve_di: %d\n",
  266. ret);
  267. }
  268. regmap_update_bits(tve->regmap, TVE_COM_CONF_REG,
  269. TVE_IPU_CLK_EN, TVE_IPU_CLK_EN);
  270. if (tve->mode == TVE_MODE_VGA)
  271. ret = tve_setup_vga(tve);
  272. else
  273. ret = tve_setup_tvout(tve);
  274. if (ret)
  275. dev_err(tve->dev, "failed to set configuration: %d\n", ret);
  276. }
  277. static void imx_tve_encoder_enable(struct drm_encoder *encoder)
  278. {
  279. struct imx_tve *tve = enc_to_tve(encoder);
  280. tve_enable(tve);
  281. }
  282. static void imx_tve_encoder_disable(struct drm_encoder *encoder)
  283. {
  284. struct imx_tve *tve = enc_to_tve(encoder);
  285. tve_disable(tve);
  286. }
  287. static int imx_tve_atomic_check(struct drm_encoder *encoder,
  288. struct drm_crtc_state *crtc_state,
  289. struct drm_connector_state *conn_state)
  290. {
  291. struct imx_crtc_state *imx_crtc_state = to_imx_crtc_state(crtc_state);
  292. struct imx_tve *tve = enc_to_tve(encoder);
  293. imx_crtc_state->bus_format = MEDIA_BUS_FMT_GBR888_1X24;
  294. imx_crtc_state->di_hsync_pin = tve->di_hsync_pin;
  295. imx_crtc_state->di_vsync_pin = tve->di_vsync_pin;
  296. return 0;
  297. }
  298. static const struct drm_connector_funcs imx_tve_connector_funcs = {
  299. .dpms = drm_atomic_helper_connector_dpms,
  300. .fill_modes = drm_helper_probe_single_connector_modes,
  301. .detect = imx_tve_connector_detect,
  302. .destroy = imx_drm_connector_destroy,
  303. .reset = drm_atomic_helper_connector_reset,
  304. .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
  305. .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
  306. };
  307. static const struct drm_connector_helper_funcs imx_tve_connector_helper_funcs = {
  308. .get_modes = imx_tve_connector_get_modes,
  309. .best_encoder = imx_tve_connector_best_encoder,
  310. .mode_valid = imx_tve_connector_mode_valid,
  311. };
  312. static const struct drm_encoder_funcs imx_tve_encoder_funcs = {
  313. .destroy = imx_drm_encoder_destroy,
  314. };
  315. static const struct drm_encoder_helper_funcs imx_tve_encoder_helper_funcs = {
  316. .mode_set = imx_tve_encoder_mode_set,
  317. .enable = imx_tve_encoder_enable,
  318. .disable = imx_tve_encoder_disable,
  319. .atomic_check = imx_tve_atomic_check,
  320. };
  321. static irqreturn_t imx_tve_irq_handler(int irq, void *data)
  322. {
  323. struct imx_tve *tve = data;
  324. unsigned int val;
  325. regmap_read(tve->regmap, TVE_STAT_REG, &val);
  326. /* clear interrupt status register */
  327. regmap_write(tve->regmap, TVE_STAT_REG, 0xffffffff);
  328. return IRQ_HANDLED;
  329. }
  330. static unsigned long clk_tve_di_recalc_rate(struct clk_hw *hw,
  331. unsigned long parent_rate)
  332. {
  333. struct imx_tve *tve = container_of(hw, struct imx_tve, clk_hw_di);
  334. unsigned int val;
  335. int ret;
  336. ret = regmap_read(tve->regmap, TVE_COM_CONF_REG, &val);
  337. if (ret < 0)
  338. return 0;
  339. switch (val & TVE_DAC_SAMP_RATE_MASK) {
  340. case TVE_DAC_DIV4_RATE:
  341. return parent_rate / 4;
  342. case TVE_DAC_DIV2_RATE:
  343. return parent_rate / 2;
  344. case TVE_DAC_FULL_RATE:
  345. default:
  346. return parent_rate;
  347. }
  348. return 0;
  349. }
  350. static long clk_tve_di_round_rate(struct clk_hw *hw, unsigned long rate,
  351. unsigned long *prate)
  352. {
  353. unsigned long div;
  354. div = *prate / rate;
  355. if (div >= 4)
  356. return *prate / 4;
  357. else if (div >= 2)
  358. return *prate / 2;
  359. return *prate;
  360. }
  361. static int clk_tve_di_set_rate(struct clk_hw *hw, unsigned long rate,
  362. unsigned long parent_rate)
  363. {
  364. struct imx_tve *tve = container_of(hw, struct imx_tve, clk_hw_di);
  365. unsigned long div;
  366. u32 val;
  367. int ret;
  368. div = parent_rate / rate;
  369. if (div >= 4)
  370. val = TVE_DAC_DIV4_RATE;
  371. else if (div >= 2)
  372. val = TVE_DAC_DIV2_RATE;
  373. else
  374. val = TVE_DAC_FULL_RATE;
  375. ret = regmap_update_bits(tve->regmap, TVE_COM_CONF_REG,
  376. TVE_DAC_SAMP_RATE_MASK, val);
  377. if (ret < 0) {
  378. dev_err(tve->dev, "failed to set divider: %d\n", ret);
  379. return ret;
  380. }
  381. return 0;
  382. }
  383. static struct clk_ops clk_tve_di_ops = {
  384. .round_rate = clk_tve_di_round_rate,
  385. .set_rate = clk_tve_di_set_rate,
  386. .recalc_rate = clk_tve_di_recalc_rate,
  387. };
  388. static int tve_clk_init(struct imx_tve *tve, void __iomem *base)
  389. {
  390. const char *tve_di_parent[1];
  391. struct clk_init_data init = {
  392. .name = "tve_di",
  393. .ops = &clk_tve_di_ops,
  394. .num_parents = 1,
  395. .flags = 0,
  396. };
  397. tve_di_parent[0] = __clk_get_name(tve->clk);
  398. init.parent_names = (const char **)&tve_di_parent;
  399. tve->clk_hw_di.init = &init;
  400. tve->di_clk = clk_register(tve->dev, &tve->clk_hw_di);
  401. if (IS_ERR(tve->di_clk)) {
  402. dev_err(tve->dev, "failed to register TVE output clock: %ld\n",
  403. PTR_ERR(tve->di_clk));
  404. return PTR_ERR(tve->di_clk);
  405. }
  406. return 0;
  407. }
  408. static int imx_tve_register(struct drm_device *drm, struct imx_tve *tve)
  409. {
  410. int encoder_type;
  411. int ret;
  412. encoder_type = tve->mode == TVE_MODE_VGA ?
  413. DRM_MODE_ENCODER_DAC : DRM_MODE_ENCODER_TVDAC;
  414. ret = imx_drm_encoder_parse_of(drm, &tve->encoder, tve->dev->of_node);
  415. if (ret)
  416. return ret;
  417. drm_encoder_helper_add(&tve->encoder, &imx_tve_encoder_helper_funcs);
  418. drm_encoder_init(drm, &tve->encoder, &imx_tve_encoder_funcs,
  419. encoder_type, NULL);
  420. drm_connector_helper_add(&tve->connector,
  421. &imx_tve_connector_helper_funcs);
  422. drm_connector_init(drm, &tve->connector, &imx_tve_connector_funcs,
  423. DRM_MODE_CONNECTOR_VGA);
  424. drm_mode_connector_attach_encoder(&tve->connector, &tve->encoder);
  425. return 0;
  426. }
  427. static bool imx_tve_readable_reg(struct device *dev, unsigned int reg)
  428. {
  429. return (reg % 4 == 0) && (reg <= 0xdc);
  430. }
  431. static struct regmap_config tve_regmap_config = {
  432. .reg_bits = 32,
  433. .val_bits = 32,
  434. .reg_stride = 4,
  435. .readable_reg = imx_tve_readable_reg,
  436. .lock = tve_lock,
  437. .unlock = tve_unlock,
  438. .max_register = 0xdc,
  439. };
  440. static const char * const imx_tve_modes[] = {
  441. [TVE_MODE_TVOUT] = "tvout",
  442. [TVE_MODE_VGA] = "vga",
  443. };
  444. static const int of_get_tve_mode(struct device_node *np)
  445. {
  446. const char *bm;
  447. int ret, i;
  448. ret = of_property_read_string(np, "fsl,tve-mode", &bm);
  449. if (ret < 0)
  450. return ret;
  451. for (i = 0; i < ARRAY_SIZE(imx_tve_modes); i++)
  452. if (!strcasecmp(bm, imx_tve_modes[i]))
  453. return i;
  454. return -EINVAL;
  455. }
  456. static int imx_tve_bind(struct device *dev, struct device *master, void *data)
  457. {
  458. struct platform_device *pdev = to_platform_device(dev);
  459. struct drm_device *drm = data;
  460. struct device_node *np = dev->of_node;
  461. struct device_node *ddc_node;
  462. struct imx_tve *tve;
  463. struct resource *res;
  464. void __iomem *base;
  465. unsigned int val;
  466. int irq;
  467. int ret;
  468. tve = devm_kzalloc(dev, sizeof(*tve), GFP_KERNEL);
  469. if (!tve)
  470. return -ENOMEM;
  471. tve->dev = dev;
  472. spin_lock_init(&tve->lock);
  473. ddc_node = of_parse_phandle(np, "ddc-i2c-bus", 0);
  474. if (ddc_node) {
  475. tve->ddc = of_find_i2c_adapter_by_node(ddc_node);
  476. of_node_put(ddc_node);
  477. }
  478. tve->mode = of_get_tve_mode(np);
  479. if (tve->mode != TVE_MODE_VGA) {
  480. dev_err(dev, "only VGA mode supported, currently\n");
  481. return -EINVAL;
  482. }
  483. if (tve->mode == TVE_MODE_VGA) {
  484. ret = of_property_read_u32(np, "fsl,hsync-pin",
  485. &tve->di_hsync_pin);
  486. if (ret < 0) {
  487. dev_err(dev, "failed to get hsync pin\n");
  488. return ret;
  489. }
  490. ret = of_property_read_u32(np, "fsl,vsync-pin",
  491. &tve->di_vsync_pin);
  492. if (ret < 0) {
  493. dev_err(dev, "failed to get vsync pin\n");
  494. return ret;
  495. }
  496. }
  497. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  498. base = devm_ioremap_resource(dev, res);
  499. if (IS_ERR(base))
  500. return PTR_ERR(base);
  501. tve_regmap_config.lock_arg = tve;
  502. tve->regmap = devm_regmap_init_mmio_clk(dev, "tve", base,
  503. &tve_regmap_config);
  504. if (IS_ERR(tve->regmap)) {
  505. dev_err(dev, "failed to init regmap: %ld\n",
  506. PTR_ERR(tve->regmap));
  507. return PTR_ERR(tve->regmap);
  508. }
  509. irq = platform_get_irq(pdev, 0);
  510. if (irq < 0) {
  511. dev_err(dev, "failed to get irq\n");
  512. return irq;
  513. }
  514. ret = devm_request_threaded_irq(dev, irq, NULL,
  515. imx_tve_irq_handler, IRQF_ONESHOT,
  516. "imx-tve", tve);
  517. if (ret < 0) {
  518. dev_err(dev, "failed to request irq: %d\n", ret);
  519. return ret;
  520. }
  521. tve->dac_reg = devm_regulator_get(dev, "dac");
  522. if (!IS_ERR(tve->dac_reg)) {
  523. if (regulator_get_voltage(tve->dac_reg) != IMX_TVE_DAC_VOLTAGE)
  524. dev_warn(dev, "dac voltage is not %d uV\n", IMX_TVE_DAC_VOLTAGE);
  525. ret = regulator_enable(tve->dac_reg);
  526. if (ret)
  527. return ret;
  528. }
  529. tve->clk = devm_clk_get(dev, "tve");
  530. if (IS_ERR(tve->clk)) {
  531. dev_err(dev, "failed to get high speed tve clock: %ld\n",
  532. PTR_ERR(tve->clk));
  533. return PTR_ERR(tve->clk);
  534. }
  535. /* this is the IPU DI clock input selector, can be parented to tve_di */
  536. tve->di_sel_clk = devm_clk_get(dev, "di_sel");
  537. if (IS_ERR(tve->di_sel_clk)) {
  538. dev_err(dev, "failed to get ipu di mux clock: %ld\n",
  539. PTR_ERR(tve->di_sel_clk));
  540. return PTR_ERR(tve->di_sel_clk);
  541. }
  542. ret = tve_clk_init(tve, base);
  543. if (ret < 0)
  544. return ret;
  545. ret = regmap_read(tve->regmap, TVE_COM_CONF_REG, &val);
  546. if (ret < 0) {
  547. dev_err(dev, "failed to read configuration register: %d\n",
  548. ret);
  549. return ret;
  550. }
  551. if (val != 0x00100000) {
  552. dev_err(dev, "configuration register default value indicates this is not a TVEv2\n");
  553. return -ENODEV;
  554. }
  555. /* disable cable detection for VGA mode */
  556. ret = regmap_write(tve->regmap, TVE_CD_CONT_REG, 0);
  557. if (ret)
  558. return ret;
  559. ret = imx_tve_register(drm, tve);
  560. if (ret)
  561. return ret;
  562. dev_set_drvdata(dev, tve);
  563. return 0;
  564. }
  565. static void imx_tve_unbind(struct device *dev, struct device *master,
  566. void *data)
  567. {
  568. struct imx_tve *tve = dev_get_drvdata(dev);
  569. if (!IS_ERR(tve->dac_reg))
  570. regulator_disable(tve->dac_reg);
  571. }
  572. static const struct component_ops imx_tve_ops = {
  573. .bind = imx_tve_bind,
  574. .unbind = imx_tve_unbind,
  575. };
  576. static int imx_tve_probe(struct platform_device *pdev)
  577. {
  578. return component_add(&pdev->dev, &imx_tve_ops);
  579. }
  580. static int imx_tve_remove(struct platform_device *pdev)
  581. {
  582. component_del(&pdev->dev, &imx_tve_ops);
  583. return 0;
  584. }
  585. static const struct of_device_id imx_tve_dt_ids[] = {
  586. { .compatible = "fsl,imx53-tve", },
  587. { /* sentinel */ }
  588. };
  589. MODULE_DEVICE_TABLE(of, imx_tve_dt_ids);
  590. static struct platform_driver imx_tve_driver = {
  591. .probe = imx_tve_probe,
  592. .remove = imx_tve_remove,
  593. .driver = {
  594. .of_match_table = imx_tve_dt_ids,
  595. .name = "imx-tve",
  596. },
  597. };
  598. module_platform_driver(imx_tve_driver);
  599. MODULE_DESCRIPTION("i.MX Television Encoder driver");
  600. MODULE_AUTHOR("Philipp Zabel, Pengutronix");
  601. MODULE_LICENSE("GPL");
  602. MODULE_ALIAS("platform:imx-tve");