1*249a4f5eSChris Morgan // SPDX-License-Identifier: GPL-2.0
2*249a4f5eSChris Morgan /*
3*249a4f5eSChris Morgan  * Magnachip d53e6ea8966 MIPI-DSI panel driver
4*249a4f5eSChris Morgan  * Copyright (C) 2023 Chris Morgan
5*249a4f5eSChris Morgan  */
6*249a4f5eSChris Morgan 
7*249a4f5eSChris Morgan #include <drm/drm_mipi_dbi.h>
8*249a4f5eSChris Morgan #include <drm/drm_mipi_dsi.h>
9*249a4f5eSChris Morgan #include <drm/drm_modes.h>
10*249a4f5eSChris Morgan #include <drm/drm_of.h>
11*249a4f5eSChris Morgan #include <drm/drm_panel.h>
12*249a4f5eSChris Morgan 
13*249a4f5eSChris Morgan #include <linux/backlight.h>
14*249a4f5eSChris Morgan #include <linux/delay.h>
15*249a4f5eSChris Morgan #include <linux/gpio/consumer.h>
16*249a4f5eSChris Morgan #include <linux/init.h>
17*249a4f5eSChris Morgan #include <linux/kernel.h>
18*249a4f5eSChris Morgan #include <linux/media-bus-format.h>
19*249a4f5eSChris Morgan #include <linux/module.h>
20*249a4f5eSChris Morgan #include <linux/of.h>
21*249a4f5eSChris Morgan #include <linux/of_device.h>
22*249a4f5eSChris Morgan #include <linux/regulator/consumer.h>
23*249a4f5eSChris Morgan #include <linux/spi/spi.h>
24*249a4f5eSChris Morgan 
25*249a4f5eSChris Morgan #include <video/mipi_display.h>
26*249a4f5eSChris Morgan 
27*249a4f5eSChris Morgan /* Forward declaration for use in backlight function */
28*249a4f5eSChris Morgan struct d53e6ea8966;
29*249a4f5eSChris Morgan 
30*249a4f5eSChris Morgan /* Panel info, unique to each panel */
31*249a4f5eSChris Morgan struct d53e6ea8966_panel_info {
32*249a4f5eSChris Morgan 	/** @display_modes: the supported display modes */
33*249a4f5eSChris Morgan 	const struct drm_display_mode *display_modes;
34*249a4f5eSChris Morgan 	/** @num_modes: the number of supported display modes */
35*249a4f5eSChris Morgan 	unsigned int num_modes;
36*249a4f5eSChris Morgan 	/** @width_mm: panel width in mm */
37*249a4f5eSChris Morgan 	u16 width_mm;
38*249a4f5eSChris Morgan 	/** @height_mm: panel height in mm */
39*249a4f5eSChris Morgan 	u16 height_mm;
40*249a4f5eSChris Morgan 	/** @bus_flags: drm bus flags for panel */
41*249a4f5eSChris Morgan 	u32 bus_flags;
42*249a4f5eSChris Morgan 	/** @panel_init_seq: panel specific init sequence */
43*249a4f5eSChris Morgan 	void (*panel_init_seq)(struct d53e6ea8966 *db);
44*249a4f5eSChris Morgan 	/** @backlight_register: panel backlight registration or NULL */
45*249a4f5eSChris Morgan 	int (*backlight_register)(struct d53e6ea8966 *db);
46*249a4f5eSChris Morgan };
47*249a4f5eSChris Morgan 
48*249a4f5eSChris Morgan struct d53e6ea8966 {
49*249a4f5eSChris Morgan 	/** @dev: the container device */
50*249a4f5eSChris Morgan 	struct device *dev;
51*249a4f5eSChris Morgan 	/** @dbi: the DBI bus abstraction handle */
52*249a4f5eSChris Morgan 	struct mipi_dbi dbi;
53*249a4f5eSChris Morgan 	/** @panel: the DRM panel instance for this device */
54*249a4f5eSChris Morgan 	struct drm_panel panel;
55*249a4f5eSChris Morgan 	/** @reset: reset GPIO line */
56*249a4f5eSChris Morgan 	struct gpio_desc *reset;
57*249a4f5eSChris Morgan 	/** @enable: enable GPIO line */
58*249a4f5eSChris Morgan 	struct gpio_desc *enable;
59*249a4f5eSChris Morgan 	/** @reg_vdd: VDD supply regulator for panel logic */
60*249a4f5eSChris Morgan 	struct regulator *reg_vdd;
61*249a4f5eSChris Morgan 	/** @reg_elvdd: ELVDD supply regulator for panel display */
62*249a4f5eSChris Morgan 	struct regulator *reg_elvdd;
63*249a4f5eSChris Morgan 	/** @dsi_dev: DSI child device (panel) */
64*249a4f5eSChris Morgan 	struct mipi_dsi_device *dsi_dev;
65*249a4f5eSChris Morgan 	/** @bl_dev: pseudo-backlight device for oled panel */
66*249a4f5eSChris Morgan 	struct backlight_device *bl_dev;
67*249a4f5eSChris Morgan 	/** @panel_info: struct containing panel timing and info */
68*249a4f5eSChris Morgan 	const struct d53e6ea8966_panel_info *panel_info;
69*249a4f5eSChris Morgan };
70*249a4f5eSChris Morgan 
71*249a4f5eSChris Morgan #define NUM_GAMMA_LEVELS	16
72*249a4f5eSChris Morgan #define GAMMA_TABLE_COUNT	23
73*249a4f5eSChris Morgan #define MAX_BRIGHTNESS		(NUM_GAMMA_LEVELS - 1)
74*249a4f5eSChris Morgan 
75*249a4f5eSChris Morgan #define MCS_ELVSS_ON			0xb1
76*249a4f5eSChris Morgan #define MCS_TEMP_SWIRE			0xb2
77*249a4f5eSChris Morgan #define MCS_PASSWORD_0			0xf0
78*249a4f5eSChris Morgan #define MCS_PASSWORD_1			0xf1
79*249a4f5eSChris Morgan #define MCS_ANALOG_PWR_CTL_0		0xf4
80*249a4f5eSChris Morgan #define MCS_ANALOG_PWR_CTL_1		0xf5
81*249a4f5eSChris Morgan #define MCS_GTCON_SET			0xf7
82*249a4f5eSChris Morgan #define MCS_GATELESS_SIGNAL_SET		0xf8
83*249a4f5eSChris Morgan #define MCS_SET_GAMMA			0xf9
84*249a4f5eSChris Morgan 
85*249a4f5eSChris Morgan static inline struct d53e6ea8966 *to_d53e6ea8966(struct drm_panel *panel)
86*249a4f5eSChris Morgan {
87*249a4f5eSChris Morgan 	return container_of(panel, struct d53e6ea8966, panel);
88*249a4f5eSChris Morgan }
89*249a4f5eSChris Morgan 
90*249a4f5eSChris Morgan /* Table of gamma values provided in datasheet */
91*249a4f5eSChris Morgan static u8 ams495qa01_gamma[NUM_GAMMA_LEVELS][GAMMA_TABLE_COUNT] = {
92*249a4f5eSChris Morgan 	{0x01, 0x79, 0x78, 0x8d, 0xd9, 0xdf, 0xd5, 0xcb, 0xcf, 0xc5,
93*249a4f5eSChris Morgan 	 0xe5, 0xe0, 0xe4, 0xdc, 0xb8, 0xd4, 0xfa, 0xed, 0xe6, 0x2f,
94*249a4f5eSChris Morgan 	 0x00, 0x2f},
95*249a4f5eSChris Morgan 	{0x01, 0x7d, 0x7c, 0x92, 0xd7, 0xdd, 0xd2, 0xcb, 0xd0, 0xc6,
96*249a4f5eSChris Morgan 	 0xe5, 0xe1, 0xe3, 0xda, 0xbd, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
97*249a4f5eSChris Morgan 	 0x00, 0x2f},
98*249a4f5eSChris Morgan 	{0x01, 0x7f, 0x7e, 0x95, 0xd7, 0xde, 0xd2, 0xcb, 0xcf, 0xc5,
99*249a4f5eSChris Morgan 	 0xe5, 0xe3, 0xe3, 0xda, 0xbf, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
100*249a4f5eSChris Morgan 	 0x00, 0x2f},
101*249a4f5eSChris Morgan 	{0x01, 0x82, 0x81, 0x99, 0xd6, 0xdd, 0xd1, 0xca, 0xcf, 0xc3,
102*249a4f5eSChris Morgan 	 0xe4, 0xe3, 0xe3, 0xda, 0xc2, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
103*249a4f5eSChris Morgan 	 0x00, 0x2f},
104*249a4f5eSChris Morgan 	{0x01, 0x84, 0x83, 0x9b, 0xd7, 0xde, 0xd2, 0xc8, 0xce, 0xc2,
105*249a4f5eSChris Morgan 	 0xe4, 0xe3, 0xe2, 0xd9, 0xc3, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
106*249a4f5eSChris Morgan 	 0x00, 0x2f},
107*249a4f5eSChris Morgan 	{0x01, 0x87, 0x86, 0x9f, 0xd6, 0xdd, 0xd1, 0xc7, 0xce, 0xc1,
108*249a4f5eSChris Morgan 	 0xe4, 0xe3, 0xe2, 0xd9, 0xc6, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
109*249a4f5eSChris Morgan 	 0x00, 0x2f},
110*249a4f5eSChris Morgan 	{0x01, 0x89, 0x89, 0xa2, 0xd5, 0xdb, 0xcf, 0xc8, 0xcf, 0xc2,
111*249a4f5eSChris Morgan 	 0xe3, 0xe3, 0xe1, 0xd9, 0xc7, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
112*249a4f5eSChris Morgan 	 0x00, 0x2f},
113*249a4f5eSChris Morgan 	{0x01, 0x8b, 0x8b, 0xa5, 0xd5, 0xdb, 0xcf, 0xc7, 0xce, 0xc0,
114*249a4f5eSChris Morgan 	 0xe3, 0xe3, 0xe1, 0xd8, 0xc7, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
115*249a4f5eSChris Morgan 	 0x00, 0x2f},
116*249a4f5eSChris Morgan 	{0x01, 0x8d, 0x8d, 0xa7, 0xd5, 0xdb, 0xcf, 0xc6, 0xce, 0xc0,
117*249a4f5eSChris Morgan 	 0xe4, 0xe4, 0xe1, 0xd7, 0xc8, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
118*249a4f5eSChris Morgan 	 0x00, 0x2f},
119*249a4f5eSChris Morgan 	{0x01, 0x8f, 0x8f, 0xaa, 0xd4, 0xdb, 0xce, 0xc6, 0xcd, 0xbf,
120*249a4f5eSChris Morgan 	 0xe3, 0xe3, 0xe1, 0xd7, 0xca, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
121*249a4f5eSChris Morgan 	 0x00, 0x2f},
122*249a4f5eSChris Morgan 	{0x01, 0x91, 0x91, 0xac, 0xd3, 0xda, 0xce, 0xc5, 0xcd, 0xbe,
123*249a4f5eSChris Morgan 	 0xe3, 0xe3, 0xe0, 0xd7, 0xca, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
124*249a4f5eSChris Morgan 	 0x00, 0x2f},
125*249a4f5eSChris Morgan 	{0x01, 0x93, 0x93, 0xaf, 0xd3, 0xda, 0xcd, 0xc5, 0xcd, 0xbe,
126*249a4f5eSChris Morgan 	 0xe2, 0xe3, 0xdf, 0xd6, 0xca, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
127*249a4f5eSChris Morgan 	 0x00, 0x2f},
128*249a4f5eSChris Morgan 	{0x01, 0x95, 0x95, 0xb1, 0xd2, 0xd9, 0xcc, 0xc4, 0xcd, 0xbe,
129*249a4f5eSChris Morgan 	 0xe2, 0xe3, 0xdf, 0xd7, 0xcc, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
130*249a4f5eSChris Morgan 	 0x00, 0x2f},
131*249a4f5eSChris Morgan 	{0x01, 0x99, 0x99, 0xb6, 0xd1, 0xd9, 0xcc, 0xc3, 0xcb, 0xbc,
132*249a4f5eSChris Morgan 	 0xe2, 0xe4, 0xdf, 0xd6, 0xcc, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
133*249a4f5eSChris Morgan 	 0x00, 0x2f},
134*249a4f5eSChris Morgan 	{0x01, 0x9c, 0x9c, 0xba, 0xd0, 0xd8, 0xcb, 0xc3, 0xcb, 0xbb,
135*249a4f5eSChris Morgan 	 0xe2, 0xe4, 0xdf, 0xd6, 0xce, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
136*249a4f5eSChris Morgan 	 0x00, 0x2f},
137*249a4f5eSChris Morgan 	{0x01, 0x9f, 0x9f, 0xbe, 0xcf, 0xd7, 0xc9, 0xc2, 0xcb, 0xbb,
138*249a4f5eSChris Morgan 	 0xe1, 0xe3, 0xde, 0xd6, 0xd0, 0xd3, 0xfa, 0xed, 0xe6, 0x2f,
139*249a4f5eSChris Morgan 	 0x00, 0x2f},
140*249a4f5eSChris Morgan };
141*249a4f5eSChris Morgan 
142*249a4f5eSChris Morgan /*
143*249a4f5eSChris Morgan  * Table of elvss values provided in datasheet and corresponds to
144*249a4f5eSChris Morgan  * gamma values.
145*249a4f5eSChris Morgan  */
146*249a4f5eSChris Morgan static u8 ams495qa01_elvss[NUM_GAMMA_LEVELS] = {
147*249a4f5eSChris Morgan 	0x15, 0x15, 0x15, 0x15, 0x15, 0x15, 0x15, 0x15, 0x15, 0x15,
148*249a4f5eSChris Morgan 	0x15, 0x15, 0x14, 0x14, 0x13, 0x12,
149*249a4f5eSChris Morgan };
150*249a4f5eSChris Morgan 
151*249a4f5eSChris Morgan static int ams495qa01_update_gamma(struct mipi_dbi *dbi, int brightness)
152*249a4f5eSChris Morgan {
153*249a4f5eSChris Morgan 	int tmp = brightness;
154*249a4f5eSChris Morgan 
155*249a4f5eSChris Morgan 	mipi_dbi_command_buf(dbi, MCS_SET_GAMMA, ams495qa01_gamma[tmp],
156*249a4f5eSChris Morgan 			     ARRAY_SIZE(ams495qa01_gamma[tmp]));
157*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MCS_SET_GAMMA, 0x00);
158*249a4f5eSChris Morgan 
159*249a4f5eSChris Morgan 	/* Undocumented command */
160*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, 0x26, 0x00);
161*249a4f5eSChris Morgan 
162*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MCS_TEMP_SWIRE, ams495qa01_elvss[tmp]);
163*249a4f5eSChris Morgan 
164*249a4f5eSChris Morgan 	return 0;
165*249a4f5eSChris Morgan }
166*249a4f5eSChris Morgan 
167*249a4f5eSChris Morgan static void ams495qa01_panel_init(struct d53e6ea8966 *db)
168*249a4f5eSChris Morgan {
169*249a4f5eSChris Morgan 	struct mipi_dbi *dbi = &db->dbi;
170*249a4f5eSChris Morgan 
171*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MCS_PASSWORD_0, 0x5a, 0x5a);
172*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MCS_PASSWORD_1, 0x5a, 0x5a);
173*249a4f5eSChris Morgan 
174*249a4f5eSChris Morgan 	/* Undocumented commands */
175*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, 0xb0, 0x02);
176*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, 0xf3, 0x3b);
177*249a4f5eSChris Morgan 
178*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MCS_ANALOG_PWR_CTL_0, 0x33, 0x42, 0x00, 0x08);
179*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MCS_ANALOG_PWR_CTL_1, 0x00, 0x06, 0x26, 0x35, 0x03);
180*249a4f5eSChris Morgan 
181*249a4f5eSChris Morgan 	/* Undocumented commands */
182*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, 0xf6, 0x02);
183*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, 0xc6, 0x0b, 0x00, 0x00, 0x3c, 0x00, 0x22,
184*249a4f5eSChris Morgan 			 0x00, 0x00, 0x00, 0x00);
185*249a4f5eSChris Morgan 
186*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MCS_GTCON_SET, 0x20);
187*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MCS_TEMP_SWIRE, 0x06, 0x06, 0x06, 0x06);
188*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MCS_ELVSS_ON, 0x07, 0x00, 0x10);
189*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MCS_GATELESS_SIGNAL_SET, 0x7f, 0x7a,
190*249a4f5eSChris Morgan 			 0x89, 0x67, 0x26, 0x38, 0x00, 0x00, 0x09,
191*249a4f5eSChris Morgan 			 0x67, 0x70, 0x88, 0x7a, 0x76, 0x05, 0x09,
192*249a4f5eSChris Morgan 			 0x23, 0x23, 0x23);
193*249a4f5eSChris Morgan 
194*249a4f5eSChris Morgan 	/* Undocumented commands */
195*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, 0xb5, 0xff, 0xef, 0x35, 0x42, 0x0d, 0xd7,
196*249a4f5eSChris Morgan 			 0xff, 0x07, 0xff, 0xff, 0xfd, 0x00, 0x01,
197*249a4f5eSChris Morgan 			 0xff, 0x05, 0x12, 0x0f, 0xff, 0xff, 0xff,
198*249a4f5eSChris Morgan 			 0xff);
199*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, 0xb4, 0x15);
200*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, 0xb3, 0x00);
201*249a4f5eSChris Morgan 
202*249a4f5eSChris Morgan 	ams495qa01_update_gamma(dbi, MAX_BRIGHTNESS);
203*249a4f5eSChris Morgan }
204*249a4f5eSChris Morgan 
205*249a4f5eSChris Morgan static int d53e6ea8966_prepare(struct drm_panel *panel)
206*249a4f5eSChris Morgan {
207*249a4f5eSChris Morgan 	struct d53e6ea8966 *db = to_d53e6ea8966(panel);
208*249a4f5eSChris Morgan 	int ret;
209*249a4f5eSChris Morgan 
210*249a4f5eSChris Morgan 	/* Power up */
211*249a4f5eSChris Morgan 	ret = regulator_enable(db->reg_vdd);
212*249a4f5eSChris Morgan 	if (ret) {
213*249a4f5eSChris Morgan 		dev_err(db->dev, "failed to enable vdd regulator: %d\n", ret);
214*249a4f5eSChris Morgan 		return ret;
215*249a4f5eSChris Morgan 	}
216*249a4f5eSChris Morgan 
217*249a4f5eSChris Morgan 	if (db->reg_elvdd) {
218*249a4f5eSChris Morgan 		ret = regulator_enable(db->reg_elvdd);
219*249a4f5eSChris Morgan 		if (ret) {
220*249a4f5eSChris Morgan 			dev_err(db->dev,
221*249a4f5eSChris Morgan 				"failed to enable elvdd regulator: %d\n", ret);
222*249a4f5eSChris Morgan 			regulator_disable(db->reg_vdd);
223*249a4f5eSChris Morgan 			return ret;
224*249a4f5eSChris Morgan 		}
225*249a4f5eSChris Morgan 	}
226*249a4f5eSChris Morgan 
227*249a4f5eSChris Morgan 	/* Enable */
228*249a4f5eSChris Morgan 	if (db->enable)
229*249a4f5eSChris Morgan 		gpiod_set_value_cansleep(db->enable, 1);
230*249a4f5eSChris Morgan 
231*249a4f5eSChris Morgan 	msleep(50);
232*249a4f5eSChris Morgan 
233*249a4f5eSChris Morgan 	/* Reset */
234*249a4f5eSChris Morgan 	gpiod_set_value_cansleep(db->reset, 1);
235*249a4f5eSChris Morgan 	usleep_range(1000, 5000);
236*249a4f5eSChris Morgan 	gpiod_set_value_cansleep(db->reset, 0);
237*249a4f5eSChris Morgan 	msleep(20);
238*249a4f5eSChris Morgan 
239*249a4f5eSChris Morgan 	db->panel_info->panel_init_seq(db);
240*249a4f5eSChris Morgan 
241*249a4f5eSChris Morgan 	return 0;
242*249a4f5eSChris Morgan }
243*249a4f5eSChris Morgan 
244*249a4f5eSChris Morgan static int d53e6ea8966_enable(struct drm_panel *panel)
245*249a4f5eSChris Morgan {
246*249a4f5eSChris Morgan 	struct d53e6ea8966 *db = to_d53e6ea8966(panel);
247*249a4f5eSChris Morgan 	struct mipi_dbi *dbi = &db->dbi;
248*249a4f5eSChris Morgan 
249*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MIPI_DCS_EXIT_SLEEP_MODE);
250*249a4f5eSChris Morgan 	msleep(200);
251*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MIPI_DCS_SET_DISPLAY_ON);
252*249a4f5eSChris Morgan 	usleep_range(10000, 15000);
253*249a4f5eSChris Morgan 
254*249a4f5eSChris Morgan 	return 0;
255*249a4f5eSChris Morgan }
256*249a4f5eSChris Morgan 
257*249a4f5eSChris Morgan static int d53e6ea8966_disable(struct drm_panel *panel)
258*249a4f5eSChris Morgan {
259*249a4f5eSChris Morgan 	struct d53e6ea8966 *db = to_d53e6ea8966(panel);
260*249a4f5eSChris Morgan 	struct mipi_dbi *dbi = &db->dbi;
261*249a4f5eSChris Morgan 
262*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MIPI_DCS_SET_DISPLAY_OFF);
263*249a4f5eSChris Morgan 	msleep(20);
264*249a4f5eSChris Morgan 	mipi_dbi_command(dbi, MIPI_DCS_ENTER_SLEEP_MODE);
265*249a4f5eSChris Morgan 	msleep(100);
266*249a4f5eSChris Morgan 
267*249a4f5eSChris Morgan 	return 0;
268*249a4f5eSChris Morgan }
269*249a4f5eSChris Morgan 
270*249a4f5eSChris Morgan static int d53e6ea8966_unprepare(struct drm_panel *panel)
271*249a4f5eSChris Morgan {
272*249a4f5eSChris Morgan 	struct d53e6ea8966 *db = to_d53e6ea8966(panel);
273*249a4f5eSChris Morgan 
274*249a4f5eSChris Morgan 	if (db->enable)
275*249a4f5eSChris Morgan 		gpiod_set_value_cansleep(db->enable, 0);
276*249a4f5eSChris Morgan 
277*249a4f5eSChris Morgan 	gpiod_set_value_cansleep(db->reset, 1);
278*249a4f5eSChris Morgan 
279*249a4f5eSChris Morgan 	if (db->reg_elvdd)
280*249a4f5eSChris Morgan 		regulator_disable(db->reg_elvdd);
281*249a4f5eSChris Morgan 
282*249a4f5eSChris Morgan 	regulator_disable(db->reg_vdd);
283*249a4f5eSChris Morgan 	msleep(100);
284*249a4f5eSChris Morgan 
285*249a4f5eSChris Morgan 	return 0;
286*249a4f5eSChris Morgan }
287*249a4f5eSChris Morgan 
288*249a4f5eSChris Morgan static int d53e6ea8966_get_modes(struct drm_panel *panel,
289*249a4f5eSChris Morgan 				 struct drm_connector *connector)
290*249a4f5eSChris Morgan {
291*249a4f5eSChris Morgan 	struct d53e6ea8966 *db = to_d53e6ea8966(panel);
292*249a4f5eSChris Morgan 	const struct d53e6ea8966_panel_info *panel_info = db->panel_info;
293*249a4f5eSChris Morgan 	struct drm_display_mode *mode;
294*249a4f5eSChris Morgan 	static const u32 bus_format = MEDIA_BUS_FMT_RGB888_1X24;
295*249a4f5eSChris Morgan 	unsigned int i;
296*249a4f5eSChris Morgan 
297*249a4f5eSChris Morgan 	for (i = 0; i < panel_info->num_modes; i++) {
298*249a4f5eSChris Morgan 		mode = drm_mode_duplicate(connector->dev,
299*249a4f5eSChris Morgan 					  &panel_info->display_modes[i]);
300*249a4f5eSChris Morgan 		if (!mode)
301*249a4f5eSChris Morgan 			return -ENOMEM;
302*249a4f5eSChris Morgan 
303*249a4f5eSChris Morgan 		drm_mode_set_name(mode);
304*249a4f5eSChris Morgan 		drm_mode_probed_add(connector, mode);
305*249a4f5eSChris Morgan 	}
306*249a4f5eSChris Morgan 
307*249a4f5eSChris Morgan 	connector->display_info.bpc = 8;
308*249a4f5eSChris Morgan 	connector->display_info.width_mm = panel_info->width_mm;
309*249a4f5eSChris Morgan 	connector->display_info.height_mm = panel_info->height_mm;
310*249a4f5eSChris Morgan 	connector->display_info.bus_flags = panel_info->bus_flags;
311*249a4f5eSChris Morgan 
312*249a4f5eSChris Morgan 	drm_display_info_set_bus_formats(&connector->display_info,
313*249a4f5eSChris Morgan 					 &bus_format, 1);
314*249a4f5eSChris Morgan 
315*249a4f5eSChris Morgan 	return 1;
316*249a4f5eSChris Morgan }
317*249a4f5eSChris Morgan 
318*249a4f5eSChris Morgan static const struct drm_panel_funcs d53e6ea8966_panel_funcs = {
319*249a4f5eSChris Morgan 	.disable = d53e6ea8966_disable,
320*249a4f5eSChris Morgan 	.enable = d53e6ea8966_enable,
321*249a4f5eSChris Morgan 	.get_modes = d53e6ea8966_get_modes,
322*249a4f5eSChris Morgan 	.prepare = d53e6ea8966_prepare,
323*249a4f5eSChris Morgan 	.unprepare = d53e6ea8966_unprepare,
324*249a4f5eSChris Morgan };
325*249a4f5eSChris Morgan 
326*249a4f5eSChris Morgan static int ams495qa01_set_brightness(struct backlight_device *bd)
327*249a4f5eSChris Morgan {
328*249a4f5eSChris Morgan 	struct d53e6ea8966 *db = bl_get_data(bd);
329*249a4f5eSChris Morgan 	struct mipi_dbi *dbi = &db->dbi;
330*249a4f5eSChris Morgan 	int brightness = backlight_get_brightness(bd);
331*249a4f5eSChris Morgan 
332*249a4f5eSChris Morgan 	ams495qa01_update_gamma(dbi, brightness);
333*249a4f5eSChris Morgan 
334*249a4f5eSChris Morgan 	return 0;
335*249a4f5eSChris Morgan }
336*249a4f5eSChris Morgan 
337*249a4f5eSChris Morgan static const struct backlight_ops ams495qa01_backlight_ops = {
338*249a4f5eSChris Morgan 	.update_status	= ams495qa01_set_brightness,
339*249a4f5eSChris Morgan };
340*249a4f5eSChris Morgan 
341*249a4f5eSChris Morgan static int ams495qa01_backlight_register(struct d53e6ea8966 *db)
342*249a4f5eSChris Morgan {
343*249a4f5eSChris Morgan 	struct backlight_properties props = {
344*249a4f5eSChris Morgan 		.type		= BACKLIGHT_RAW,
345*249a4f5eSChris Morgan 		.brightness	= MAX_BRIGHTNESS,
346*249a4f5eSChris Morgan 		.max_brightness = MAX_BRIGHTNESS,
347*249a4f5eSChris Morgan 	};
348*249a4f5eSChris Morgan 	struct device *dev = db->dev;
349*249a4f5eSChris Morgan 	int ret = 0;
350*249a4f5eSChris Morgan 
351*249a4f5eSChris Morgan 	db->bl_dev = devm_backlight_device_register(dev, "panel", dev, db,
352*249a4f5eSChris Morgan 						    &ams495qa01_backlight_ops,
353*249a4f5eSChris Morgan 						    &props);
354*249a4f5eSChris Morgan 	if (IS_ERR(db->bl_dev)) {
355*249a4f5eSChris Morgan 		ret = PTR_ERR(db->bl_dev);
356*249a4f5eSChris Morgan 		dev_err(dev, "error registering backlight device (%d)\n", ret);
357*249a4f5eSChris Morgan 	}
358*249a4f5eSChris Morgan 
359*249a4f5eSChris Morgan 	return ret;
360*249a4f5eSChris Morgan }
361*249a4f5eSChris Morgan 
362*249a4f5eSChris Morgan static int d53e6ea8966_probe(struct spi_device *spi)
363*249a4f5eSChris Morgan {
364*249a4f5eSChris Morgan 	struct device *dev = &spi->dev;
365*249a4f5eSChris Morgan 	struct mipi_dsi_host *dsi_host;
366*249a4f5eSChris Morgan 	struct d53e6ea8966 *db;
367*249a4f5eSChris Morgan 	int ret;
368*249a4f5eSChris Morgan 	struct mipi_dsi_device_info info = {
369*249a4f5eSChris Morgan 		.type = "d53e6ea8966",
370*249a4f5eSChris Morgan 		.channel = 0,
371*249a4f5eSChris Morgan 		.node = NULL,
372*249a4f5eSChris Morgan 	};
373*249a4f5eSChris Morgan 
374*249a4f5eSChris Morgan 	db = devm_kzalloc(dev, sizeof(*db), GFP_KERNEL);
375*249a4f5eSChris Morgan 	if (!db)
376*249a4f5eSChris Morgan 		return -ENOMEM;
377*249a4f5eSChris Morgan 
378*249a4f5eSChris Morgan 	spi_set_drvdata(spi, db);
379*249a4f5eSChris Morgan 
380*249a4f5eSChris Morgan 	db->dev = dev;
381*249a4f5eSChris Morgan 
382*249a4f5eSChris Morgan 	db->panel_info = of_device_get_match_data(dev);
383*249a4f5eSChris Morgan 	if (!db->panel_info)
384*249a4f5eSChris Morgan 		return -EINVAL;
385*249a4f5eSChris Morgan 
386*249a4f5eSChris Morgan 	db->reg_vdd = devm_regulator_get(dev, "vdd");
387*249a4f5eSChris Morgan 	if (IS_ERR(db->reg_vdd))
388*249a4f5eSChris Morgan 		return dev_err_probe(dev, PTR_ERR(db->reg_vdd),
389*249a4f5eSChris Morgan 				     "Failed to get vdd supply\n");
390*249a4f5eSChris Morgan 
391*249a4f5eSChris Morgan 	db->reg_elvdd = devm_regulator_get_optional(dev, "elvdd");
392*249a4f5eSChris Morgan 	if (IS_ERR(db->reg_elvdd))
393*249a4f5eSChris Morgan 		db->reg_elvdd = NULL;
394*249a4f5eSChris Morgan 
395*249a4f5eSChris Morgan 	db->reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH);
396*249a4f5eSChris Morgan 	if (IS_ERR(db->reset)) {
397*249a4f5eSChris Morgan 		ret = PTR_ERR(db->reset);
398*249a4f5eSChris Morgan 		return dev_err_probe(dev, ret, "no RESET GPIO\n");
399*249a4f5eSChris Morgan 	}
400*249a4f5eSChris Morgan 
401*249a4f5eSChris Morgan 	db->enable = devm_gpiod_get_optional(dev, "enable", GPIOD_OUT_LOW);
402*249a4f5eSChris Morgan 	if (IS_ERR(db->enable)) {
403*249a4f5eSChris Morgan 		ret = PTR_ERR(db->enable);
404*249a4f5eSChris Morgan 		return dev_err_probe(dev, ret, "cannot get ENABLE GPIO\n");
405*249a4f5eSChris Morgan 	}
406*249a4f5eSChris Morgan 
407*249a4f5eSChris Morgan 	ret = mipi_dbi_spi_init(spi, &db->dbi, NULL);
408*249a4f5eSChris Morgan 	if (ret)
409*249a4f5eSChris Morgan 		return dev_err_probe(dev, ret, "MIPI DBI init failed\n");
410*249a4f5eSChris Morgan 
411*249a4f5eSChris Morgan 	dsi_host = drm_of_get_dsi_bus(dev);
412*249a4f5eSChris Morgan 	if (IS_ERR(dsi_host)) {
413*249a4f5eSChris Morgan 		ret = PTR_ERR(dsi_host);
414*249a4f5eSChris Morgan 		return dev_err_probe(dev, ret, "Error attaching DSI bus\n");
415*249a4f5eSChris Morgan 	}
416*249a4f5eSChris Morgan 
417*249a4f5eSChris Morgan 	db->dsi_dev = devm_mipi_dsi_device_register_full(dev, dsi_host, &info);
418*249a4f5eSChris Morgan 	if (IS_ERR(db->dsi_dev)) {
419*249a4f5eSChris Morgan 		dev_err(dev, "failed to register dsi device: %ld\n",
420*249a4f5eSChris Morgan 			PTR_ERR(db->dsi_dev));
421*249a4f5eSChris Morgan 		ret = PTR_ERR(db->dsi_dev);
422*249a4f5eSChris Morgan 	}
423*249a4f5eSChris Morgan 
424*249a4f5eSChris Morgan 	db->dsi_dev->lanes = 2;
425*249a4f5eSChris Morgan 	db->dsi_dev->format = MIPI_DSI_FMT_RGB888;
426*249a4f5eSChris Morgan 	db->dsi_dev->mode_flags = MIPI_DSI_MODE_VIDEO | MIPI_DSI_MODE_VIDEO_BURST |
427*249a4f5eSChris Morgan 			  MIPI_DSI_MODE_LPM | MIPI_DSI_MODE_NO_EOT_PACKET;
428*249a4f5eSChris Morgan 
429*249a4f5eSChris Morgan 	drm_panel_init(&db->panel, dev, &d53e6ea8966_panel_funcs,
430*249a4f5eSChris Morgan 		       DRM_MODE_CONNECTOR_DSI);
431*249a4f5eSChris Morgan 
432*249a4f5eSChris Morgan 	if (db->panel_info->backlight_register) {
433*249a4f5eSChris Morgan 		ret = db->panel_info->backlight_register(db);
434*249a4f5eSChris Morgan 		if (ret < 0)
435*249a4f5eSChris Morgan 			return ret;
436*249a4f5eSChris Morgan 		db->panel.backlight = db->bl_dev;
437*249a4f5eSChris Morgan 	}
438*249a4f5eSChris Morgan 
439*249a4f5eSChris Morgan 	drm_panel_add(&db->panel);
440*249a4f5eSChris Morgan 
441*249a4f5eSChris Morgan 	ret = devm_mipi_dsi_attach(dev, db->dsi_dev);
442*249a4f5eSChris Morgan 	if (ret < 0) {
443*249a4f5eSChris Morgan 		dev_err(dev, "mipi_dsi_attach failed: %d\n", ret);
444*249a4f5eSChris Morgan 		drm_panel_remove(&db->panel);
445*249a4f5eSChris Morgan 		return ret;
446*249a4f5eSChris Morgan 	}
447*249a4f5eSChris Morgan 
448*249a4f5eSChris Morgan 	return 0;
449*249a4f5eSChris Morgan }
450*249a4f5eSChris Morgan 
451*249a4f5eSChris Morgan static void d53e6ea8966_remove(struct spi_device *spi)
452*249a4f5eSChris Morgan {
453*249a4f5eSChris Morgan 	struct d53e6ea8966 *db = spi_get_drvdata(spi);
454*249a4f5eSChris Morgan 
455*249a4f5eSChris Morgan 	drm_panel_remove(&db->panel);
456*249a4f5eSChris Morgan }
457*249a4f5eSChris Morgan 
458*249a4f5eSChris Morgan static const struct drm_display_mode ams495qa01_modes[] = {
459*249a4f5eSChris Morgan 	{ /* 60hz */
460*249a4f5eSChris Morgan 		.clock = 33500,
461*249a4f5eSChris Morgan 		.hdisplay = 960,
462*249a4f5eSChris Morgan 		.hsync_start = 960 + 10,
463*249a4f5eSChris Morgan 		.hsync_end = 960 + 10 + 2,
464*249a4f5eSChris Morgan 		.htotal = 960 + 10 + 2 + 10,
465*249a4f5eSChris Morgan 		.vdisplay = 544,
466*249a4f5eSChris Morgan 		.vsync_start = 544 + 10,
467*249a4f5eSChris Morgan 		.vsync_end = 544 + 10 + 2,
468*249a4f5eSChris Morgan 		.vtotal = 544 + 10 + 2 + 10,
469*249a4f5eSChris Morgan 		.flags = DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC,
470*249a4f5eSChris Morgan 		.type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED,
471*249a4f5eSChris Morgan 		},
472*249a4f5eSChris Morgan 	{ /* 50hz */
473*249a4f5eSChris Morgan 		.clock = 27800,
474*249a4f5eSChris Morgan 		.hdisplay = 960,
475*249a4f5eSChris Morgan 		.hsync_start = 960 + 10,
476*249a4f5eSChris Morgan 		.hsync_end = 960 + 10 + 2,
477*249a4f5eSChris Morgan 		.htotal = 960 + 10 + 2 + 10,
478*249a4f5eSChris Morgan 		.vdisplay = 544,
479*249a4f5eSChris Morgan 		.vsync_start = 544 + 10,
480*249a4f5eSChris Morgan 		.vsync_end = 544 + 10 + 2,
481*249a4f5eSChris Morgan 		.vtotal = 544 + 10 + 2 + 10,
482*249a4f5eSChris Morgan 		.flags = DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC,
483*249a4f5eSChris Morgan 		.type = DRM_MODE_TYPE_DRIVER,
484*249a4f5eSChris Morgan 	},
485*249a4f5eSChris Morgan };
486*249a4f5eSChris Morgan 
487*249a4f5eSChris Morgan static const struct d53e6ea8966_panel_info ams495qa01_info = {
488*249a4f5eSChris Morgan 	.display_modes = ams495qa01_modes,
489*249a4f5eSChris Morgan 	.num_modes = ARRAY_SIZE(ams495qa01_modes),
490*249a4f5eSChris Morgan 	.width_mm = 117,
491*249a4f5eSChris Morgan 	.height_mm = 74,
492*249a4f5eSChris Morgan 	.bus_flags = DRM_BUS_FLAG_DE_LOW | DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE,
493*249a4f5eSChris Morgan 	.panel_init_seq = ams495qa01_panel_init,
494*249a4f5eSChris Morgan 	.backlight_register = ams495qa01_backlight_register,
495*249a4f5eSChris Morgan };
496*249a4f5eSChris Morgan 
497*249a4f5eSChris Morgan static const struct of_device_id d53e6ea8966_match[] = {
498*249a4f5eSChris Morgan 	{ .compatible = "samsung,ams495qa01", .data = &ams495qa01_info },
499*249a4f5eSChris Morgan 	{ /* sentinel */ },
500*249a4f5eSChris Morgan };
501*249a4f5eSChris Morgan MODULE_DEVICE_TABLE(of, d53e6ea8966_match);
502*249a4f5eSChris Morgan 
503*249a4f5eSChris Morgan static const struct spi_device_id d53e6ea8966_ids[] = {
504*249a4f5eSChris Morgan 	{ "ams495qa01", 0 },
505*249a4f5eSChris Morgan 	{ /* sentinel */ },
506*249a4f5eSChris Morgan };
507*249a4f5eSChris Morgan MODULE_DEVICE_TABLE(spi, d53e6ea8966_ids);
508*249a4f5eSChris Morgan 
509*249a4f5eSChris Morgan static struct spi_driver d53e6ea8966_driver = {
510*249a4f5eSChris Morgan 	.driver		= {
511*249a4f5eSChris Morgan 		.name	= "d53e6ea8966-panel",
512*249a4f5eSChris Morgan 		.of_match_table = d53e6ea8966_match,
513*249a4f5eSChris Morgan 	},
514*249a4f5eSChris Morgan 	.id_table	= d53e6ea8966_ids,
515*249a4f5eSChris Morgan 	.probe		= d53e6ea8966_probe,
516*249a4f5eSChris Morgan 	.remove		= d53e6ea8966_remove,
517*249a4f5eSChris Morgan };
518*249a4f5eSChris Morgan module_spi_driver(d53e6ea8966_driver);
519*249a4f5eSChris Morgan 
520*249a4f5eSChris Morgan MODULE_AUTHOR("Chris Morgan <macromorgan@hotmail.com>");
521*249a4f5eSChris Morgan MODULE_DESCRIPTION("Magnachip d53e6ea8966 panel driver");
522*249a4f5eSChris Morgan MODULE_LICENSE("GPL");
523