panel-sharp-lq101r1sx01.c 9.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (C) 2014 NVIDIA Corporation
  4. */
  5. #include <linux/delay.h>
  6. #include <linux/gpio/consumer.h>
  7. #include <linux/module.h>
  8. #include <linux/of.h>
  9. #include <linux/regulator/consumer.h>
  10. #include <video/mipi_display.h>
  11. #include <drm/drm_crtc.h>
  12. #include <drm/drm_device.h>
  13. #include <drm/drm_mipi_dsi.h>
  14. #include <drm/drm_panel.h>
  15. struct sharp_panel {
  16. struct drm_panel base;
  17. /* the datasheet refers to them as DSI-LINK1 and DSI-LINK2 */
  18. struct mipi_dsi_device *link1;
  19. struct mipi_dsi_device *link2;
  20. struct regulator *supply;
  21. bool prepared;
  22. bool enabled;
  23. const struct drm_display_mode *mode;
  24. };
  25. static inline struct sharp_panel *to_sharp_panel(struct drm_panel *panel)
  26. {
  27. return container_of(panel, struct sharp_panel, base);
  28. }
  29. static void sharp_wait_frames(struct sharp_panel *sharp, unsigned int frames)
  30. {
  31. unsigned int refresh = drm_mode_vrefresh(sharp->mode);
  32. if (WARN_ON(frames > refresh))
  33. return;
  34. msleep(1000 / (refresh / frames));
  35. }
  36. static int sharp_panel_write(struct sharp_panel *sharp, u16 offset, u8 value)
  37. {
  38. u8 payload[3] = { offset >> 8, offset & 0xff, value };
  39. struct mipi_dsi_device *dsi = sharp->link1;
  40. ssize_t err;
  41. err = mipi_dsi_generic_write(dsi, payload, sizeof(payload));
  42. if (err < 0) {
  43. dev_err(&dsi->dev, "failed to write %02x to %04x: %zd\n",
  44. value, offset, err);
  45. return err;
  46. }
  47. err = mipi_dsi_dcs_nop(dsi);
  48. if (err < 0) {
  49. dev_err(&dsi->dev, "failed to send DCS nop: %zd\n", err);
  50. return err;
  51. }
  52. usleep_range(10, 20);
  53. return 0;
  54. }
  55. static __maybe_unused int sharp_panel_read(struct sharp_panel *sharp,
  56. u16 offset, u8 *value)
  57. {
  58. ssize_t err;
  59. cpu_to_be16s(&offset);
  60. err = mipi_dsi_generic_read(sharp->link1, &offset, sizeof(offset),
  61. value, sizeof(*value));
  62. if (err < 0)
  63. dev_err(&sharp->link1->dev, "failed to read from %04x: %zd\n",
  64. offset, err);
  65. return err;
  66. }
  67. static int sharp_panel_disable(struct drm_panel *panel)
  68. {
  69. struct sharp_panel *sharp = to_sharp_panel(panel);
  70. if (!sharp->enabled)
  71. return 0;
  72. sharp->enabled = false;
  73. return 0;
  74. }
  75. static int sharp_panel_unprepare(struct drm_panel *panel)
  76. {
  77. struct sharp_panel *sharp = to_sharp_panel(panel);
  78. int err;
  79. if (!sharp->prepared)
  80. return 0;
  81. sharp_wait_frames(sharp, 4);
  82. err = mipi_dsi_dcs_set_display_off(sharp->link1);
  83. if (err < 0)
  84. dev_err(panel->dev, "failed to set display off: %d\n", err);
  85. err = mipi_dsi_dcs_enter_sleep_mode(sharp->link1);
  86. if (err < 0)
  87. dev_err(panel->dev, "failed to enter sleep mode: %d\n", err);
  88. msleep(120);
  89. regulator_disable(sharp->supply);
  90. sharp->prepared = false;
  91. return 0;
  92. }
  93. static int sharp_setup_symmetrical_split(struct mipi_dsi_device *left,
  94. struct mipi_dsi_device *right,
  95. const struct drm_display_mode *mode)
  96. {
  97. int err;
  98. err = mipi_dsi_dcs_set_column_address(left, 0, mode->hdisplay / 2 - 1);
  99. if (err < 0) {
  100. dev_err(&left->dev, "failed to set column address: %d\n", err);
  101. return err;
  102. }
  103. err = mipi_dsi_dcs_set_page_address(left, 0, mode->vdisplay - 1);
  104. if (err < 0) {
  105. dev_err(&left->dev, "failed to set page address: %d\n", err);
  106. return err;
  107. }
  108. err = mipi_dsi_dcs_set_column_address(right, mode->hdisplay / 2,
  109. mode->hdisplay - 1);
  110. if (err < 0) {
  111. dev_err(&right->dev, "failed to set column address: %d\n", err);
  112. return err;
  113. }
  114. err = mipi_dsi_dcs_set_page_address(right, 0, mode->vdisplay - 1);
  115. if (err < 0) {
  116. dev_err(&right->dev, "failed to set page address: %d\n", err);
  117. return err;
  118. }
  119. return 0;
  120. }
  121. static int sharp_panel_prepare(struct drm_panel *panel)
  122. {
  123. struct sharp_panel *sharp = to_sharp_panel(panel);
  124. u8 format = MIPI_DCS_PIXEL_FMT_24BIT;
  125. int err;
  126. if (sharp->prepared)
  127. return 0;
  128. err = regulator_enable(sharp->supply);
  129. if (err < 0)
  130. return err;
  131. /*
  132. * According to the datasheet, the panel needs around 10 ms to fully
  133. * power up. At least another 120 ms is required before exiting sleep
  134. * mode to make sure the panel is ready. Throw in another 20 ms for
  135. * good measure.
  136. */
  137. msleep(150);
  138. err = mipi_dsi_dcs_exit_sleep_mode(sharp->link1);
  139. if (err < 0) {
  140. dev_err(panel->dev, "failed to exit sleep mode: %d\n", err);
  141. goto poweroff;
  142. }
  143. /*
  144. * The MIPI DCS specification mandates this delay only between the
  145. * exit_sleep_mode and enter_sleep_mode commands, so it isn't strictly
  146. * necessary here.
  147. */
  148. /*
  149. msleep(120);
  150. */
  151. /* set left-right mode */
  152. err = sharp_panel_write(sharp, 0x1000, 0x2a);
  153. if (err < 0) {
  154. dev_err(panel->dev, "failed to set left-right mode: %d\n", err);
  155. goto poweroff;
  156. }
  157. /* enable command mode */
  158. err = sharp_panel_write(sharp, 0x1001, 0x01);
  159. if (err < 0) {
  160. dev_err(panel->dev, "failed to enable command mode: %d\n", err);
  161. goto poweroff;
  162. }
  163. err = mipi_dsi_dcs_set_pixel_format(sharp->link1, format);
  164. if (err < 0) {
  165. dev_err(panel->dev, "failed to set pixel format: %d\n", err);
  166. goto poweroff;
  167. }
  168. /*
  169. * TODO: The device supports both left-right and even-odd split
  170. * configurations, but this driver currently supports only the left-
  171. * right split. To support a different mode a mechanism needs to be
  172. * put in place to communicate the configuration back to the DSI host
  173. * controller.
  174. */
  175. err = sharp_setup_symmetrical_split(sharp->link1, sharp->link2,
  176. sharp->mode);
  177. if (err < 0) {
  178. dev_err(panel->dev, "failed to set up symmetrical split: %d\n",
  179. err);
  180. goto poweroff;
  181. }
  182. err = mipi_dsi_dcs_set_display_on(sharp->link1);
  183. if (err < 0) {
  184. dev_err(panel->dev, "failed to set display on: %d\n", err);
  185. goto poweroff;
  186. }
  187. sharp->prepared = true;
  188. /* wait for 6 frames before continuing */
  189. sharp_wait_frames(sharp, 6);
  190. return 0;
  191. poweroff:
  192. regulator_disable(sharp->supply);
  193. return err;
  194. }
  195. static int sharp_panel_enable(struct drm_panel *panel)
  196. {
  197. struct sharp_panel *sharp = to_sharp_panel(panel);
  198. if (sharp->enabled)
  199. return 0;
  200. sharp->enabled = true;
  201. return 0;
  202. }
  203. static const struct drm_display_mode default_mode = {
  204. .clock = 278000,
  205. .hdisplay = 2560,
  206. .hsync_start = 2560 + 128,
  207. .hsync_end = 2560 + 128 + 64,
  208. .htotal = 2560 + 128 + 64 + 64,
  209. .vdisplay = 1600,
  210. .vsync_start = 1600 + 4,
  211. .vsync_end = 1600 + 4 + 8,
  212. .vtotal = 1600 + 4 + 8 + 32,
  213. };
  214. static int sharp_panel_get_modes(struct drm_panel *panel,
  215. struct drm_connector *connector)
  216. {
  217. struct drm_display_mode *mode;
  218. mode = drm_mode_duplicate(connector->dev, &default_mode);
  219. if (!mode) {
  220. dev_err(panel->dev, "failed to add mode %ux%ux@%u\n",
  221. default_mode.hdisplay, default_mode.vdisplay,
  222. drm_mode_vrefresh(&default_mode));
  223. return -ENOMEM;
  224. }
  225. drm_mode_set_name(mode);
  226. drm_mode_probed_add(connector, mode);
  227. connector->display_info.width_mm = 217;
  228. connector->display_info.height_mm = 136;
  229. return 1;
  230. }
  231. static const struct drm_panel_funcs sharp_panel_funcs = {
  232. .disable = sharp_panel_disable,
  233. .unprepare = sharp_panel_unprepare,
  234. .prepare = sharp_panel_prepare,
  235. .enable = sharp_panel_enable,
  236. .get_modes = sharp_panel_get_modes,
  237. };
  238. static const struct of_device_id sharp_of_match[] = {
  239. { .compatible = "sharp,lq101r1sx01", },
  240. { }
  241. };
  242. MODULE_DEVICE_TABLE(of, sharp_of_match);
  243. static int sharp_panel_add(struct sharp_panel *sharp)
  244. {
  245. int ret;
  246. sharp->mode = &default_mode;
  247. sharp->supply = devm_regulator_get(&sharp->link1->dev, "power");
  248. if (IS_ERR(sharp->supply))
  249. return PTR_ERR(sharp->supply);
  250. drm_panel_init(&sharp->base, &sharp->link1->dev, &sharp_panel_funcs,
  251. DRM_MODE_CONNECTOR_DSI);
  252. ret = drm_panel_of_backlight(&sharp->base);
  253. if (ret)
  254. return ret;
  255. drm_panel_add(&sharp->base);
  256. return 0;
  257. }
  258. static void sharp_panel_del(struct sharp_panel *sharp)
  259. {
  260. if (sharp->base.dev)
  261. drm_panel_remove(&sharp->base);
  262. if (sharp->link2)
  263. put_device(&sharp->link2->dev);
  264. }
  265. static int sharp_panel_probe(struct mipi_dsi_device *dsi)
  266. {
  267. struct mipi_dsi_device *secondary = NULL;
  268. struct sharp_panel *sharp;
  269. struct device_node *np;
  270. int err;
  271. dsi->lanes = 4;
  272. dsi->format = MIPI_DSI_FMT_RGB888;
  273. dsi->mode_flags = MIPI_DSI_MODE_LPM;
  274. /* Find DSI-LINK1 */
  275. np = of_parse_phandle(dsi->dev.of_node, "link2", 0);
  276. if (np) {
  277. secondary = of_find_mipi_dsi_device_by_node(np);
  278. of_node_put(np);
  279. if (!secondary)
  280. return -EPROBE_DEFER;
  281. }
  282. /* register a panel for only the DSI-LINK1 interface */
  283. if (secondary) {
  284. sharp = devm_kzalloc(&dsi->dev, sizeof(*sharp), GFP_KERNEL);
  285. if (!sharp) {
  286. put_device(&secondary->dev);
  287. return -ENOMEM;
  288. }
  289. mipi_dsi_set_drvdata(dsi, sharp);
  290. sharp->link2 = secondary;
  291. sharp->link1 = dsi;
  292. err = sharp_panel_add(sharp);
  293. if (err < 0) {
  294. put_device(&secondary->dev);
  295. return err;
  296. }
  297. }
  298. err = mipi_dsi_attach(dsi);
  299. if (err < 0) {
  300. if (secondary)
  301. sharp_panel_del(sharp);
  302. return err;
  303. }
  304. return 0;
  305. }
  306. static int sharp_panel_remove(struct mipi_dsi_device *dsi)
  307. {
  308. struct sharp_panel *sharp = mipi_dsi_get_drvdata(dsi);
  309. int err;
  310. /* only detach from host for the DSI-LINK2 interface */
  311. if (!sharp) {
  312. mipi_dsi_detach(dsi);
  313. return 0;
  314. }
  315. err = drm_panel_disable(&sharp->base);
  316. if (err < 0)
  317. dev_err(&dsi->dev, "failed to disable panel: %d\n", err);
  318. err = mipi_dsi_detach(dsi);
  319. if (err < 0)
  320. dev_err(&dsi->dev, "failed to detach from DSI host: %d\n", err);
  321. sharp_panel_del(sharp);
  322. return 0;
  323. }
  324. static void sharp_panel_shutdown(struct mipi_dsi_device *dsi)
  325. {
  326. struct sharp_panel *sharp = mipi_dsi_get_drvdata(dsi);
  327. /* nothing to do for DSI-LINK2 */
  328. if (!sharp)
  329. return;
  330. drm_panel_disable(&sharp->base);
  331. }
  332. static struct mipi_dsi_driver sharp_panel_driver = {
  333. .driver = {
  334. .name = "panel-sharp-lq101r1sx01",
  335. .of_match_table = sharp_of_match,
  336. },
  337. .probe = sharp_panel_probe,
  338. .remove = sharp_panel_remove,
  339. .shutdown = sharp_panel_shutdown,
  340. };
  341. module_mipi_dsi_driver(sharp_panel_driver);
  342. MODULE_AUTHOR("Thierry Reding <treding@nvidia.com>");
  343. MODULE_DESCRIPTION("Sharp LQ101R1SX01 panel driver");
  344. MODULE_LICENSE("GPL v2");