panel-truly-nt35597.c 15 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (c) 2018, The Linux Foundation. All rights reserved.
  4. */
  5. #include <linux/backlight.h>
  6. #include <linux/delay.h>
  7. #include <linux/gpio/consumer.h>
  8. #include <linux/module.h>
  9. #include <linux/of_device.h>
  10. #include <linux/of_graph.h>
  11. #include <linux/pinctrl/consumer.h>
  12. #include <linux/regulator/consumer.h>
  13. #include <video/mipi_display.h>
  14. #include <drm/drm_mipi_dsi.h>
  15. #include <drm/drm_modes.h>
  16. #include <drm/drm_panel.h>
  17. static const char * const regulator_names[] = {
  18. "vdda",
  19. "vdispp",
  20. "vdispn",
  21. };
  22. static unsigned long const regulator_enable_loads[] = {
  23. 62000,
  24. 100000,
  25. 100000,
  26. };
  27. static unsigned long const regulator_disable_loads[] = {
  28. 80,
  29. 100,
  30. 100,
  31. };
  32. struct cmd_set {
  33. u8 commands[4];
  34. u8 size;
  35. };
  36. struct nt35597_config {
  37. u32 width_mm;
  38. u32 height_mm;
  39. const char *panel_name;
  40. const struct cmd_set *panel_on_cmds;
  41. u32 num_on_cmds;
  42. const struct drm_display_mode *dm;
  43. };
  44. struct truly_nt35597 {
  45. struct device *dev;
  46. struct drm_panel panel;
  47. struct regulator_bulk_data supplies[ARRAY_SIZE(regulator_names)];
  48. struct gpio_desc *reset_gpio;
  49. struct gpio_desc *mode_gpio;
  50. struct backlight_device *backlight;
  51. struct mipi_dsi_device *dsi[2];
  52. const struct nt35597_config *config;
  53. bool prepared;
  54. bool enabled;
  55. };
  56. static inline struct truly_nt35597 *panel_to_ctx(struct drm_panel *panel)
  57. {
  58. return container_of(panel, struct truly_nt35597, panel);
  59. }
  60. static const struct cmd_set qcom_2k_panel_magic_cmds[] = {
  61. /* CMD2_P0 */
  62. { { 0xff, 0x20 }, 2 },
  63. { { 0xfb, 0x01 }, 2 },
  64. { { 0x00, 0x01 }, 2 },
  65. { { 0x01, 0x55 }, 2 },
  66. { { 0x02, 0x45 }, 2 },
  67. { { 0x05, 0x40 }, 2 },
  68. { { 0x06, 0x19 }, 2 },
  69. { { 0x07, 0x1e }, 2 },
  70. { { 0x0b, 0x73 }, 2 },
  71. { { 0x0c, 0x73 }, 2 },
  72. { { 0x0e, 0xb0 }, 2 },
  73. { { 0x0f, 0xae }, 2 },
  74. { { 0x11, 0xb8 }, 2 },
  75. { { 0x13, 0x00 }, 2 },
  76. { { 0x58, 0x80 }, 2 },
  77. { { 0x59, 0x01 }, 2 },
  78. { { 0x5a, 0x00 }, 2 },
  79. { { 0x5b, 0x01 }, 2 },
  80. { { 0x5c, 0x80 }, 2 },
  81. { { 0x5d, 0x81 }, 2 },
  82. { { 0x5e, 0x00 }, 2 },
  83. { { 0x5f, 0x01 }, 2 },
  84. { { 0x72, 0x11 }, 2 },
  85. { { 0x68, 0x03 }, 2 },
  86. /* CMD2_P4 */
  87. { { 0xFF, 0x24 }, 2 },
  88. { { 0xFB, 0x01 }, 2 },
  89. { { 0x00, 0x1C }, 2 },
  90. { { 0x01, 0x0B }, 2 },
  91. { { 0x02, 0x0C }, 2 },
  92. { { 0x03, 0x01 }, 2 },
  93. { { 0x04, 0x0F }, 2 },
  94. { { 0x05, 0x10 }, 2 },
  95. { { 0x06, 0x10 }, 2 },
  96. { { 0x07, 0x10 }, 2 },
  97. { { 0x08, 0x89 }, 2 },
  98. { { 0x09, 0x8A }, 2 },
  99. { { 0x0A, 0x13 }, 2 },
  100. { { 0x0B, 0x13 }, 2 },
  101. { { 0x0C, 0x15 }, 2 },
  102. { { 0x0D, 0x15 }, 2 },
  103. { { 0x0E, 0x17 }, 2 },
  104. { { 0x0F, 0x17 }, 2 },
  105. { { 0x10, 0x1C }, 2 },
  106. { { 0x11, 0x0B }, 2 },
  107. { { 0x12, 0x0C }, 2 },
  108. { { 0x13, 0x01 }, 2 },
  109. { { 0x14, 0x0F }, 2 },
  110. { { 0x15, 0x10 }, 2 },
  111. { { 0x16, 0x10 }, 2 },
  112. { { 0x17, 0x10 }, 2 },
  113. { { 0x18, 0x89 }, 2 },
  114. { { 0x19, 0x8A }, 2 },
  115. { { 0x1A, 0x13 }, 2 },
  116. { { 0x1B, 0x13 }, 2 },
  117. { { 0x1C, 0x15 }, 2 },
  118. { { 0x1D, 0x15 }, 2 },
  119. { { 0x1E, 0x17 }, 2 },
  120. { { 0x1F, 0x17 }, 2 },
  121. /* STV */
  122. { { 0x20, 0x40 }, 2 },
  123. { { 0x21, 0x01 }, 2 },
  124. { { 0x22, 0x00 }, 2 },
  125. { { 0x23, 0x40 }, 2 },
  126. { { 0x24, 0x40 }, 2 },
  127. { { 0x25, 0x6D }, 2 },
  128. { { 0x26, 0x40 }, 2 },
  129. { { 0x27, 0x40 }, 2 },
  130. /* Vend */
  131. { { 0xE0, 0x00 }, 2 },
  132. { { 0xDC, 0x21 }, 2 },
  133. { { 0xDD, 0x22 }, 2 },
  134. { { 0xDE, 0x07 }, 2 },
  135. { { 0xDF, 0x07 }, 2 },
  136. { { 0xE3, 0x6D }, 2 },
  137. { { 0xE1, 0x07 }, 2 },
  138. { { 0xE2, 0x07 }, 2 },
  139. /* UD */
  140. { { 0x29, 0xD8 }, 2 },
  141. { { 0x2A, 0x2A }, 2 },
  142. /* CLK */
  143. { { 0x4B, 0x03 }, 2 },
  144. { { 0x4C, 0x11 }, 2 },
  145. { { 0x4D, 0x10 }, 2 },
  146. { { 0x4E, 0x01 }, 2 },
  147. { { 0x4F, 0x01 }, 2 },
  148. { { 0x50, 0x10 }, 2 },
  149. { { 0x51, 0x00 }, 2 },
  150. { { 0x52, 0x80 }, 2 },
  151. { { 0x53, 0x00 }, 2 },
  152. { { 0x56, 0x00 }, 2 },
  153. { { 0x54, 0x07 }, 2 },
  154. { { 0x58, 0x07 }, 2 },
  155. { { 0x55, 0x25 }, 2 },
  156. /* Reset XDONB */
  157. { { 0x5B, 0x43 }, 2 },
  158. { { 0x5C, 0x00 }, 2 },
  159. { { 0x5F, 0x73 }, 2 },
  160. { { 0x60, 0x73 }, 2 },
  161. { { 0x63, 0x22 }, 2 },
  162. { { 0x64, 0x00 }, 2 },
  163. { { 0x67, 0x08 }, 2 },
  164. { { 0x68, 0x04 }, 2 },
  165. /* Resolution:1440x2560 */
  166. { { 0x72, 0x02 }, 2 },
  167. /* mux */
  168. { { 0x7A, 0x80 }, 2 },
  169. { { 0x7B, 0x91 }, 2 },
  170. { { 0x7C, 0xD8 }, 2 },
  171. { { 0x7D, 0x60 }, 2 },
  172. { { 0x7F, 0x15 }, 2 },
  173. { { 0x75, 0x15 }, 2 },
  174. /* ABOFF */
  175. { { 0xB3, 0xC0 }, 2 },
  176. { { 0xB4, 0x00 }, 2 },
  177. { { 0xB5, 0x00 }, 2 },
  178. /* Source EQ */
  179. { { 0x78, 0x00 }, 2 },
  180. { { 0x79, 0x00 }, 2 },
  181. { { 0x80, 0x00 }, 2 },
  182. { { 0x83, 0x00 }, 2 },
  183. /* FP BP */
  184. { { 0x93, 0x0A }, 2 },
  185. { { 0x94, 0x0A }, 2 },
  186. /* Inversion Type */
  187. { { 0x8A, 0x00 }, 2 },
  188. { { 0x9B, 0xFF }, 2 },
  189. /* IMGSWAP =1 @PortSwap=1 */
  190. { { 0x9D, 0xB0 }, 2 },
  191. { { 0x9F, 0x63 }, 2 },
  192. { { 0x98, 0x10 }, 2 },
  193. /* FRM */
  194. { { 0xEC, 0x00 }, 2 },
  195. /* CMD1 */
  196. { { 0xFF, 0x10 }, 2 },
  197. /* VBP+VSA=,VFP = 10H */
  198. { { 0x3B, 0x03, 0x0A, 0x0A }, 4 },
  199. /* FTE on */
  200. { { 0x35, 0x00 }, 2 },
  201. /* EN_BK =1(auto black) */
  202. { { 0xE5, 0x01 }, 2 },
  203. /* CMD mode(10) VDO mode(03) */
  204. { { 0xBB, 0x03 }, 2 },
  205. /* Non Reload MTP */
  206. { { 0xFB, 0x01 }, 2 },
  207. };
  208. static int truly_dcs_write(struct drm_panel *panel, u32 command)
  209. {
  210. struct truly_nt35597 *ctx = panel_to_ctx(panel);
  211. int i, ret;
  212. for (i = 0; i < ARRAY_SIZE(ctx->dsi); i++) {
  213. ret = mipi_dsi_dcs_write(ctx->dsi[i], command, NULL, 0);
  214. if (ret < 0) {
  215. dev_err(ctx->dev, "cmd 0x%x failed for dsi = %d\n", command, i);
  216. }
  217. }
  218. return ret;
  219. }
  220. static int truly_dcs_write_buf(struct drm_panel *panel,
  221. u32 size, const u8 *buf)
  222. {
  223. struct truly_nt35597 *ctx = panel_to_ctx(panel);
  224. int ret = 0;
  225. int i;
  226. for (i = 0; i < ARRAY_SIZE(ctx->dsi); i++) {
  227. ret = mipi_dsi_dcs_write_buffer(ctx->dsi[i], buf, size);
  228. if (ret < 0) {
  229. dev_err(ctx->dev, "failed to tx cmd [%d], err: %d\n", i, ret);
  230. return ret;
  231. }
  232. }
  233. return ret;
  234. }
  235. static int truly_35597_power_on(struct truly_nt35597 *ctx)
  236. {
  237. int ret, i;
  238. for (i = 0; i < ARRAY_SIZE(ctx->supplies); i++) {
  239. ret = regulator_set_load(ctx->supplies[i].consumer,
  240. regulator_enable_loads[i]);
  241. if (ret)
  242. return ret;
  243. }
  244. ret = regulator_bulk_enable(ARRAY_SIZE(ctx->supplies), ctx->supplies);
  245. if (ret < 0)
  246. return ret;
  247. /*
  248. * Reset sequence of truly panel requires the panel to be
  249. * out of reset for 10ms, followed by being held in reset
  250. * for 10ms and then out again
  251. */
  252. gpiod_set_value(ctx->reset_gpio, 0);
  253. usleep_range(10000, 20000);
  254. gpiod_set_value(ctx->reset_gpio, 1);
  255. usleep_range(10000, 20000);
  256. gpiod_set_value(ctx->reset_gpio, 0);
  257. usleep_range(10000, 20000);
  258. return 0;
  259. }
  260. static int truly_nt35597_power_off(struct truly_nt35597 *ctx)
  261. {
  262. int ret = 0;
  263. int i;
  264. gpiod_set_value(ctx->reset_gpio, 1);
  265. for (i = 0; i < ARRAY_SIZE(ctx->supplies); i++) {
  266. ret = regulator_set_load(ctx->supplies[i].consumer,
  267. regulator_disable_loads[i]);
  268. if (ret) {
  269. dev_err(ctx->dev, "regulator_set_load failed %d\n", ret);
  270. return ret;
  271. }
  272. }
  273. ret = regulator_bulk_disable(ARRAY_SIZE(ctx->supplies), ctx->supplies);
  274. if (ret) {
  275. dev_err(ctx->dev, "regulator_bulk_disable failed %d\n", ret);
  276. }
  277. return ret;
  278. }
  279. static int truly_nt35597_disable(struct drm_panel *panel)
  280. {
  281. struct truly_nt35597 *ctx = panel_to_ctx(panel);
  282. int ret;
  283. if (!ctx->enabled)
  284. return 0;
  285. if (ctx->backlight) {
  286. ret = backlight_disable(ctx->backlight);
  287. if (ret < 0)
  288. dev_err(ctx->dev, "backlight disable failed %d\n", ret);
  289. }
  290. ctx->enabled = false;
  291. return 0;
  292. }
  293. static int truly_nt35597_unprepare(struct drm_panel *panel)
  294. {
  295. struct truly_nt35597 *ctx = panel_to_ctx(panel);
  296. int ret = 0;
  297. if (!ctx->prepared)
  298. return 0;
  299. ctx->dsi[0]->mode_flags = 0;
  300. ctx->dsi[1]->mode_flags = 0;
  301. ret = truly_dcs_write(panel, MIPI_DCS_SET_DISPLAY_OFF);
  302. if (ret < 0) {
  303. dev_err(ctx->dev, "set_display_off cmd failed ret = %d\n", ret);
  304. }
  305. /* 120ms delay required here as per DCS spec */
  306. msleep(120);
  307. ret = truly_dcs_write(panel, MIPI_DCS_ENTER_SLEEP_MODE);
  308. if (ret < 0) {
  309. dev_err(ctx->dev, "enter_sleep cmd failed ret = %d\n", ret);
  310. }
  311. ret = truly_nt35597_power_off(ctx);
  312. if (ret < 0)
  313. dev_err(ctx->dev, "power_off failed ret = %d\n", ret);
  314. ctx->prepared = false;
  315. return ret;
  316. }
  317. static int truly_nt35597_prepare(struct drm_panel *panel)
  318. {
  319. struct truly_nt35597 *ctx = panel_to_ctx(panel);
  320. int ret;
  321. int i;
  322. const struct cmd_set *panel_on_cmds;
  323. const struct nt35597_config *config;
  324. u32 num_cmds;
  325. if (ctx->prepared)
  326. return 0;
  327. ret = truly_35597_power_on(ctx);
  328. if (ret < 0)
  329. return ret;
  330. ctx->dsi[0]->mode_flags |= MIPI_DSI_MODE_LPM;
  331. ctx->dsi[1]->mode_flags |= MIPI_DSI_MODE_LPM;
  332. config = ctx->config;
  333. panel_on_cmds = config->panel_on_cmds;
  334. num_cmds = config->num_on_cmds;
  335. for (i = 0; i < num_cmds; i++) {
  336. ret = truly_dcs_write_buf(panel,
  337. panel_on_cmds[i].size,
  338. panel_on_cmds[i].commands);
  339. if (ret < 0) {
  340. dev_err(ctx->dev, "cmd set tx failed i = %d ret = %d\n", i, ret);
  341. goto power_off;
  342. }
  343. }
  344. ret = truly_dcs_write(panel, MIPI_DCS_EXIT_SLEEP_MODE);
  345. if (ret < 0) {
  346. dev_err(ctx->dev, "exit_sleep_mode cmd failed ret = %d\n", ret);
  347. goto power_off;
  348. }
  349. /* Per DSI spec wait 120ms after sending exit sleep DCS command */
  350. msleep(120);
  351. ret = truly_dcs_write(panel, MIPI_DCS_SET_DISPLAY_ON);
  352. if (ret < 0) {
  353. dev_err(ctx->dev, "set_display_on cmd failed ret = %d\n", ret);
  354. goto power_off;
  355. }
  356. /* Per DSI spec wait 120ms after sending set_display_on DCS command */
  357. msleep(120);
  358. ctx->prepared = true;
  359. return 0;
  360. power_off:
  361. if (truly_nt35597_power_off(ctx))
  362. dev_err(ctx->dev, "power_off failed\n");
  363. return ret;
  364. }
  365. static int truly_nt35597_enable(struct drm_panel *panel)
  366. {
  367. struct truly_nt35597 *ctx = panel_to_ctx(panel);
  368. int ret;
  369. if (ctx->enabled)
  370. return 0;
  371. if (ctx->backlight) {
  372. ret = backlight_enable(ctx->backlight);
  373. if (ret < 0)
  374. dev_err(ctx->dev, "backlight enable failed %d\n", ret);
  375. }
  376. ctx->enabled = true;
  377. return 0;
  378. }
  379. static int truly_nt35597_get_modes(struct drm_panel *panel,
  380. struct drm_connector *connector)
  381. {
  382. struct truly_nt35597 *ctx = panel_to_ctx(panel);
  383. struct drm_display_mode *mode;
  384. const struct nt35597_config *config;
  385. config = ctx->config;
  386. mode = drm_mode_create(connector->dev);
  387. if (!mode) {
  388. dev_err(ctx->dev, "failed to create a new display mode\n");
  389. return 0;
  390. }
  391. connector->display_info.width_mm = config->width_mm;
  392. connector->display_info.height_mm = config->height_mm;
  393. drm_mode_copy(mode, config->dm);
  394. mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
  395. drm_mode_probed_add(connector, mode);
  396. return 1;
  397. }
  398. static const struct drm_panel_funcs truly_nt35597_drm_funcs = {
  399. .disable = truly_nt35597_disable,
  400. .unprepare = truly_nt35597_unprepare,
  401. .prepare = truly_nt35597_prepare,
  402. .enable = truly_nt35597_enable,
  403. .get_modes = truly_nt35597_get_modes,
  404. };
  405. static int truly_nt35597_panel_add(struct truly_nt35597 *ctx)
  406. {
  407. struct device *dev = ctx->dev;
  408. int ret, i;
  409. for (i = 0; i < ARRAY_SIZE(ctx->supplies); i++)
  410. ctx->supplies[i].supply = regulator_names[i];
  411. ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(ctx->supplies),
  412. ctx->supplies);
  413. if (ret < 0)
  414. return ret;
  415. ctx->reset_gpio = devm_gpiod_get(dev, "reset", GPIOD_OUT_LOW);
  416. if (IS_ERR(ctx->reset_gpio)) {
  417. dev_err(dev, "cannot get reset gpio %ld\n", PTR_ERR(ctx->reset_gpio));
  418. return PTR_ERR(ctx->reset_gpio);
  419. }
  420. ctx->mode_gpio = devm_gpiod_get(dev, "mode", GPIOD_OUT_LOW);
  421. if (IS_ERR(ctx->mode_gpio)) {
  422. dev_err(dev, "cannot get mode gpio %ld\n", PTR_ERR(ctx->mode_gpio));
  423. return PTR_ERR(ctx->mode_gpio);
  424. }
  425. /* dual port */
  426. gpiod_set_value(ctx->mode_gpio, 0);
  427. drm_panel_init(&ctx->panel, dev, &truly_nt35597_drm_funcs,
  428. DRM_MODE_CONNECTOR_DSI);
  429. drm_panel_add(&ctx->panel);
  430. return 0;
  431. }
  432. static const struct drm_display_mode qcom_sdm845_mtp_2k_mode = {
  433. .name = "1440x2560",
  434. .clock = 268316,
  435. .hdisplay = 1440,
  436. .hsync_start = 1440 + 200,
  437. .hsync_end = 1440 + 200 + 32,
  438. .htotal = 1440 + 200 + 32 + 64,
  439. .vdisplay = 2560,
  440. .vsync_start = 2560 + 8,
  441. .vsync_end = 2560 + 8 + 1,
  442. .vtotal = 2560 + 8 + 1 + 7,
  443. .flags = 0,
  444. };
  445. static const struct nt35597_config nt35597_dir = {
  446. .width_mm = 74,
  447. .height_mm = 131,
  448. .panel_name = "qcom_sdm845_mtp_2k_panel",
  449. .dm = &qcom_sdm845_mtp_2k_mode,
  450. .panel_on_cmds = qcom_2k_panel_magic_cmds,
  451. .num_on_cmds = ARRAY_SIZE(qcom_2k_panel_magic_cmds),
  452. };
  453. static int truly_nt35597_probe(struct mipi_dsi_device *dsi)
  454. {
  455. struct device *dev = &dsi->dev;
  456. struct truly_nt35597 *ctx;
  457. struct mipi_dsi_device *dsi1_device;
  458. struct device_node *dsi1;
  459. struct mipi_dsi_host *dsi1_host;
  460. struct mipi_dsi_device *dsi_dev;
  461. int ret = 0;
  462. int i;
  463. const struct mipi_dsi_device_info info = {
  464. .type = "trulynt35597",
  465. .channel = 0,
  466. .node = NULL,
  467. };
  468. ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL);
  469. if (!ctx)
  470. return -ENOMEM;
  471. /*
  472. * This device represents itself as one with two input ports which are
  473. * fed by the output ports of the two DSI controllers . The DSI0 is
  474. * the master controller and has most of the panel related info in its
  475. * child node.
  476. */
  477. ctx->config = of_device_get_match_data(dev);
  478. if (!ctx->config) {
  479. dev_err(dev, "missing device configuration\n");
  480. return -ENODEV;
  481. }
  482. dsi1 = of_graph_get_remote_node(dsi->dev.of_node, 1, -1);
  483. if (!dsi1) {
  484. dev_err(dev, "failed to get remote node for dsi1_device\n");
  485. return -ENODEV;
  486. }
  487. dsi1_host = of_find_mipi_dsi_host_by_node(dsi1);
  488. of_node_put(dsi1);
  489. if (!dsi1_host) {
  490. dev_err(dev, "failed to find dsi host\n");
  491. return -EPROBE_DEFER;
  492. }
  493. /* register the second DSI device */
  494. dsi1_device = mipi_dsi_device_register_full(dsi1_host, &info);
  495. if (IS_ERR(dsi1_device)) {
  496. dev_err(dev, "failed to create dsi device\n");
  497. return PTR_ERR(dsi1_device);
  498. }
  499. mipi_dsi_set_drvdata(dsi, ctx);
  500. ctx->dev = dev;
  501. ctx->dsi[0] = dsi;
  502. ctx->dsi[1] = dsi1_device;
  503. ret = truly_nt35597_panel_add(ctx);
  504. if (ret) {
  505. dev_err(dev, "failed to add panel\n");
  506. goto err_panel_add;
  507. }
  508. for (i = 0; i < ARRAY_SIZE(ctx->dsi); i++) {
  509. dsi_dev = ctx->dsi[i];
  510. dsi_dev->lanes = 4;
  511. dsi_dev->format = MIPI_DSI_FMT_RGB888;
  512. dsi_dev->mode_flags = MIPI_DSI_MODE_VIDEO | MIPI_DSI_MODE_LPM |
  513. MIPI_DSI_CLOCK_NON_CONTINUOUS;
  514. ret = mipi_dsi_attach(dsi_dev);
  515. if (ret < 0) {
  516. dev_err(dev, "dsi attach failed i = %d\n", i);
  517. goto err_dsi_attach;
  518. }
  519. }
  520. return 0;
  521. err_dsi_attach:
  522. drm_panel_remove(&ctx->panel);
  523. err_panel_add:
  524. mipi_dsi_device_unregister(dsi1_device);
  525. return ret;
  526. }
  527. static int truly_nt35597_remove(struct mipi_dsi_device *dsi)
  528. {
  529. struct truly_nt35597 *ctx = mipi_dsi_get_drvdata(dsi);
  530. if (ctx->dsi[0])
  531. mipi_dsi_detach(ctx->dsi[0]);
  532. if (ctx->dsi[1]) {
  533. mipi_dsi_detach(ctx->dsi[1]);
  534. mipi_dsi_device_unregister(ctx->dsi[1]);
  535. }
  536. drm_panel_remove(&ctx->panel);
  537. return 0;
  538. }
  539. static const struct of_device_id truly_nt35597_of_match[] = {
  540. {
  541. .compatible = "truly,nt35597-2K-display",
  542. .data = &nt35597_dir,
  543. },
  544. { }
  545. };
  546. MODULE_DEVICE_TABLE(of, truly_nt35597_of_match);
  547. static struct mipi_dsi_driver truly_nt35597_driver = {
  548. .driver = {
  549. .name = "panel-truly-nt35597",
  550. .of_match_table = truly_nt35597_of_match,
  551. },
  552. .probe = truly_nt35597_probe,
  553. .remove = truly_nt35597_remove,
  554. };
  555. module_mipi_dsi_driver(truly_nt35597_driver);
  556. MODULE_DESCRIPTION("Truly NT35597 DSI Panel Driver");
  557. MODULE_LICENSE("GPL v2");