parade-ps8640.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2016 MediaTek Inc.
  4. */
  5. #include <linux/delay.h>
  6. #include <linux/err.h>
  7. #include <linux/gpio/consumer.h>
  8. #include <linux/i2c.h>
  9. #include <linux/module.h>
  10. #include <linux/of_graph.h>
  11. #include <linux/pm_runtime.h>
  12. #include <linux/regmap.h>
  13. #include <linux/regulator/consumer.h>
  14. #include <drm/display/drm_dp_aux_bus.h>
  15. #include <drm/display/drm_dp_helper.h>
  16. #include <drm/drm_atomic_state_helper.h>
  17. #include <drm/drm_bridge.h>
  18. #include <drm/drm_edid.h>
  19. #include <drm/drm_mipi_dsi.h>
  20. #include <drm/drm_of.h>
  21. #include <drm/drm_panel.h>
  22. #include <drm/drm_print.h>
  23. #define PAGE0_AUXCH_CFG3 0x76
  24. #define AUXCH_CFG3_RESET 0xff
  25. #define PAGE0_SWAUX_ADDR_7_0 0x7d
  26. #define PAGE0_SWAUX_ADDR_15_8 0x7e
  27. #define PAGE0_SWAUX_ADDR_23_16 0x7f
  28. #define SWAUX_ADDR_MASK GENMASK(19, 0)
  29. #define PAGE0_SWAUX_LENGTH 0x80
  30. #define SWAUX_LENGTH_MASK GENMASK(3, 0)
  31. #define SWAUX_NO_PAYLOAD BIT(7)
  32. #define PAGE0_SWAUX_WDATA 0x81
  33. #define PAGE0_SWAUX_RDATA 0x82
  34. #define PAGE0_SWAUX_CTRL 0x83
  35. #define SWAUX_SEND BIT(0)
  36. #define PAGE0_SWAUX_STATUS 0x84
  37. #define SWAUX_M_MASK GENMASK(4, 0)
  38. #define SWAUX_STATUS_MASK GENMASK(7, 5)
  39. #define SWAUX_STATUS_NACK (0x1 << 5)
  40. #define SWAUX_STATUS_DEFER (0x2 << 5)
  41. #define SWAUX_STATUS_ACKM (0x3 << 5)
  42. #define SWAUX_STATUS_INVALID (0x4 << 5)
  43. #define SWAUX_STATUS_I2C_NACK (0x5 << 5)
  44. #define SWAUX_STATUS_I2C_DEFER (0x6 << 5)
  45. #define SWAUX_STATUS_TIMEOUT (0x7 << 5)
  46. #define PAGE2_GPIO_H 0xa7
  47. #define PS_GPIO9 BIT(1)
  48. #define PAGE2_I2C_BYPASS 0xea
  49. #define I2C_BYPASS_EN 0xd0
  50. #define PAGE2_MCS_EN 0xf3
  51. #define MCS_EN BIT(0)
  52. #define PAGE3_SET_ADD 0xfe
  53. #define VDO_CTL_ADD 0x13
  54. #define VDO_DIS 0x18
  55. #define VDO_EN 0x1c
  56. #define NUM_MIPI_LANES 4
  57. #define COMMON_PS8640_REGMAP_CONFIG \
  58. .reg_bits = 8, \
  59. .val_bits = 8, \
  60. .cache_type = REGCACHE_NONE
  61. /*
  62. * PS8640 uses multiple addresses:
  63. * page[0]: for DP control
  64. * page[1]: for VIDEO Bridge
  65. * page[2]: for control top
  66. * page[3]: for DSI Link Control1
  67. * page[4]: for MIPI Phy
  68. * page[5]: for VPLL
  69. * page[6]: for DSI Link Control2
  70. * page[7]: for SPI ROM mapping
  71. */
  72. enum page_addr_offset {
  73. PAGE0_DP_CNTL = 0,
  74. PAGE1_VDO_BDG,
  75. PAGE2_TOP_CNTL,
  76. PAGE3_DSI_CNTL1,
  77. PAGE4_MIPI_PHY,
  78. PAGE5_VPLL,
  79. PAGE6_DSI_CNTL2,
  80. PAGE7_SPI_CNTL,
  81. MAX_DEVS
  82. };
  83. enum ps8640_vdo_control {
  84. DISABLE = VDO_DIS,
  85. ENABLE = VDO_EN,
  86. };
  87. struct ps8640 {
  88. struct drm_bridge bridge;
  89. struct drm_bridge *panel_bridge;
  90. struct drm_dp_aux aux;
  91. struct mipi_dsi_device *dsi;
  92. struct i2c_client *page[MAX_DEVS];
  93. struct regmap *regmap[MAX_DEVS];
  94. struct regulator_bulk_data supplies[2];
  95. struct gpio_desc *gpio_reset;
  96. struct gpio_desc *gpio_powerdown;
  97. struct device_link *link;
  98. bool pre_enabled;
  99. bool need_post_hpd_delay;
  100. struct mutex aux_lock;
  101. };
  102. static const struct regmap_config ps8640_regmap_config[] = {
  103. [PAGE0_DP_CNTL] = {
  104. COMMON_PS8640_REGMAP_CONFIG,
  105. .max_register = 0xbf,
  106. },
  107. [PAGE1_VDO_BDG] = {
  108. COMMON_PS8640_REGMAP_CONFIG,
  109. .max_register = 0xff,
  110. },
  111. [PAGE2_TOP_CNTL] = {
  112. COMMON_PS8640_REGMAP_CONFIG,
  113. .max_register = 0xff,
  114. },
  115. [PAGE3_DSI_CNTL1] = {
  116. COMMON_PS8640_REGMAP_CONFIG,
  117. .max_register = 0xff,
  118. },
  119. [PAGE4_MIPI_PHY] = {
  120. COMMON_PS8640_REGMAP_CONFIG,
  121. .max_register = 0xff,
  122. },
  123. [PAGE5_VPLL] = {
  124. COMMON_PS8640_REGMAP_CONFIG,
  125. .max_register = 0x7f,
  126. },
  127. [PAGE6_DSI_CNTL2] = {
  128. COMMON_PS8640_REGMAP_CONFIG,
  129. .max_register = 0xff,
  130. },
  131. [PAGE7_SPI_CNTL] = {
  132. COMMON_PS8640_REGMAP_CONFIG,
  133. .max_register = 0xff,
  134. },
  135. };
  136. static inline struct ps8640 *bridge_to_ps8640(struct drm_bridge *e)
  137. {
  138. return container_of(e, struct ps8640, bridge);
  139. }
  140. static inline struct ps8640 *aux_to_ps8640(struct drm_dp_aux *aux)
  141. {
  142. return container_of(aux, struct ps8640, aux);
  143. }
  144. static int _ps8640_wait_hpd_asserted(struct ps8640 *ps_bridge, unsigned long wait_us)
  145. {
  146. struct regmap *map = ps_bridge->regmap[PAGE2_TOP_CNTL];
  147. int status;
  148. int ret;
  149. /*
  150. * Apparently something about the firmware in the chip signals that
  151. * HPD goes high by reporting GPIO9 as high (even though HPD isn't
  152. * actually connected to GPIO9).
  153. */
  154. ret = regmap_read_poll_timeout(map, PAGE2_GPIO_H, status,
  155. status & PS_GPIO9, 20000, wait_us);
  156. /*
  157. * The first time we see HPD go high after a reset we delay an extra
  158. * 50 ms. The best guess is that the MCU is doing "stuff" during this
  159. * time (maybe talking to the panel) and we don't want to interrupt it.
  160. *
  161. * No locking is done around "need_post_hpd_delay". If we're here we
  162. * know we're holding a PM Runtime reference and the only other place
  163. * that touches this is PM Runtime resume.
  164. */
  165. if (!ret && ps_bridge->need_post_hpd_delay) {
  166. ps_bridge->need_post_hpd_delay = false;
  167. msleep(50);
  168. }
  169. return ret;
  170. }
  171. static int ps8640_wait_hpd_asserted(struct drm_dp_aux *aux, unsigned long wait_us)
  172. {
  173. struct ps8640 *ps_bridge = aux_to_ps8640(aux);
  174. struct device *dev = &ps_bridge->page[PAGE0_DP_CNTL]->dev;
  175. int ret;
  176. /*
  177. * Note that this function is called by code that has already powered
  178. * the panel. We have to power ourselves up but we don't need to worry
  179. * about powering the panel.
  180. */
  181. pm_runtime_get_sync(dev);
  182. ret = _ps8640_wait_hpd_asserted(ps_bridge, wait_us);
  183. pm_runtime_mark_last_busy(dev);
  184. pm_runtime_put_autosuspend(dev);
  185. return ret;
  186. }
  187. static ssize_t ps8640_aux_transfer_msg(struct drm_dp_aux *aux,
  188. struct drm_dp_aux_msg *msg)
  189. {
  190. struct ps8640 *ps_bridge = aux_to_ps8640(aux);
  191. struct regmap *map = ps_bridge->regmap[PAGE0_DP_CNTL];
  192. struct device *dev = &ps_bridge->page[PAGE0_DP_CNTL]->dev;
  193. size_t len = msg->size;
  194. unsigned int data;
  195. unsigned int base;
  196. int ret;
  197. u8 request = msg->request &
  198. ~(DP_AUX_I2C_MOT | DP_AUX_I2C_WRITE_STATUS_UPDATE);
  199. u8 *buf = msg->buffer;
  200. u8 addr_len[PAGE0_SWAUX_LENGTH + 1 - PAGE0_SWAUX_ADDR_7_0];
  201. u8 i;
  202. bool is_native_aux = false;
  203. if (len > DP_AUX_MAX_PAYLOAD_BYTES)
  204. return -EINVAL;
  205. if (msg->address & ~SWAUX_ADDR_MASK)
  206. return -EINVAL;
  207. switch (request) {
  208. case DP_AUX_NATIVE_WRITE:
  209. case DP_AUX_NATIVE_READ:
  210. is_native_aux = true;
  211. fallthrough;
  212. case DP_AUX_I2C_WRITE:
  213. case DP_AUX_I2C_READ:
  214. break;
  215. default:
  216. return -EINVAL;
  217. }
  218. ret = regmap_write(map, PAGE0_AUXCH_CFG3, AUXCH_CFG3_RESET);
  219. if (ret) {
  220. DRM_DEV_ERROR(dev, "failed to write PAGE0_AUXCH_CFG3: %d\n",
  221. ret);
  222. return ret;
  223. }
  224. /* Assume it's good */
  225. msg->reply = 0;
  226. base = PAGE0_SWAUX_ADDR_7_0;
  227. addr_len[PAGE0_SWAUX_ADDR_7_0 - base] = msg->address;
  228. addr_len[PAGE0_SWAUX_ADDR_15_8 - base] = msg->address >> 8;
  229. addr_len[PAGE0_SWAUX_ADDR_23_16 - base] = (msg->address >> 16) |
  230. (msg->request << 4);
  231. addr_len[PAGE0_SWAUX_LENGTH - base] = (len == 0) ? SWAUX_NO_PAYLOAD :
  232. ((len - 1) & SWAUX_LENGTH_MASK);
  233. regmap_bulk_write(map, PAGE0_SWAUX_ADDR_7_0, addr_len,
  234. ARRAY_SIZE(addr_len));
  235. if (len && (request == DP_AUX_NATIVE_WRITE ||
  236. request == DP_AUX_I2C_WRITE)) {
  237. /* Write to the internal FIFO buffer */
  238. for (i = 0; i < len; i++) {
  239. ret = regmap_write(map, PAGE0_SWAUX_WDATA, buf[i]);
  240. if (ret) {
  241. DRM_DEV_ERROR(dev,
  242. "failed to write WDATA: %d\n",
  243. ret);
  244. return ret;
  245. }
  246. }
  247. }
  248. regmap_write(map, PAGE0_SWAUX_CTRL, SWAUX_SEND);
  249. /* Zero delay loop because i2c transactions are slow already */
  250. regmap_read_poll_timeout(map, PAGE0_SWAUX_CTRL, data,
  251. !(data & SWAUX_SEND), 0, 50 * 1000);
  252. regmap_read(map, PAGE0_SWAUX_STATUS, &data);
  253. if (ret) {
  254. DRM_DEV_ERROR(dev, "failed to read PAGE0_SWAUX_STATUS: %d\n",
  255. ret);
  256. return ret;
  257. }
  258. switch (data & SWAUX_STATUS_MASK) {
  259. case SWAUX_STATUS_NACK:
  260. case SWAUX_STATUS_I2C_NACK:
  261. /*
  262. * The programming guide is not clear about whether a I2C NACK
  263. * would trigger SWAUX_STATUS_NACK or SWAUX_STATUS_I2C_NACK. So
  264. * we handle both cases together.
  265. */
  266. if (is_native_aux)
  267. msg->reply |= DP_AUX_NATIVE_REPLY_NACK;
  268. else
  269. msg->reply |= DP_AUX_I2C_REPLY_NACK;
  270. fallthrough;
  271. case SWAUX_STATUS_ACKM:
  272. len = data & SWAUX_M_MASK;
  273. break;
  274. case SWAUX_STATUS_DEFER:
  275. case SWAUX_STATUS_I2C_DEFER:
  276. if (is_native_aux)
  277. msg->reply |= DP_AUX_NATIVE_REPLY_DEFER;
  278. else
  279. msg->reply |= DP_AUX_I2C_REPLY_DEFER;
  280. len = data & SWAUX_M_MASK;
  281. break;
  282. case SWAUX_STATUS_INVALID:
  283. return -EOPNOTSUPP;
  284. case SWAUX_STATUS_TIMEOUT:
  285. return -ETIMEDOUT;
  286. }
  287. if (len && (request == DP_AUX_NATIVE_READ ||
  288. request == DP_AUX_I2C_READ)) {
  289. /* Read from the internal FIFO buffer */
  290. for (i = 0; i < len; i++) {
  291. ret = regmap_read(map, PAGE0_SWAUX_RDATA, &data);
  292. if (ret) {
  293. DRM_DEV_ERROR(dev,
  294. "failed to read RDATA: %d\n",
  295. ret);
  296. return ret;
  297. }
  298. if (i < msg->size)
  299. buf[i] = data;
  300. }
  301. }
  302. return min(len, msg->size);
  303. }
  304. static ssize_t ps8640_aux_transfer(struct drm_dp_aux *aux,
  305. struct drm_dp_aux_msg *msg)
  306. {
  307. struct ps8640 *ps_bridge = aux_to_ps8640(aux);
  308. struct device *dev = &ps_bridge->page[PAGE0_DP_CNTL]->dev;
  309. int ret;
  310. mutex_lock(&ps_bridge->aux_lock);
  311. pm_runtime_get_sync(dev);
  312. ret = _ps8640_wait_hpd_asserted(ps_bridge, 200 * 1000);
  313. if (ret) {
  314. pm_runtime_put_sync_suspend(dev);
  315. goto exit;
  316. }
  317. ret = ps8640_aux_transfer_msg(aux, msg);
  318. pm_runtime_mark_last_busy(dev);
  319. pm_runtime_put_autosuspend(dev);
  320. exit:
  321. mutex_unlock(&ps_bridge->aux_lock);
  322. return ret;
  323. }
  324. static void ps8640_bridge_vdo_control(struct ps8640 *ps_bridge,
  325. const enum ps8640_vdo_control ctrl)
  326. {
  327. struct regmap *map = ps_bridge->regmap[PAGE3_DSI_CNTL1];
  328. struct device *dev = &ps_bridge->page[PAGE3_DSI_CNTL1]->dev;
  329. u8 vdo_ctrl_buf[] = { VDO_CTL_ADD, ctrl };
  330. int ret;
  331. ret = regmap_bulk_write(map, PAGE3_SET_ADD,
  332. vdo_ctrl_buf, sizeof(vdo_ctrl_buf));
  333. if (ret < 0)
  334. dev_err(dev, "failed to %sable VDO: %d\n",
  335. ctrl == ENABLE ? "en" : "dis", ret);
  336. }
  337. static int __maybe_unused ps8640_resume(struct device *dev)
  338. {
  339. struct ps8640 *ps_bridge = dev_get_drvdata(dev);
  340. int ret;
  341. ret = regulator_bulk_enable(ARRAY_SIZE(ps_bridge->supplies),
  342. ps_bridge->supplies);
  343. if (ret < 0) {
  344. dev_err(dev, "cannot enable regulators %d\n", ret);
  345. return ret;
  346. }
  347. gpiod_set_value(ps_bridge->gpio_powerdown, 0);
  348. gpiod_set_value(ps_bridge->gpio_reset, 1);
  349. usleep_range(2000, 2500);
  350. gpiod_set_value(ps_bridge->gpio_reset, 0);
  351. /* Double reset for T4 and T5 */
  352. msleep(50);
  353. gpiod_set_value(ps_bridge->gpio_reset, 1);
  354. msleep(50);
  355. gpiod_set_value(ps_bridge->gpio_reset, 0);
  356. /* We just reset things, so we need a delay after the first HPD */
  357. ps_bridge->need_post_hpd_delay = true;
  358. /*
  359. * Mystery 200 ms delay for the "MCU to be ready". It's unclear if
  360. * this is truly necessary since the MCU will already signal that
  361. * things are "good to go" by signaling HPD on "gpio 9". See
  362. * _ps8640_wait_hpd_asserted(). For now we'll keep this mystery delay
  363. * just in case.
  364. */
  365. msleep(200);
  366. return 0;
  367. }
  368. static int __maybe_unused ps8640_suspend(struct device *dev)
  369. {
  370. struct ps8640 *ps_bridge = dev_get_drvdata(dev);
  371. int ret;
  372. gpiod_set_value(ps_bridge->gpio_reset, 1);
  373. gpiod_set_value(ps_bridge->gpio_powerdown, 1);
  374. ret = regulator_bulk_disable(ARRAY_SIZE(ps_bridge->supplies),
  375. ps_bridge->supplies);
  376. if (ret < 0)
  377. dev_err(dev, "cannot disable regulators %d\n", ret);
  378. return ret;
  379. }
  380. static const struct dev_pm_ops ps8640_pm_ops = {
  381. SET_RUNTIME_PM_OPS(ps8640_suspend, ps8640_resume, NULL)
  382. SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
  383. pm_runtime_force_resume)
  384. };
  385. static void ps8640_atomic_pre_enable(struct drm_bridge *bridge,
  386. struct drm_bridge_state *old_bridge_state)
  387. {
  388. struct ps8640 *ps_bridge = bridge_to_ps8640(bridge);
  389. struct regmap *map = ps_bridge->regmap[PAGE2_TOP_CNTL];
  390. struct device *dev = &ps_bridge->page[PAGE0_DP_CNTL]->dev;
  391. int ret;
  392. pm_runtime_get_sync(dev);
  393. ret = _ps8640_wait_hpd_asserted(ps_bridge, 200 * 1000);
  394. if (ret < 0)
  395. dev_warn(dev, "HPD didn't go high: %d\n", ret);
  396. /*
  397. * The Manufacturer Command Set (MCS) is a device dependent interface
  398. * intended for factory programming of the display module default
  399. * parameters. Once the display module is configured, the MCS shall be
  400. * disabled by the manufacturer. Once disabled, all MCS commands are
  401. * ignored by the display interface.
  402. */
  403. ret = regmap_update_bits(map, PAGE2_MCS_EN, MCS_EN, 0);
  404. if (ret < 0)
  405. dev_warn(dev, "failed write PAGE2_MCS_EN: %d\n", ret);
  406. /* Switch access edp panel's edid through i2c */
  407. ret = regmap_write(map, PAGE2_I2C_BYPASS, I2C_BYPASS_EN);
  408. if (ret < 0)
  409. dev_warn(dev, "failed write PAGE2_MCS_EN: %d\n", ret);
  410. ps8640_bridge_vdo_control(ps_bridge, ENABLE);
  411. ps_bridge->pre_enabled = true;
  412. }
  413. static void ps8640_atomic_post_disable(struct drm_bridge *bridge,
  414. struct drm_bridge_state *old_bridge_state)
  415. {
  416. struct ps8640 *ps_bridge = bridge_to_ps8640(bridge);
  417. ps_bridge->pre_enabled = false;
  418. ps8640_bridge_vdo_control(ps_bridge, DISABLE);
  419. /*
  420. * The bridge seems to expect everything to be power cycled at the
  421. * disable process, so grab a lock here to make sure
  422. * ps8640_aux_transfer() is not holding a runtime PM reference and
  423. * preventing the bridge from suspend.
  424. */
  425. mutex_lock(&ps_bridge->aux_lock);
  426. pm_runtime_put_sync_suspend(&ps_bridge->page[PAGE0_DP_CNTL]->dev);
  427. mutex_unlock(&ps_bridge->aux_lock);
  428. }
  429. static int ps8640_bridge_attach(struct drm_bridge *bridge,
  430. enum drm_bridge_attach_flags flags)
  431. {
  432. struct ps8640 *ps_bridge = bridge_to_ps8640(bridge);
  433. struct device *dev = &ps_bridge->page[0]->dev;
  434. int ret;
  435. if (!(flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR))
  436. return -EINVAL;
  437. ps_bridge->aux.drm_dev = bridge->dev;
  438. ret = drm_dp_aux_register(&ps_bridge->aux);
  439. if (ret) {
  440. dev_err(dev, "failed to register DP AUX channel: %d\n", ret);
  441. return ret;
  442. }
  443. ps_bridge->link = device_link_add(bridge->dev->dev, dev, DL_FLAG_STATELESS);
  444. if (!ps_bridge->link) {
  445. dev_err(dev, "failed to create device link");
  446. ret = -EINVAL;
  447. goto err_devlink;
  448. }
  449. /* Attach the panel-bridge to the dsi bridge */
  450. ret = drm_bridge_attach(bridge->encoder, ps_bridge->panel_bridge,
  451. &ps_bridge->bridge, flags);
  452. if (ret)
  453. goto err_bridge_attach;
  454. return 0;
  455. err_bridge_attach:
  456. device_link_del(ps_bridge->link);
  457. err_devlink:
  458. drm_dp_aux_unregister(&ps_bridge->aux);
  459. return ret;
  460. }
  461. static void ps8640_bridge_detach(struct drm_bridge *bridge)
  462. {
  463. struct ps8640 *ps_bridge = bridge_to_ps8640(bridge);
  464. drm_dp_aux_unregister(&ps_bridge->aux);
  465. if (ps_bridge->link)
  466. device_link_del(ps_bridge->link);
  467. }
  468. static void ps8640_runtime_disable(void *data)
  469. {
  470. pm_runtime_dont_use_autosuspend(data);
  471. pm_runtime_disable(data);
  472. }
  473. static const struct drm_bridge_funcs ps8640_bridge_funcs = {
  474. .attach = ps8640_bridge_attach,
  475. .detach = ps8640_bridge_detach,
  476. .atomic_post_disable = ps8640_atomic_post_disable,
  477. .atomic_pre_enable = ps8640_atomic_pre_enable,
  478. .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
  479. .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
  480. .atomic_reset = drm_atomic_helper_bridge_reset,
  481. };
  482. static int ps8640_bridge_get_dsi_resources(struct device *dev, struct ps8640 *ps_bridge)
  483. {
  484. struct device_node *in_ep, *dsi_node;
  485. struct mipi_dsi_device *dsi;
  486. struct mipi_dsi_host *host;
  487. const struct mipi_dsi_device_info info = { .type = "ps8640",
  488. .channel = 0,
  489. .node = NULL,
  490. };
  491. /* port@0 is ps8640 dsi input port */
  492. in_ep = of_graph_get_endpoint_by_regs(dev->of_node, 0, -1);
  493. if (!in_ep)
  494. return -ENODEV;
  495. dsi_node = of_graph_get_remote_port_parent(in_ep);
  496. of_node_put(in_ep);
  497. if (!dsi_node)
  498. return -ENODEV;
  499. host = of_find_mipi_dsi_host_by_node(dsi_node);
  500. of_node_put(dsi_node);
  501. if (!host)
  502. return -EPROBE_DEFER;
  503. dsi = devm_mipi_dsi_device_register_full(dev, host, &info);
  504. if (IS_ERR(dsi)) {
  505. dev_err(dev, "failed to create dsi device\n");
  506. return PTR_ERR(dsi);
  507. }
  508. ps_bridge->dsi = dsi;
  509. dsi->host = host;
  510. dsi->mode_flags = MIPI_DSI_MODE_VIDEO |
  511. MIPI_DSI_MODE_VIDEO_SYNC_PULSE;
  512. dsi->format = MIPI_DSI_FMT_RGB888;
  513. dsi->lanes = NUM_MIPI_LANES;
  514. return 0;
  515. }
  516. static int ps8640_bridge_link_panel(struct drm_dp_aux *aux)
  517. {
  518. struct ps8640 *ps_bridge = aux_to_ps8640(aux);
  519. struct device *dev = aux->dev;
  520. struct device_node *np = dev->of_node;
  521. int ret;
  522. /*
  523. * NOTE about returning -EPROBE_DEFER from this function: if we
  524. * return an error (most relevant to -EPROBE_DEFER) it will only
  525. * be passed out to ps8640_probe() if it called this directly (AKA the
  526. * panel isn't under the "aux-bus" node). That should be fine because
  527. * if the panel is under "aux-bus" it's guaranteed to have probed by
  528. * the time this function has been called.
  529. */
  530. /* port@1 is ps8640 output port */
  531. ps_bridge->panel_bridge = devm_drm_of_get_bridge(dev, np, 1, 0);
  532. if (IS_ERR(ps_bridge->panel_bridge))
  533. return PTR_ERR(ps_bridge->panel_bridge);
  534. ret = devm_drm_bridge_add(dev, &ps_bridge->bridge);
  535. if (ret)
  536. return ret;
  537. return devm_mipi_dsi_attach(dev, ps_bridge->dsi);
  538. }
  539. static int ps8640_probe(struct i2c_client *client)
  540. {
  541. struct device *dev = &client->dev;
  542. struct ps8640 *ps_bridge;
  543. int ret;
  544. u32 i;
  545. ps_bridge = devm_kzalloc(dev, sizeof(*ps_bridge), GFP_KERNEL);
  546. if (!ps_bridge)
  547. return -ENOMEM;
  548. mutex_init(&ps_bridge->aux_lock);
  549. ps_bridge->supplies[0].supply = "vdd12";
  550. ps_bridge->supplies[1].supply = "vdd33";
  551. ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(ps_bridge->supplies),
  552. ps_bridge->supplies);
  553. if (ret)
  554. return ret;
  555. ps_bridge->gpio_powerdown = devm_gpiod_get(&client->dev, "powerdown",
  556. GPIOD_OUT_HIGH);
  557. if (IS_ERR(ps_bridge->gpio_powerdown))
  558. return PTR_ERR(ps_bridge->gpio_powerdown);
  559. /*
  560. * Assert the reset to avoid the bridge being initialized prematurely
  561. */
  562. ps_bridge->gpio_reset = devm_gpiod_get(&client->dev, "reset",
  563. GPIOD_OUT_HIGH);
  564. if (IS_ERR(ps_bridge->gpio_reset))
  565. return PTR_ERR(ps_bridge->gpio_reset);
  566. ps_bridge->bridge.funcs = &ps8640_bridge_funcs;
  567. ps_bridge->bridge.of_node = dev->of_node;
  568. ps_bridge->bridge.type = DRM_MODE_CONNECTOR_eDP;
  569. /*
  570. * Get MIPI DSI resources early. These can return -EPROBE_DEFER so
  571. * we want to get them out of the way sooner.
  572. */
  573. ret = ps8640_bridge_get_dsi_resources(&client->dev, ps_bridge);
  574. if (ret)
  575. return ret;
  576. ps_bridge->page[PAGE0_DP_CNTL] = client;
  577. ps_bridge->regmap[PAGE0_DP_CNTL] = devm_regmap_init_i2c(client, ps8640_regmap_config);
  578. if (IS_ERR(ps_bridge->regmap[PAGE0_DP_CNTL]))
  579. return PTR_ERR(ps_bridge->regmap[PAGE0_DP_CNTL]);
  580. for (i = 1; i < ARRAY_SIZE(ps_bridge->page); i++) {
  581. ps_bridge->page[i] = devm_i2c_new_dummy_device(&client->dev,
  582. client->adapter,
  583. client->addr + i);
  584. if (IS_ERR(ps_bridge->page[i]))
  585. return PTR_ERR(ps_bridge->page[i]);
  586. ps_bridge->regmap[i] = devm_regmap_init_i2c(ps_bridge->page[i],
  587. ps8640_regmap_config + i);
  588. if (IS_ERR(ps_bridge->regmap[i]))
  589. return PTR_ERR(ps_bridge->regmap[i]);
  590. }
  591. i2c_set_clientdata(client, ps_bridge);
  592. ps_bridge->aux.name = "parade-ps8640-aux";
  593. ps_bridge->aux.dev = dev;
  594. ps_bridge->aux.transfer = ps8640_aux_transfer;
  595. ps_bridge->aux.wait_hpd_asserted = ps8640_wait_hpd_asserted;
  596. drm_dp_aux_init(&ps_bridge->aux);
  597. pm_runtime_enable(dev);
  598. /*
  599. * Powering on ps8640 takes ~300ms. To avoid wasting time on power
  600. * cycling ps8640 too often, set autosuspend_delay to 2000ms to ensure
  601. * the bridge wouldn't suspend in between each _aux_transfer_msg() call
  602. * during EDID read (~20ms in my experiment) and in between the last
  603. * _aux_transfer_msg() call during EDID read and the _pre_enable() call
  604. * (~100ms in my experiment).
  605. */
  606. pm_runtime_set_autosuspend_delay(dev, 2000);
  607. pm_runtime_use_autosuspend(dev);
  608. pm_suspend_ignore_children(dev, true);
  609. ret = devm_add_action_or_reset(dev, ps8640_runtime_disable, dev);
  610. if (ret)
  611. return ret;
  612. ret = devm_of_dp_aux_populate_bus(&ps_bridge->aux, ps8640_bridge_link_panel);
  613. /*
  614. * If devm_of_dp_aux_populate_bus() returns -ENODEV then it's up to
  615. * usa to call ps8640_bridge_link_panel() directly. NOTE: in this case
  616. * the function is allowed to -EPROBE_DEFER.
  617. */
  618. if (ret == -ENODEV)
  619. return ps8640_bridge_link_panel(&ps_bridge->aux);
  620. return ret;
  621. }
  622. static const struct of_device_id ps8640_match[] = {
  623. { .compatible = "parade,ps8640" },
  624. { }
  625. };
  626. MODULE_DEVICE_TABLE(of, ps8640_match);
  627. static struct i2c_driver ps8640_driver = {
  628. .probe = ps8640_probe,
  629. .driver = {
  630. .name = "ps8640",
  631. .of_match_table = ps8640_match,
  632. .pm = &ps8640_pm_ops,
  633. },
  634. };
  635. module_i2c_driver(ps8640_driver);
  636. MODULE_AUTHOR("Jitao Shi <jitao.shi@mediatek.com>");
  637. MODULE_AUTHOR("CK Hu <ck.hu@mediatek.com>");
  638. MODULE_AUTHOR("Enric Balletbo i Serra <enric.balletbo@collabora.com>");
  639. MODULE_DESCRIPTION("PARADE ps8640 DSI-eDP converter driver");
  640. MODULE_LICENSE("GPL v2");