Linux Audio

Check our new training course

Loading...
v6.13.7
  1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 * Copyright (c) 2017, Fuzhou Rockchip Electronics Co., Ltd
  4 */
  5
 
  6#include <linux/delay.h>
  7#include <linux/gpio/consumer.h>
  8#include <linux/module.h>
  9#include <linux/of.h>
 10#include <linux/regulator/consumer.h>
 11
 12#include <video/mipi_display.h>
 13
 14#include <drm/drm_crtc.h>
 15#include <drm/drm_device.h>
 16#include <drm/drm_mipi_dsi.h>
 17#include <drm/drm_modes.h>
 18#include <drm/drm_panel.h>
 
 19
 20struct kingdisplay_panel {
 21	struct drm_panel base;
 22	struct mipi_dsi_device *link;
 23
 
 24	struct regulator *supply;
 25	struct gpio_desc *enable_gpio;
 
 
 
 26};
 27
 28struct kingdisplay_panel_cmd {
 29	char cmd;
 30	char data;
 31};
 32
 33/*
 34 * According to the discussion on
 35 * https://review.coreboot.org/#/c/coreboot/+/22472/
 36 * the panel init array is not part of the panels datasheet but instead
 37 * just came in this form from the panel vendor.
 38 */
 39static const struct kingdisplay_panel_cmd init_code[] = {
 40	/* voltage setting */
 41	{ 0xB0, 0x00 },
 42	{ 0xB2, 0x02 },
 43	{ 0xB3, 0x11 },
 44	{ 0xB4, 0x00 },
 45	{ 0xB6, 0x80 },
 46	/* VCOM disable */
 47	{ 0xB7, 0x02 },
 48	{ 0xB8, 0x80 },
 49	{ 0xBA, 0x43 },
 50	/* VCOM setting */
 51	{ 0xBB, 0x53 },
 52	/* VSP setting */
 53	{ 0xBC, 0x0A },
 54	/* VSN setting */
 55	{ 0xBD, 0x4A },
 56	/* VGH setting */
 57	{ 0xBE, 0x2F },
 58	/* VGL setting */
 59	{ 0xBF, 0x1A },
 60	{ 0xF0, 0x39 },
 61	{ 0xF1, 0x22 },
 62	/* Gamma setting */
 63	{ 0xB0, 0x02 },
 64	{ 0xC0, 0x00 },
 65	{ 0xC1, 0x01 },
 66	{ 0xC2, 0x0B },
 67	{ 0xC3, 0x15 },
 68	{ 0xC4, 0x22 },
 69	{ 0xC5, 0x11 },
 70	{ 0xC6, 0x15 },
 71	{ 0xC7, 0x19 },
 72	{ 0xC8, 0x1A },
 73	{ 0xC9, 0x16 },
 74	{ 0xCA, 0x18 },
 75	{ 0xCB, 0x13 },
 76	{ 0xCC, 0x18 },
 77	{ 0xCD, 0x13 },
 78	{ 0xCE, 0x1C },
 79	{ 0xCF, 0x19 },
 80	{ 0xD0, 0x21 },
 81	{ 0xD1, 0x2C },
 82	{ 0xD2, 0x2F },
 83	{ 0xD3, 0x30 },
 84	{ 0xD4, 0x19 },
 85	{ 0xD5, 0x1F },
 86	{ 0xD6, 0x00 },
 87	{ 0xD7, 0x01 },
 88	{ 0xD8, 0x0B },
 89	{ 0xD9, 0x15 },
 90	{ 0xDA, 0x22 },
 91	{ 0xDB, 0x11 },
 92	{ 0xDC, 0x15 },
 93	{ 0xDD, 0x19 },
 94	{ 0xDE, 0x1A },
 95	{ 0xDF, 0x16 },
 96	{ 0xE0, 0x18 },
 97	{ 0xE1, 0x13 },
 98	{ 0xE2, 0x18 },
 99	{ 0xE3, 0x13 },
100	{ 0xE4, 0x1C },
101	{ 0xE5, 0x19 },
102	{ 0xE6, 0x21 },
103	{ 0xE7, 0x2C },
104	{ 0xE8, 0x2F },
105	{ 0xE9, 0x30 },
106	{ 0xEA, 0x19 },
107	{ 0xEB, 0x1F },
108	/* GOA MUX setting */
109	{ 0xB0, 0x01 },
110	{ 0xC0, 0x10 },
111	{ 0xC1, 0x0F },
112	{ 0xC2, 0x0E },
113	{ 0xC3, 0x0D },
114	{ 0xC4, 0x0C },
115	{ 0xC5, 0x0B },
116	{ 0xC6, 0x0A },
117	{ 0xC7, 0x09 },
118	{ 0xC8, 0x08 },
119	{ 0xC9, 0x07 },
120	{ 0xCA, 0x06 },
121	{ 0xCB, 0x05 },
122	{ 0xCC, 0x00 },
123	{ 0xCD, 0x01 },
124	{ 0xCE, 0x02 },
125	{ 0xCF, 0x03 },
126	{ 0xD0, 0x04 },
127	{ 0xD6, 0x10 },
128	{ 0xD7, 0x0F },
129	{ 0xD8, 0x0E },
130	{ 0xD9, 0x0D },
131	{ 0xDA, 0x0C },
132	{ 0xDB, 0x0B },
133	{ 0xDC, 0x0A },
134	{ 0xDD, 0x09 },
135	{ 0xDE, 0x08 },
136	{ 0xDF, 0x07 },
137	{ 0xE0, 0x06 },
138	{ 0xE1, 0x05 },
139	{ 0xE2, 0x00 },
140	{ 0xE3, 0x01 },
141	{ 0xE4, 0x02 },
142	{ 0xE5, 0x03 },
143	{ 0xE6, 0x04 },
144	{ 0xE7, 0x00 },
145	{ 0xEC, 0xC0 },
146	/* GOA timing setting */
147	{ 0xB0, 0x03 },
148	{ 0xC0, 0x01 },
149	{ 0xC2, 0x6F },
150	{ 0xC3, 0x6F },
151	{ 0xC5, 0x36 },
152	{ 0xC8, 0x08 },
153	{ 0xC9, 0x04 },
154	{ 0xCA, 0x41 },
155	{ 0xCC, 0x43 },
156	{ 0xCF, 0x60 },
157	{ 0xD2, 0x04 },
158	{ 0xD3, 0x04 },
159	{ 0xD4, 0x03 },
160	{ 0xD5, 0x02 },
161	{ 0xD6, 0x01 },
162	{ 0xD7, 0x00 },
163	{ 0xDB, 0x01 },
164	{ 0xDE, 0x36 },
165	{ 0xE6, 0x6F },
166	{ 0xE7, 0x6F },
167	/* GOE setting */
168	{ 0xB0, 0x06 },
169	{ 0xB8, 0xA5 },
170	{ 0xC0, 0xA5 },
171	{ 0xD5, 0x3F },
172};
173
174static inline
175struct kingdisplay_panel *to_kingdisplay_panel(struct drm_panel *panel)
176{
177	return container_of(panel, struct kingdisplay_panel, base);
178}
179
180static int kingdisplay_panel_disable(struct drm_panel *panel)
181{
182	struct kingdisplay_panel *kingdisplay = to_kingdisplay_panel(panel);
183	int err;
184
 
 
 
 
 
185	err = mipi_dsi_dcs_set_display_off(kingdisplay->link);
186	if (err < 0)
187		dev_err(panel->dev, "failed to set display off: %d\n", err);
 
 
 
188
189	return 0;
190}
191
192static int kingdisplay_panel_unprepare(struct drm_panel *panel)
193{
194	struct kingdisplay_panel *kingdisplay = to_kingdisplay_panel(panel);
195	int err;
196
 
 
 
197	err = mipi_dsi_dcs_enter_sleep_mode(kingdisplay->link);
198	if (err < 0) {
199		dev_err(panel->dev, "failed to enter sleep mode: %d\n", err);
 
200		return err;
201	}
202
203	/* T15: 120ms */
204	msleep(120);
205
206	gpiod_set_value_cansleep(kingdisplay->enable_gpio, 0);
207
208	err = regulator_disable(kingdisplay->supply);
209	if (err < 0)
210		return err;
211
 
 
212	return 0;
213}
214
215static int kingdisplay_panel_prepare(struct drm_panel *panel)
216{
217	struct kingdisplay_panel *kingdisplay = to_kingdisplay_panel(panel);
218	int err, regulator_err;
219	unsigned int i;
220
 
 
 
221	gpiod_set_value_cansleep(kingdisplay->enable_gpio, 0);
222
223	err = regulator_enable(kingdisplay->supply);
224	if (err < 0)
225		return err;
226
227	/* T2: 15ms */
228	usleep_range(15000, 16000);
229
230	gpiod_set_value_cansleep(kingdisplay->enable_gpio, 1);
231
232	/* T4: 15ms */
233	usleep_range(15000, 16000);
234
235	for (i = 0; i < ARRAY_SIZE(init_code); i++) {
236		err = mipi_dsi_generic_write(kingdisplay->link, &init_code[i],
237					sizeof(struct kingdisplay_panel_cmd));
238		if (err < 0) {
239			dev_err(panel->dev, "failed write init cmds: %d\n", err);
 
240			goto poweroff;
241		}
242	}
243
244	err = mipi_dsi_dcs_exit_sleep_mode(kingdisplay->link);
245	if (err < 0) {
246		dev_err(panel->dev, "failed to exit sleep mode: %d\n", err);
 
247		goto poweroff;
248	}
249
250	/* T6: 120ms */
251	msleep(120);
252
253	err = mipi_dsi_dcs_set_display_on(kingdisplay->link);
254	if (err < 0) {
255		dev_err(panel->dev, "failed to set display on: %d\n", err);
 
256		goto poweroff;
257	}
258
259	/* T7: 10ms */
260	usleep_range(10000, 11000);
261
 
 
262	return 0;
263
264poweroff:
265	gpiod_set_value_cansleep(kingdisplay->enable_gpio, 0);
266
267	regulator_err = regulator_disable(kingdisplay->supply);
268	if (regulator_err)
269		dev_err(panel->dev, "failed to disable regulator: %d\n", regulator_err);
 
270
271	return err;
272}
273
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
274static const struct drm_display_mode default_mode = {
275	.clock = 229000,
276	.hdisplay = 1536,
277	.hsync_start = 1536 + 100,
278	.hsync_end = 1536 + 100 + 24,
279	.htotal = 1536 + 100 + 24 + 100,
280	.vdisplay = 2048,
281	.vsync_start = 2048 + 95,
282	.vsync_end = 2048 + 95 + 2,
283	.vtotal = 2048 + 95 + 2 + 23,
 
284};
285
286static int kingdisplay_panel_get_modes(struct drm_panel *panel,
287				       struct drm_connector *connector)
288{
289	struct drm_display_mode *mode;
290
291	mode = drm_mode_duplicate(connector->dev, &default_mode);
292	if (!mode) {
293		dev_err(panel->dev, "failed to add mode %ux%u@%u\n",
294			default_mode.hdisplay, default_mode.vdisplay,
295			drm_mode_vrefresh(&default_mode));
296		return -ENOMEM;
297	}
298
299	drm_mode_set_name(mode);
300
301	drm_mode_probed_add(connector, mode);
302
303	connector->display_info.width_mm = 147;
304	connector->display_info.height_mm = 196;
305	connector->display_info.bpc = 8;
306
307	return 1;
308}
309
310static const struct drm_panel_funcs kingdisplay_panel_funcs = {
311	.disable = kingdisplay_panel_disable,
312	.unprepare = kingdisplay_panel_unprepare,
313	.prepare = kingdisplay_panel_prepare,
 
314	.get_modes = kingdisplay_panel_get_modes,
315};
316
317static const struct of_device_id kingdisplay_of_match[] = {
318	{ .compatible = "kingdisplay,kd097d04", },
319	{ }
320};
321MODULE_DEVICE_TABLE(of, kingdisplay_of_match);
322
323static int kingdisplay_panel_add(struct kingdisplay_panel *kingdisplay)
324{
325	struct device *dev = &kingdisplay->link->dev;
326	int err;
327
328	kingdisplay->supply = devm_regulator_get(dev, "power");
329	if (IS_ERR(kingdisplay->supply))
330		return PTR_ERR(kingdisplay->supply);
331
332	kingdisplay->enable_gpio = devm_gpiod_get_optional(dev, "enable",
333							   GPIOD_OUT_HIGH);
334	if (IS_ERR(kingdisplay->enable_gpio)) {
335		err = PTR_ERR(kingdisplay->enable_gpio);
336		dev_dbg(dev, "failed to get enable gpio: %d\n", err);
337		kingdisplay->enable_gpio = NULL;
338	}
339
340	drm_panel_init(&kingdisplay->base, &kingdisplay->link->dev,
341		       &kingdisplay_panel_funcs, DRM_MODE_CONNECTOR_DSI);
342
343	err = drm_panel_of_backlight(&kingdisplay->base);
344	if (err)
345		return err;
346
347	drm_panel_add(&kingdisplay->base);
348
349	return 0;
350}
351
352static void kingdisplay_panel_del(struct kingdisplay_panel *kingdisplay)
353{
354	drm_panel_remove(&kingdisplay->base);
355}
356
357static int kingdisplay_panel_probe(struct mipi_dsi_device *dsi)
358{
359	struct kingdisplay_panel *kingdisplay;
360	int err;
361
362	dsi->lanes = 4;
363	dsi->format = MIPI_DSI_FMT_RGB888;
364	dsi->mode_flags = MIPI_DSI_MODE_VIDEO | MIPI_DSI_MODE_VIDEO_BURST |
365			  MIPI_DSI_MODE_LPM;
366
367	kingdisplay = devm_kzalloc(&dsi->dev, sizeof(*kingdisplay), GFP_KERNEL);
368	if (!kingdisplay)
369		return -ENOMEM;
370
371	mipi_dsi_set_drvdata(dsi, kingdisplay);
372	kingdisplay->link = dsi;
373
374	err = kingdisplay_panel_add(kingdisplay);
375	if (err < 0)
376		return err;
377
378	err = mipi_dsi_attach(dsi);
379	if (err < 0) {
380		kingdisplay_panel_del(kingdisplay);
381		return err;
382	}
383
384	return 0;
385}
386
387static void kingdisplay_panel_remove(struct mipi_dsi_device *dsi)
388{
389	struct kingdisplay_panel *kingdisplay = mipi_dsi_get_drvdata(dsi);
390	int err;
391
 
 
 
 
 
 
 
 
 
392	err = mipi_dsi_detach(dsi);
393	if (err < 0)
394		dev_err(&dsi->dev, "failed to detach from DSI host: %d\n", err);
 
395
396	kingdisplay_panel_del(kingdisplay);
 
 
 
 
 
 
 
 
 
 
397}
398
399static struct mipi_dsi_driver kingdisplay_panel_driver = {
400	.driver = {
401		.name = "panel-kingdisplay-kd097d04",
402		.of_match_table = kingdisplay_of_match,
403	},
404	.probe = kingdisplay_panel_probe,
405	.remove = kingdisplay_panel_remove,
 
406};
407module_mipi_dsi_driver(kingdisplay_panel_driver);
408
409MODULE_AUTHOR("Chris Zhong <zyw@rock-chips.com>");
410MODULE_AUTHOR("Nickey Yang <nickey.yang@rock-chips.com>");
411MODULE_DESCRIPTION("kingdisplay KD097D04 panel driver");
412MODULE_LICENSE("GPL v2");
v5.4
  1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 * Copyright (c) 2017, Fuzhou Rockchip Electronics Co., Ltd
  4 */
  5
  6#include <linux/backlight.h>
  7#include <linux/delay.h>
  8#include <linux/gpio/consumer.h>
  9#include <linux/module.h>
 10#include <linux/of.h>
 11#include <linux/regulator/consumer.h>
 12
 13#include <video/mipi_display.h>
 14
 15#include <drm/drm_crtc.h>
 16#include <drm/drm_device.h>
 17#include <drm/drm_mipi_dsi.h>
 18#include <drm/drm_modes.h>
 19#include <drm/drm_panel.h>
 20#include <drm/drm_print.h>
 21
 22struct kingdisplay_panel {
 23	struct drm_panel base;
 24	struct mipi_dsi_device *link;
 25
 26	struct backlight_device *backlight;
 27	struct regulator *supply;
 28	struct gpio_desc *enable_gpio;
 29
 30	bool prepared;
 31	bool enabled;
 32};
 33
 34struct kingdisplay_panel_cmd {
 35	char cmd;
 36	char data;
 37};
 38
 39/*
 40 * According to the discussion on
 41 * https://review.coreboot.org/#/c/coreboot/+/22472/
 42 * the panel init array is not part of the panels datasheet but instead
 43 * just came in this form from the panel vendor.
 44 */
 45static const struct kingdisplay_panel_cmd init_code[] = {
 46	/* voltage setting */
 47	{ 0xB0, 0x00 },
 48	{ 0xB2, 0x02 },
 49	{ 0xB3, 0x11 },
 50	{ 0xB4, 0x00 },
 51	{ 0xB6, 0x80 },
 52	/* VCOM disable */
 53	{ 0xB7, 0x02 },
 54	{ 0xB8, 0x80 },
 55	{ 0xBA, 0x43 },
 56	/* VCOM setting */
 57	{ 0xBB, 0x53 },
 58	/* VSP setting */
 59	{ 0xBC, 0x0A },
 60	/* VSN setting */
 61	{ 0xBD, 0x4A },
 62	/* VGH setting */
 63	{ 0xBE, 0x2F },
 64	/* VGL setting */
 65	{ 0xBF, 0x1A },
 66	{ 0xF0, 0x39 },
 67	{ 0xF1, 0x22 },
 68	/* Gamma setting */
 69	{ 0xB0, 0x02 },
 70	{ 0xC0, 0x00 },
 71	{ 0xC1, 0x01 },
 72	{ 0xC2, 0x0B },
 73	{ 0xC3, 0x15 },
 74	{ 0xC4, 0x22 },
 75	{ 0xC5, 0x11 },
 76	{ 0xC6, 0x15 },
 77	{ 0xC7, 0x19 },
 78	{ 0xC8, 0x1A },
 79	{ 0xC9, 0x16 },
 80	{ 0xCA, 0x18 },
 81	{ 0xCB, 0x13 },
 82	{ 0xCC, 0x18 },
 83	{ 0xCD, 0x13 },
 84	{ 0xCE, 0x1C },
 85	{ 0xCF, 0x19 },
 86	{ 0xD0, 0x21 },
 87	{ 0xD1, 0x2C },
 88	{ 0xD2, 0x2F },
 89	{ 0xD3, 0x30 },
 90	{ 0xD4, 0x19 },
 91	{ 0xD5, 0x1F },
 92	{ 0xD6, 0x00 },
 93	{ 0xD7, 0x01 },
 94	{ 0xD8, 0x0B },
 95	{ 0xD9, 0x15 },
 96	{ 0xDA, 0x22 },
 97	{ 0xDB, 0x11 },
 98	{ 0xDC, 0x15 },
 99	{ 0xDD, 0x19 },
100	{ 0xDE, 0x1A },
101	{ 0xDF, 0x16 },
102	{ 0xE0, 0x18 },
103	{ 0xE1, 0x13 },
104	{ 0xE2, 0x18 },
105	{ 0xE3, 0x13 },
106	{ 0xE4, 0x1C },
107	{ 0xE5, 0x19 },
108	{ 0xE6, 0x21 },
109	{ 0xE7, 0x2C },
110	{ 0xE8, 0x2F },
111	{ 0xE9, 0x30 },
112	{ 0xEA, 0x19 },
113	{ 0xEB, 0x1F },
114	/* GOA MUX setting */
115	{ 0xB0, 0x01 },
116	{ 0xC0, 0x10 },
117	{ 0xC1, 0x0F },
118	{ 0xC2, 0x0E },
119	{ 0xC3, 0x0D },
120	{ 0xC4, 0x0C },
121	{ 0xC5, 0x0B },
122	{ 0xC6, 0x0A },
123	{ 0xC7, 0x09 },
124	{ 0xC8, 0x08 },
125	{ 0xC9, 0x07 },
126	{ 0xCA, 0x06 },
127	{ 0xCB, 0x05 },
128	{ 0xCC, 0x00 },
129	{ 0xCD, 0x01 },
130	{ 0xCE, 0x02 },
131	{ 0xCF, 0x03 },
132	{ 0xD0, 0x04 },
133	{ 0xD6, 0x10 },
134	{ 0xD7, 0x0F },
135	{ 0xD8, 0x0E },
136	{ 0xD9, 0x0D },
137	{ 0xDA, 0x0C },
138	{ 0xDB, 0x0B },
139	{ 0xDC, 0x0A },
140	{ 0xDD, 0x09 },
141	{ 0xDE, 0x08 },
142	{ 0xDF, 0x07 },
143	{ 0xE0, 0x06 },
144	{ 0xE1, 0x05 },
145	{ 0xE2, 0x00 },
146	{ 0xE3, 0x01 },
147	{ 0xE4, 0x02 },
148	{ 0xE5, 0x03 },
149	{ 0xE6, 0x04 },
150	{ 0xE7, 0x00 },
151	{ 0xEC, 0xC0 },
152	/* GOA timing setting */
153	{ 0xB0, 0x03 },
154	{ 0xC0, 0x01 },
155	{ 0xC2, 0x6F },
156	{ 0xC3, 0x6F },
157	{ 0xC5, 0x36 },
158	{ 0xC8, 0x08 },
159	{ 0xC9, 0x04 },
160	{ 0xCA, 0x41 },
161	{ 0xCC, 0x43 },
162	{ 0xCF, 0x60 },
163	{ 0xD2, 0x04 },
164	{ 0xD3, 0x04 },
165	{ 0xD4, 0x03 },
166	{ 0xD5, 0x02 },
167	{ 0xD6, 0x01 },
168	{ 0xD7, 0x00 },
169	{ 0xDB, 0x01 },
170	{ 0xDE, 0x36 },
171	{ 0xE6, 0x6F },
172	{ 0xE7, 0x6F },
173	/* GOE setting */
174	{ 0xB0, 0x06 },
175	{ 0xB8, 0xA5 },
176	{ 0xC0, 0xA5 },
177	{ 0xD5, 0x3F },
178};
179
180static inline
181struct kingdisplay_panel *to_kingdisplay_panel(struct drm_panel *panel)
182{
183	return container_of(panel, struct kingdisplay_panel, base);
184}
185
186static int kingdisplay_panel_disable(struct drm_panel *panel)
187{
188	struct kingdisplay_panel *kingdisplay = to_kingdisplay_panel(panel);
189	int err;
190
191	if (!kingdisplay->enabled)
192		return 0;
193
194	backlight_disable(kingdisplay->backlight);
195
196	err = mipi_dsi_dcs_set_display_off(kingdisplay->link);
197	if (err < 0)
198		DRM_DEV_ERROR(panel->dev, "failed to set display off: %d\n",
199			      err);
200
201	kingdisplay->enabled = false;
202
203	return 0;
204}
205
206static int kingdisplay_panel_unprepare(struct drm_panel *panel)
207{
208	struct kingdisplay_panel *kingdisplay = to_kingdisplay_panel(panel);
209	int err;
210
211	if (!kingdisplay->prepared)
212		return 0;
213
214	err = mipi_dsi_dcs_enter_sleep_mode(kingdisplay->link);
215	if (err < 0) {
216		DRM_DEV_ERROR(panel->dev, "failed to enter sleep mode: %d\n",
217			      err);
218		return err;
219	}
220
221	/* T15: 120ms */
222	msleep(120);
223
224	gpiod_set_value_cansleep(kingdisplay->enable_gpio, 0);
225
226	err = regulator_disable(kingdisplay->supply);
227	if (err < 0)
228		return err;
229
230	kingdisplay->prepared = false;
231
232	return 0;
233}
234
235static int kingdisplay_panel_prepare(struct drm_panel *panel)
236{
237	struct kingdisplay_panel *kingdisplay = to_kingdisplay_panel(panel);
238	int err, regulator_err;
239	unsigned int i;
240
241	if (kingdisplay->prepared)
242		return 0;
243
244	gpiod_set_value_cansleep(kingdisplay->enable_gpio, 0);
245
246	err = regulator_enable(kingdisplay->supply);
247	if (err < 0)
248		return err;
249
250	/* T2: 15ms */
251	usleep_range(15000, 16000);
252
253	gpiod_set_value_cansleep(kingdisplay->enable_gpio, 1);
254
255	/* T4: 15ms */
256	usleep_range(15000, 16000);
257
258	for (i = 0; i < ARRAY_SIZE(init_code); i++) {
259		err = mipi_dsi_generic_write(kingdisplay->link, &init_code[i],
260					sizeof(struct kingdisplay_panel_cmd));
261		if (err < 0) {
262			DRM_DEV_ERROR(panel->dev, "failed write init cmds: %d\n",
263				      err);
264			goto poweroff;
265		}
266	}
267
268	err = mipi_dsi_dcs_exit_sleep_mode(kingdisplay->link);
269	if (err < 0) {
270		DRM_DEV_ERROR(panel->dev, "failed to exit sleep mode: %d\n",
271			      err);
272		goto poweroff;
273	}
274
275	/* T6: 120ms */
276	msleep(120);
277
278	err = mipi_dsi_dcs_set_display_on(kingdisplay->link);
279	if (err < 0) {
280		DRM_DEV_ERROR(panel->dev, "failed to set display on: %d\n",
281			      err);
282		goto poweroff;
283	}
284
285	/* T7: 10ms */
286	usleep_range(10000, 11000);
287
288	kingdisplay->prepared = true;
289
290	return 0;
291
292poweroff:
293	gpiod_set_value_cansleep(kingdisplay->enable_gpio, 0);
294
295	regulator_err = regulator_disable(kingdisplay->supply);
296	if (regulator_err)
297		DRM_DEV_ERROR(panel->dev, "failed to disable regulator: %d\n",
298			      regulator_err);
299
300	return err;
301}
302
303static int kingdisplay_panel_enable(struct drm_panel *panel)
304{
305	struct kingdisplay_panel *kingdisplay = to_kingdisplay_panel(panel);
306	int ret;
307
308	if (kingdisplay->enabled)
309		return 0;
310
311	ret = backlight_enable(kingdisplay->backlight);
312	if (ret) {
313		DRM_DEV_ERROR(panel->drm->dev,
314			      "Failed to enable backlight %d\n", ret);
315		return ret;
316	}
317
318	kingdisplay->enabled = true;
319
320	return 0;
321}
322
323static const struct drm_display_mode default_mode = {
324	.clock = 229000,
325	.hdisplay = 1536,
326	.hsync_start = 1536 + 100,
327	.hsync_end = 1536 + 100 + 24,
328	.htotal = 1536 + 100 + 24 + 100,
329	.vdisplay = 2048,
330	.vsync_start = 2048 + 95,
331	.vsync_end = 2048 + 95 + 2,
332	.vtotal = 2048 + 95 + 2 + 23,
333	.vrefresh = 60,
334};
335
336static int kingdisplay_panel_get_modes(struct drm_panel *panel)
 
