1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * Copyright (C) 2021 RenewOutReach 4 * Copyright (C) 2021 Amarula Solutions(India) 5 * 6 * Author: 7 * Jagan Teki <jagan@amarulasolutions.com> 8 * Christopher Vollo <chris@renewoutreach.org> 9 */ 10 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> 15 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> 23 24 enum cmd_registers { 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 */ 37 }; 38 39 enum input_source { 40 INPUT_EXTERNAL_VIDEO = 0, 41 INPUT_TEST_PATTERN, 42 INPUT_SPLASH_SCREEN, 43 }; 44 45 #define DEV_ID_MASK GENMASK(3, 0) 46 #define IMAGE_FREESE_EN BIT(0) 47 #define DSI_PORT_EN 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 54 55 struct dlpc { 56 struct device *dev; 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; 62 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; 68 }; 69 70 static inline struct dlpc *bridge_to_dlpc(struct drm_bridge *bridge) 71 { 72 return container_of(bridge, struct dlpc, bridge); 73 } 74 75 static bool dlpc_writeable_noinc_reg(struct device *dev, unsigned int reg) 76 { 77 switch (reg) { 78 case WR_IMAGE_CROP: 79 case WR_DISPLAY_SIZE: 80 case WR_INPUT_IMAGE_SIZE: 81 case WR_DSI_HS_CLK: 82 return true; 83 default: 84 return false; 85 } 86 } 87 88 static const struct regmap_range dlpc_volatile_ranges[] = { 89 { .range_min = 0x10, .range_max = 0xBF }, 90 }; 91 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), 95 }; 96 97 static struct regmap_config dlpc_regmap_config = { 98 .reg_bits = 8, 99 .val_bits = 8, 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_RBTREE, 104 .name = "dlpc3433", 105 }; 106 107 static void dlpc_atomic_enable(struct drm_bridge *bridge, 108 struct drm_bridge_state *old_bridge_state) 109 { 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]; 115 unsigned int devid; 116 117 regmap_read(regmap, RD_DEVICE_ID, &devid); 118 devid &= DEV_ID_MASK; 119 120 DRM_DEV_DEBUG(dev, "DLPC3433 device id: 0x%02x\n", devid); 121 122 if (devid != 0x01) { 123 DRM_DEV_ERROR(dev, "Unsupported DLPC device id: 0x%02x\n", devid); 124 return; 125 } 126 127 /* disable image freeze */ 128 regmap_write(regmap, WR_IMAGE_FREEZE, IMAGE_FREESE_EN); 129 130 /* enable DSI port */ 131 regmap_write(regmap, WR_DSI_PORT_EN, DSI_PORT_EN); 132 133 memset(buf, 0, MAX_BYTE_SIZE); 134 135 /* set image crop */ 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); 141 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); 148 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); 155 156 /* set external video port */ 157 regmap_write(regmap, WR_INPUT_SOURCE, INPUT_EXTERNAL_VIDEO); 158 159 /* set external video format select as DSI */ 160 regmap_write(regmap, WR_EXT_SOURCE_FMT, EXT_SOURCE_FMT_DSI); 161 162 /* disable image freeze */ 163 regmap_write(regmap, WR_IMAGE_FREEZE, 0x00); 164 165 /* enable RGB led */ 166 regmap_update_bits(regmap, WR_RGB_LED_EN, LED_MASK, 167 RED_LED_EN | GREEN_LED_EN | BLUE_LED_EN); 168 169 msleep(10); 170 } 171 172 static void dlpc_atomic_pre_enable(struct drm_bridge *bridge, 173 struct drm_bridge_state *old_bridge_state) 174 { 175 struct dlpc *dlpc = bridge_to_dlpc(bridge); 176 int ret; 177 178 gpiod_set_value(dlpc->enable_gpio, 1); 179 180 msleep(500); 181 182 ret = regulator_enable(dlpc->vcc_intf); 183 if (ret) 184 DRM_DEV_ERROR(dlpc->dev, 185 "failed to enable VCC_INTF regulator: %d\n", ret); 186 187 ret = regulator_enable(dlpc->vcc_flsh); 188 if (ret) 189 DRM_DEV_ERROR(dlpc->dev, 190 "failed to enable VCC_FLSH regulator: %d\n", ret); 191 192 msleep(10); 193 } 194 195 static void dlpc_atomic_post_disable(struct drm_bridge *bridge, 196 struct drm_bridge_state *old_bridge_state) 197 { 198 struct dlpc *dlpc = bridge_to_dlpc(bridge); 199 200 regulator_disable(dlpc->vcc_flsh); 201 regulator_disable(dlpc->vcc_intf); 202 203 msleep(10); 204 205 gpiod_set_value(dlpc->enable_gpio, 0); 206 207 msleep(500); 208 } 209 210 #define MAX_INPUT_SEL_FORMATS 1 211 212 static u32 * 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, 217 u32 output_fmt, 218 unsigned int *num_input_fmts) 219 { 220 u32 *input_fmts; 221 222 *num_input_fmts = 0; 223 224 input_fmts = kcalloc(MAX_INPUT_SEL_FORMATS, sizeof(*input_fmts), 225 GFP_KERNEL); 226 if (!input_fmts) 227 return NULL; 228 229 /* This is the DSI-end bus format */ 230 input_fmts[0] = MEDIA_BUS_FMT_RGB888_1X24; 231 *num_input_fmts = 1; 232 233 return input_fmts; 234 } 235 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) 239 { 240 struct dlpc *dlpc = bridge_to_dlpc(bridge); 241 242 drm_mode_copy(&dlpc->mode, adjusted_mode); 243 } 244 245 static int dlpc_attach(struct drm_bridge *bridge, 246 enum drm_bridge_attach_flags flags) 247 { 248 struct dlpc *dlpc = bridge_to_dlpc(bridge); 249 250 return drm_bridge_attach(bridge->encoder, dlpc->next_bridge, bridge, flags); 251 } 252 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, 263 }; 264 265 static int dlpc3433_parse_dt(struct dlpc *dlpc) 266 { 267 struct device *dev = dlpc->dev; 268 struct device_node *endpoint; 269 int ret; 270 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); 274 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"); 279 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"); 284 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); 288 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) { 292 ret = -EINVAL; 293 goto err_put_endpoint; 294 } 295 296 dlpc->host_node = of_graph_get_remote_port_parent(endpoint); 297 if (!dlpc->host_node) { 298 ret = -ENODEV; 299 goto err_put_host; 300 } 301 302 of_node_put(endpoint); 303 304 return 0; 305 306 err_put_host: 307 of_node_put(dlpc->host_node); 308 err_put_endpoint: 309 of_node_put(endpoint); 310 return ret; 311 } 312 313 static int dlpc_host_attach(struct dlpc *dlpc) 314 { 315 struct device *dev = dlpc->dev; 316 struct mipi_dsi_host *host; 317 struct mipi_dsi_device_info info = { 318 .type = "dlpc3433", 319 .channel = 0, 320 .node = NULL, 321 }; 322 323 host = of_find_mipi_dsi_host_by_node(dlpc->host_node); 324 if (!host) { 325 DRM_DEV_ERROR(dev, "failed to find dsi host\n"); 326 return -EPROBE_DEFER; 327 } 328 329 dlpc->dsi = mipi_dsi_device_register_full(host, &info); 330 if (IS_ERR(dlpc->dsi)) { 331 DRM_DEV_ERROR(dev, "failed to create dsi device\n"); 332 return PTR_ERR(dlpc->dsi); 333 } 334 335 dlpc->dsi->mode_flags = MIPI_DSI_MODE_VIDEO_BURST; 336 dlpc->dsi->format = MIPI_DSI_FMT_RGB565; 337 dlpc->dsi->lanes = dlpc->dsi_lanes; 338 339 return devm_mipi_dsi_attach(dev, dlpc->dsi); 340 } 341 342 static int dlpc3433_probe(struct i2c_client *client) 343 { 344 struct device *dev = &client->dev; 345 struct dlpc *dlpc; 346 int ret; 347 348 dlpc = devm_kzalloc(dev, sizeof(*dlpc), GFP_KERNEL); 349 if (!dlpc) 350 return -ENOMEM; 351 352 dlpc->dev = dev; 353 354 dlpc->regmap = devm_regmap_init_i2c(client, &dlpc_regmap_config); 355 if (IS_ERR(dlpc->regmap)) 356 return PTR_ERR(dlpc->regmap); 357 358 ret = dlpc3433_parse_dt(dlpc); 359 if (ret) 360 return ret; 361 362 dev_set_drvdata(dev, dlpc); 363 i2c_set_clientdata(client, dlpc); 364 365 dlpc->bridge.funcs = &dlpc_bridge_funcs; 366 dlpc->bridge.of_node = dev->of_node; 367 drm_bridge_add(&dlpc->bridge); 368 369 ret = dlpc_host_attach(dlpc); 370 if (ret) { 371 DRM_DEV_ERROR(dev, "failed to attach dsi host\n"); 372 goto err_remove_bridge; 373 } 374 375 return 0; 376 377 err_remove_bridge: 378 drm_bridge_remove(&dlpc->bridge); 379 return ret; 380 } 381 382 static void dlpc3433_remove(struct i2c_client *client) 383 { 384 struct dlpc *dlpc = i2c_get_clientdata(client); 385 386 drm_bridge_remove(&dlpc->bridge); 387 of_node_put(dlpc->host_node); 388 } 389 390 static const struct i2c_device_id dlpc3433_id[] = { 391 { "ti,dlpc3433", 0 }, 392 { /* sentinel */ } 393 }; 394 MODULE_DEVICE_TABLE(i2c, dlpc3433_id); 395 396 static const struct of_device_id dlpc3433_match_table[] = { 397 { .compatible = "ti,dlpc3433" }, 398 { /* sentinel */ } 399 }; 400 MODULE_DEVICE_TABLE(of, dlpc3433_match_table); 401 402 static struct i2c_driver dlpc3433_driver = { 403 .probe_new = dlpc3433_probe, 404 .remove = dlpc3433_remove, 405 .id_table = dlpc3433_id, 406 .driver = { 407 .name = "ti-dlpc3433", 408 .of_match_table = dlpc3433_match_table, 409 }, 410 }; 411 module_i2c_driver(dlpc3433_driver); 412 413 MODULE_AUTHOR("Jagan Teki <jagan@amarulasolutions.com>"); 414 MODULE_AUTHOR("Christopher Vollo <chris@renewoutreach.org>"); 415 MODULE_DESCRIPTION("TI DLPC3433 MIPI DSI Display Controller Bridge"); 416 MODULE_LICENSE("GPL"); 417