1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2021 RenewOutReach
4 * Copyright (C) 2021 Amarula Solutions(India)
11 #include <drm/drm_atomic_helper.h>
12 #include <drm/drm_of.h>
13 #include <drm/drm_print.h>
14 #include <drm/drm_mipi_dsi.h>
16 #include <linux/delay.h>
17 #include <linux/gpio/consumer.h>
18 #include <linux/i2c.h>
19 #include <linux/media-bus-format.h>
20 #include <linux/module.h>
21 #include <linux/regmap.h>
22 #include <linux/regulator/consumer.h>
25 WR_INPUT_SOURCE = 0x05, /* Write Input Source Select */
26 WR_EXT_SOURCE_FMT = 0x07, /* Write External Video Source Format */
27 WR_IMAGE_CROP = 0x10, /* Write Image Crop */
28 WR_DISPLAY_SIZE = 0x12, /* Write Display Size */
29 WR_IMAGE_FREEZE = 0x1A, /* Write Image Freeze */
30 WR_INPUT_IMAGE_SIZE = 0x2E, /* Write External Input Image Size */
31 WR_RGB_LED_EN = 0x52, /* Write RGB LED Enable */
32 WR_RGB_LED_CURRENT = 0x54, /* Write RGB LED Current */
33 WR_RGB_LED_MAX_CURRENT = 0x5C, /* Write RGB LED Max Current */
34 WR_DSI_HS_CLK = 0xBD, /* Write DSI HS Clock */
35 RD_DEVICE_ID = 0xD4, /* Read Controller Device ID */
36 WR_DSI_PORT_EN = 0xD7, /* Write DSI Port Enable */
40 INPUT_EXTERNAL_VIDEO = 0,
45 #define DEV_ID_MASK GENMASK(3, 0)
46 #define IMAGE_FREESE_EN BIT(0)
48 #define EXT_SOURCE_FMT_DSI 0
49 #define RED_LED_EN BIT(0)
50 #define GREEN_LED_EN BIT(1)
51 #define BLUE_LED_EN BIT(2)
52 #define LED_MASK GENMASK(2, 0)
53 #define MAX_BYTE_SIZE 8
57 struct drm_bridge bridge;
58 struct drm_bridge *next_bridge;
59 struct device_node *host_node;
60 struct mipi_dsi_device *dsi;
61 struct drm_display_mode mode;
63 struct gpio_desc *enable_gpio;
64 struct regulator *vcc_intf;
65 struct regulator *vcc_flsh;
66 struct regmap *regmap;
67 unsigned int dsi_lanes;
70 static inline struct dlpc *bridge_to_dlpc(struct drm_bridge *bridge)
72 return container_of(bridge, struct dlpc, bridge);
75 static bool dlpc_writeable_noinc_reg(struct device *dev, unsigned int reg)
80 case WR_INPUT_IMAGE_SIZE:
88 static const struct regmap_range dlpc_volatile_ranges[] = {
89 { .range_min = 0x10, .range_max = 0xBF },
92 static const struct regmap_access_table dlpc_volatile_table = {
93 .yes_ranges = dlpc_volatile_ranges,
94 .n_yes_ranges = ARRAY_SIZE(dlpc_volatile_ranges),
97 static const struct regmap_config dlpc_regmap_config = {
100 .max_register = WR_DSI_PORT_EN,
101 .writeable_noinc_reg = dlpc_writeable_noinc_reg,
102 .volatile_table = &dlpc_volatile_table,
103 .cache_type = REGCACHE_MAPLE,
107 static void dlpc_atomic_enable(struct drm_bridge *bridge,
108 struct drm_bridge_state *old_bridge_state)
110 struct dlpc *dlpc = bridge_to_dlpc(bridge);
111 struct device *dev = dlpc->dev;
112 struct drm_display_mode *mode = &dlpc->mode;
113 struct regmap *regmap = dlpc->regmap;
114 char buf[MAX_BYTE_SIZE];
117 regmap_read(regmap, RD_DEVICE_ID, &devid);
118 devid &= DEV_ID_MASK;
120 DRM_DEV_DEBUG(dev, "DLPC3433 device id: 0x%02x\n", devid);
123 DRM_DEV_ERROR(dev, "Unsupported DLPC device id: 0x%02x\n", devid);
127 /* disable image freeze */
128 regmap_write(regmap, WR_IMAGE_FREEZE, IMAGE_FREESE_EN);
130 /* enable DSI port */
131 regmap_write(regmap, WR_DSI_PORT_EN, DSI_PORT_EN);
133 memset(buf, 0, MAX_BYTE_SIZE);
136 buf[4] = mode->hdisplay & 0xff;
137 buf[5] = (mode->hdisplay & 0xff00) >> 8;
138 buf[6] = mode->vdisplay & 0xff;
139 buf[7] = (mode->vdisplay & 0xff00) >> 8;
140 regmap_noinc_write(regmap, WR_IMAGE_CROP, buf, MAX_BYTE_SIZE);
142 /* set display size */
143 buf[4] = mode->hdisplay & 0xff;
144 buf[5] = (mode->hdisplay & 0xff00) >> 8;
145 buf[6] = mode->vdisplay & 0xff;
146 buf[7] = (mode->vdisplay & 0xff00) >> 8;
147 regmap_noinc_write(regmap, WR_DISPLAY_SIZE, buf, MAX_BYTE_SIZE);
149 /* set input image size */
150 buf[0] = mode->hdisplay & 0xff;
151 buf[1] = (mode->hdisplay & 0xff00) >> 8;
152 buf[2] = mode->vdisplay & 0xff;
153 buf[3] = (mode->vdisplay & 0xff00) >> 8;
154 regmap_noinc_write(regmap, WR_INPUT_IMAGE_SIZE, buf, 4);
156 /* set external video port */
157 regmap_write(regmap, WR_INPUT_SOURCE, INPUT_EXTERNAL_VIDEO);
159 /* set external video format select as DSI */
160 regmap_write(regmap, WR_EXT_SOURCE_FMT, EXT_SOURCE_FMT_DSI);
162 /* disable image freeze */
163 regmap_write(regmap, WR_IMAGE_FREEZE, 0x00);
166 regmap_update_bits(regmap, WR_RGB_LED_EN, LED_MASK,
167 RED_LED_EN | GREEN_LED_EN | BLUE_LED_EN);
172 static void dlpc_atomic_pre_enable(struct drm_bridge *bridge,
173 struct drm_bridge_state *old_bridge_state)
175 struct dlpc *dlpc = bridge_to_dlpc(bridge);
178 gpiod_set_value(dlpc->enable_gpio, 1);
182 ret = regulator_enable(dlpc->vcc_intf);
184 DRM_DEV_ERROR(dlpc->dev,
185 "failed to enable VCC_INTF regulator: %d\n", ret);
187 ret = regulator_enable(dlpc->vcc_flsh);
189 DRM_DEV_ERROR(dlpc->dev,
190 "failed to enable VCC_FLSH regulator: %d\n", ret);
195 static void dlpc_atomic_post_disable(struct drm_bridge *bridge,
196 struct drm_bridge_state *old_bridge_state)
198 struct dlpc *dlpc = bridge_to_dlpc(bridge);
200 regulator_disable(dlpc->vcc_flsh);
201 regulator_disable(dlpc->vcc_intf);
205 gpiod_set_value(dlpc->enable_gpio, 0);
210 #define MAX_INPUT_SEL_FORMATS 1
213 dlpc_atomic_get_input_bus_fmts(struct drm_bridge *bridge,
214 struct drm_bridge_state *bridge_state,
215 struct drm_crtc_state *crtc_state,
216 struct drm_connector_state *conn_state,
218 unsigned int *num_input_fmts)
224 input_fmts = kcalloc(MAX_INPUT_SEL_FORMATS, sizeof(*input_fmts),
229 /* This is the DSI-end bus format */
230 input_fmts[0] = MEDIA_BUS_FMT_RGB888_1X24;
236 static void dlpc_mode_set(struct drm_bridge *bridge,
237 const struct drm_display_mode *mode,
238 const struct drm_display_mode *adjusted_mode)
240 struct dlpc *dlpc = bridge_to_dlpc(bridge);
242 drm_mode_copy(&dlpc->mode, adjusted_mode);
245 static int dlpc_attach(struct drm_bridge *bridge,
246 enum drm_bridge_attach_flags flags)
248 struct dlpc *dlpc = bridge_to_dlpc(bridge);
250 return drm_bridge_attach(bridge->encoder, dlpc->next_bridge, bridge, flags);
253 static const struct drm_bridge_funcs dlpc_bridge_funcs = {
254 .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
255 .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
256 .atomic_get_input_bus_fmts = dlpc_atomic_get_input_bus_fmts,
257 .atomic_reset = drm_atomic_helper_bridge_reset,
258 .atomic_pre_enable = dlpc_atomic_pre_enable,
259 .atomic_enable = dlpc_atomic_enable,
260 .atomic_post_disable = dlpc_atomic_post_disable,
261 .mode_set = dlpc_mode_set,
262 .attach = dlpc_attach,
265 static int dlpc3433_parse_dt(struct dlpc *dlpc)
267 struct device *dev = dlpc->dev;
268 struct device_node *endpoint;
271 dlpc->enable_gpio = devm_gpiod_get(dev, "enable", GPIOD_OUT_LOW);
272 if (IS_ERR(dlpc->enable_gpio))
273 return PTR_ERR(dlpc->enable_gpio);
275 dlpc->vcc_intf = devm_regulator_get(dlpc->dev, "vcc_intf");
276 if (IS_ERR(dlpc->vcc_intf))
277 return dev_err_probe(dev, PTR_ERR(dlpc->vcc_intf),
278 "failed to get VCC_INTF supply\n");
280 dlpc->vcc_flsh = devm_regulator_get(dlpc->dev, "vcc_flsh");
281 if (IS_ERR(dlpc->vcc_flsh))
282 return dev_err_probe(dev, PTR_ERR(dlpc->vcc_flsh),
283 "failed to get VCC_FLSH supply\n");
285 dlpc->next_bridge = devm_drm_of_get_bridge(dev, dev->of_node, 1, 0);
286 if (IS_ERR(dlpc->next_bridge))
287 return PTR_ERR(dlpc->next_bridge);
289 endpoint = of_graph_get_endpoint_by_regs(dev->of_node, 0, 0);
290 dlpc->dsi_lanes = of_property_count_u32_elems(endpoint, "data-lanes");
291 if (dlpc->dsi_lanes < 0 || dlpc->dsi_lanes > 4) {
293 goto err_put_endpoint;
296 dlpc->host_node = of_graph_get_remote_port_parent(endpoint);
297 if (!dlpc->host_node) {
302 of_node_put(endpoint);
307 of_node_put(dlpc->host_node);
309 of_node_put(endpoint);
313 static int dlpc_host_attach(struct dlpc *dlpc)
315 struct device *dev = dlpc->dev;
316 struct mipi_dsi_host *host;
317 struct mipi_dsi_device_info info = {
324 host = of_find_mipi_dsi_host_by_node(dlpc->host_node);
326 return dev_err_probe(dev, -EPROBE_DEFER, "failed to find dsi host\n");
328 dlpc->dsi = mipi_dsi_device_register_full(host, &info);
329 if (IS_ERR(dlpc->dsi)) {
330 DRM_DEV_ERROR(dev, "failed to create dsi device\n");
331 return PTR_ERR(dlpc->dsi);
334 dlpc->dsi->mode_flags = MIPI_DSI_MODE_VIDEO_BURST;
335 dlpc->dsi->format = MIPI_DSI_FMT_RGB565;
336 dlpc->dsi->lanes = dlpc->dsi_lanes;
338 ret = devm_mipi_dsi_attach(dev, dlpc->dsi);
340 DRM_DEV_ERROR(dev, "failed to attach dsi host\n");
345 static int dlpc3433_probe(struct i2c_client *client)
347 struct device *dev = &client->dev;
351 dlpc = devm_kzalloc(dev, sizeof(*dlpc), GFP_KERNEL);
357 dlpc->regmap = devm_regmap_init_i2c(client, &dlpc_regmap_config);
358 if (IS_ERR(dlpc->regmap))
359 return PTR_ERR(dlpc->regmap);
361 ret = dlpc3433_parse_dt(dlpc);
365 dev_set_drvdata(dev, dlpc);
366 i2c_set_clientdata(client, dlpc);
368 dlpc->bridge.funcs = &dlpc_bridge_funcs;
369 dlpc->bridge.of_node = dev->of_node;
370 drm_bridge_add(&dlpc->bridge);
372 ret = dlpc_host_attach(dlpc);
374 goto err_remove_bridge;
379 drm_bridge_remove(&dlpc->bridge);
383 static void dlpc3433_remove(struct i2c_client *client)
385 struct dlpc *dlpc = i2c_get_clientdata(client);
387 drm_bridge_remove(&dlpc->bridge);
388 of_node_put(dlpc->host_node);
391 static const struct i2c_device_id dlpc3433_id[] = {
395 MODULE_DEVICE_TABLE(i2c, dlpc3433_id);
397 static const struct of_device_id dlpc3433_match_table[] = {
398 { .compatible = "ti,dlpc3433" },
401 MODULE_DEVICE_TABLE(of, dlpc3433_match_table);
403 static struct i2c_driver dlpc3433_driver = {
404 .probe = dlpc3433_probe,
405 .remove = dlpc3433_remove,
406 .id_table = dlpc3433_id,
408 .name = "ti-dlpc3433",
409 .of_match_table = dlpc3433_match_table,
412 module_i2c_driver(dlpc3433_driver);
416 MODULE_DESCRIPTION("TI DLPC3433 MIPI DSI Display Controller Bridge");
417 MODULE_LICENSE("GPL");