337{
338	struct drm_display_mode *mode;
339
340	mode = drm_mode_duplicate(panel->drm, &default_mode);
341	if (!mode) {
342		DRM_DEV_ERROR(panel->drm->dev, "failed to add mode %ux%ux@%u\n",
343			      default_mode.hdisplay, default_mode.vdisplay,
344			      default_mode.vrefresh);
345		return -ENOMEM;
346	}
347
348	drm_mode_set_name(mode);
349
350	drm_mode_probed_add(panel->connector, mode);
351
352	panel->connector->display_info.width_mm = 147;
353	panel->connector->display_info.height_mm = 196;
354	panel->connector->display_info.bpc = 8;
355
356	return 1;
357}
358
359static const struct drm_panel_funcs kingdisplay_panel_funcs = {
360	.disable = kingdisplay_panel_disable,
361	.unprepare = kingdisplay_panel_unprepare,
362	.prepare = kingdisplay_panel_prepare,
363	.enable = kingdisplay_panel_enable,
364	.get_modes = kingdisplay_panel_get_modes,
365};
366
367static const struct of_device_id kingdisplay_of_match[] = {
368	{ .compatible = "kingdisplay,kd097d04", },
369	{ }
370};
371MODULE_DEVICE_TABLE(of, kingdisplay_of_match);
372
373static int kingdisplay_panel_add(struct kingdisplay_panel *kingdisplay)
374{
375	struct device *dev = &kingdisplay->link->dev;
376	int err;
377
378	kingdisplay->supply = devm_regulator_get(dev, "power");
379	if (IS_ERR(kingdisplay->supply))
380		return PTR_ERR(kingdisplay->supply);
381
382	kingdisplay->enable_gpio = devm_gpiod_get_optional(dev, "enable",
383							   GPIOD_OUT_HIGH);
384	if (IS_ERR(kingdisplay->enable_gpio)) {
385		err = PTR_ERR(kingdisplay->enable_gpio);
386		dev_dbg(dev, "failed to get enable gpio: %d\n", err);
387		kingdisplay->enable_gpio = NULL;
388	}
389
390	kingdisplay->backlight = devm_of_find_backlight(dev);
391	if (IS_ERR(kingdisplay->backlight))
392		return PTR_ERR(kingdisplay->backlight);
393
394	drm_panel_init(&kingdisplay->base);
395	kingdisplay->base.funcs = &kingdisplay_panel_funcs;
396	kingdisplay->base.dev = &kingdisplay->link->dev;
 
397
398	return drm_panel_add(&kingdisplay->base);
399}
400
401static void kingdisplay_panel_del(struct kingdisplay_panel *kingdisplay)
402{
403	drm_panel_remove(&kingdisplay->base);
404}
405
406static int kingdisplay_panel_probe(struct mipi_dsi_device *dsi)
407{
408	struct kingdisplay_panel *kingdisplay;
409	int err;
410
411	dsi->lanes = 4;
412	dsi->format = MIPI_DSI_FMT_RGB888;
413	dsi->mode_flags = MIPI_DSI_MODE_VIDEO | MIPI_DSI_MODE_VIDEO_BURST |
414			  MIPI_DSI_MODE_LPM;
415
416	kingdisplay = devm_kzalloc(&dsi->dev, sizeof(*kingdisplay), GFP_KERNEL);
417	if (!kingdisplay)
418		return -ENOMEM;
419
420	mipi_dsi_set_drvdata(dsi, kingdisplay);
421	kingdisplay->link = dsi;
422
423	err = kingdisplay_panel_add(kingdisplay);
424	if (err < 0)
425		return err;
426
427	return mipi_dsi_attach(dsi);
 
 
 
 
 
 
428}
429
430static int kingdisplay_panel_remove(struct mipi_dsi_device *dsi)
431{
432	struct kingdisplay_panel *kingdisplay = mipi_dsi_get_drvdata(dsi);
433	int err;
434
435	err = kingdisplay_panel_unprepare(&kingdisplay->base);
436	if (err < 0)
437		DRM_DEV_ERROR(&dsi->dev, "failed to unprepare panel: %d\n",
438			      err);
439
440	err = kingdisplay_panel_disable(&kingdisplay->base);
441	if (err < 0)
442		DRM_DEV_ERROR(&dsi->dev, "failed to disable panel: %d\n", err);
443
444	err = mipi_dsi_detach(dsi);
445	if (err < 0)
446		DRM_DEV_ERROR(&dsi->dev, "failed to detach from DSI host: %d\n",
447			      err);
448
449	kingdisplay_panel_del(kingdisplay);
450
451	return 0;
452}
453
454static void kingdisplay_panel_shutdown(struct mipi_dsi_device *dsi)
455{
456	struct kingdisplay_panel *kingdisplay = mipi_dsi_get_drvdata(dsi);
457
458	kingdisplay_panel_unprepare(&kingdisplay->base);
459	kingdisplay_panel_disable(&kingdisplay->base);
460}
461
462static struct mipi_dsi_driver kingdisplay_panel_driver = {
463	.driver = {
464		.name = "panel-kingdisplay-kd097d04",
465		.of_match_table = kingdisplay_of_match,
466	},
467	.probe = kingdisplay_panel_probe,
468	.remove = kingdisplay_panel_remove,
469	.shutdown = kingdisplay_panel_shutdown,
470};
471module_mipi_dsi_driver(kingdisplay_panel_driver);
472
473MODULE_AUTHOR("Chris Zhong <zyw@rock-chips.com>");
474MODULE_AUTHOR("Nickey Yang <nickey.yang@rock-chips.com>");
475MODULE_DESCRIPTION("kingdisplay KD097D04 panel driver");
476MODULE_LICENSE("GPL v2");