1 // SPDX-License-Identifier: GPL-2.0-only 2 /* Copyright (c) 2020 Caleb Connolly <caleb@connolly.tech> 3 * Generated with linux-mdss-dsi-panel-driver-generator from vendor device tree: 4 * Copyright (c) 2020, The Linux Foundation. All rights reserved. 5 */ 6 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 #include <linux/backlight.h> 13 14 #include <video/mipi_display.h> 15 16 #include <drm/drm_mipi_dsi.h> 17 #include <drm/drm_modes.h> 18 #include <drm/drm_panel.h> 19 20 struct sofef00_panel { 21 struct drm_panel panel; 22 struct mipi_dsi_device *dsi; 23 struct regulator *supply; 24 struct gpio_desc *reset_gpio; 25 const struct drm_display_mode *mode; 26 }; 27 28 static inline 29 struct sofef00_panel *to_sofef00_panel(struct drm_panel *panel) 30 { 31 return container_of(panel, struct sofef00_panel, panel); 32 } 33 34 static void sofef00_panel_reset(struct sofef00_panel *ctx) 35 { 36 gpiod_set_value_cansleep(ctx->reset_gpio, 0); 37 usleep_range(5000, 6000); 38 gpiod_set_value_cansleep(ctx->reset_gpio, 1); 39 usleep_range(2000, 3000); 40 gpiod_set_value_cansleep(ctx->reset_gpio, 0); 41 usleep_range(12000, 13000); 42 } 43 44 static int sofef00_panel_on(struct sofef00_panel *ctx) 45 { 46 struct mipi_dsi_device *dsi = ctx->dsi; 47 struct device *dev = &dsi->dev; 48 int ret; 49 50 dsi->mode_flags |= MIPI_DSI_MODE_LPM; 51 52 ret = mipi_dsi_dcs_exit_sleep_mode(dsi); 53 if (ret < 0) { 54 dev_err(dev, "Failed to exit sleep mode: %d\n", ret); 55 return ret; 56 } 57 usleep_range(10000, 11000); 58 59 mipi_dsi_dcs_write_seq(dsi, 0xf0, 0x5a, 0x5a); 60 61 ret = mipi_dsi_dcs_set_tear_on(dsi, MIPI_DSI_DCS_TEAR_MODE_VBLANK); 62 if (ret < 0) { 63 dev_err(dev, "Failed to set tear on: %d\n", ret); 64 return ret; 65 } 66 67 mipi_dsi_dcs_write_seq(dsi, 0xf0, 0xa5, 0xa5); 68 mipi_dsi_dcs_write_seq(dsi, 0xf0, 0x5a, 0x5a); 69 mipi_dsi_dcs_write_seq(dsi, 0xb0, 0x07); 70 mipi_dsi_dcs_write_seq(dsi, 0xb6, 0x12); 71 mipi_dsi_dcs_write_seq(dsi, 0xf0, 0xa5, 0xa5); 72 mipi_dsi_dcs_write_seq(dsi, MIPI_DCS_WRITE_CONTROL_DISPLAY, 0x20); 73 mipi_dsi_dcs_write_seq(dsi, MIPI_DCS_WRITE_POWER_SAVE, 0x00); 74 75 ret = mipi_dsi_dcs_set_display_on(dsi); 76 if (ret < 0) { 77 dev_err(dev, "Failed to set display on: %d\n", ret); 78 return ret; 79 } 80 81 return 0; 82 } 83 84 static int sofef00_panel_off(struct sofef00_panel *ctx) 85 { 86 struct mipi_dsi_device *dsi = ctx->dsi; 87 struct device *dev = &dsi->dev; 88 int ret; 89 90 dsi->mode_flags &= ~MIPI_DSI_MODE_LPM; 91 92 ret = mipi_dsi_dcs_set_display_off(dsi); 93 if (ret < 0) { 94 dev_err(dev, "Failed to set display off: %d\n", ret); 95 return ret; 96 } 97 msleep(40); 98 99 ret = mipi_dsi_dcs_enter_sleep_mode(dsi); 100 if (ret < 0) { 101 dev_err(dev, "Failed to enter sleep mode: %d\n", ret); 102 return ret; 103 } 104 msleep(160); 105 106 return 0; 107 } 108 109 static int sofef00_panel_prepare(struct drm_panel *panel) 110 { 111 struct sofef00_panel *ctx = to_sofef00_panel(panel); 112 struct device *dev = &ctx->dsi->dev; 113 int ret; 114 115 ret = regulator_enable(ctx->supply); 116 if (ret < 0) { 117 dev_err(dev, "Failed to enable regulator: %d\n", ret); 118 return ret; 119 } 120 121 sofef00_panel_reset(ctx); 122 123 ret = sofef00_panel_on(ctx); 124 if (ret < 0) { 125 dev_err(dev, "Failed to initialize panel: %d\n", ret); 126 gpiod_set_value_cansleep(ctx->reset_gpio, 1); 127 return ret; 128 } 129 130 return 0; 131 } 132 133 static int sofef00_panel_unprepare(struct drm_panel *panel) 134 { 135 struct sofef00_panel *ctx = to_sofef00_panel(panel); 136 struct device *dev = &ctx->dsi->dev; 137 int ret; 138 139 ret = sofef00_panel_off(ctx); 140 if (ret < 0) 141 dev_err(dev, "Failed to un-initialize panel: %d\n", ret); 142 143 regulator_disable(ctx->supply); 144 145 return 0; 146 } 147 148 static const struct drm_display_mode enchilada_panel_mode = { 149 .clock = (1080 + 112 + 16 + 36) * (2280 + 36 + 8 + 12) * 60 / 1000, 150 .hdisplay = 1080, 151 .hsync_start = 1080 + 112, 152 .hsync_end = 1080 + 112 + 16, 153 .htotal = 1080 + 112 + 16 + 36, 154 .vdisplay = 2280, 155 .vsync_start = 2280 + 36, 156 .vsync_end = 2280 + 36 + 8, 157 .vtotal = 2280 + 36 + 8 + 12, 158 .width_mm = 68, 159 .height_mm = 145, 160 }; 161 162 static const struct drm_display_mode fajita_panel_mode = { 163 .clock = (1080 + 72 + 16 + 36) * (2340 + 32 + 4 + 18) * 60 / 1000, 164 .hdisplay = 1080, 165 .hsync_start = 1080 + 72, 166 .hsync_end = 1080 + 72 + 16, 167 .htotal = 1080 + 72 + 16 + 36, 168 .vdisplay = 2340, 169 .vsync_start = 2340 + 32, 170 .vsync_end = 2340 + 32 + 4, 171 .vtotal = 2340 + 32 + 4 + 18, 172 .width_mm = 68, 173 .height_mm = 145, 174 }; 175 176 static int sofef00_panel_get_modes(struct drm_panel *panel, struct drm_connector *connector) 177 { 178 struct drm_display_mode *mode; 179 struct sofef00_panel *ctx = to_sofef00_panel(panel); 180 181 mode = drm_mode_duplicate(connector->dev, ctx->mode); 182 if (!mode) 183 return -ENOMEM; 184 185 drm_mode_set_name(mode); 186 187 mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED; 188 connector->display_info.width_mm = mode->width_mm; 189 connector->display_info.height_mm = mode->height_mm; 190 drm_mode_probed_add(connector, mode); 191 192 return 1; 193 } 194 195 static const struct drm_panel_funcs sofef00_panel_panel_funcs = { 196 .prepare = sofef00_panel_prepare, 197 .unprepare = sofef00_panel_unprepare, 198 .get_modes = sofef00_panel_get_modes, 199 }; 200 201 static int sofef00_panel_bl_update_status(struct backlight_device *bl) 202 { 203 struct mipi_dsi_device *dsi = bl_get_data(bl); 204 int err; 205 u16 brightness = (u16)backlight_get_brightness(bl); 206 207 err = mipi_dsi_dcs_set_display_brightness_large(dsi, brightness); 208 if (err < 0) 209 return err; 210 211 return 0; 212 } 213 214 static const struct backlight_ops sofef00_panel_bl_ops = { 215 .update_status = sofef00_panel_bl_update_status, 216 }; 217 218 static struct backlight_device * 219 sofef00_create_backlight(struct mipi_dsi_device *dsi) 220 { 221 struct device *dev = &dsi->dev; 222 const struct backlight_properties props = { 223 .type = BACKLIGHT_PLATFORM, 224 .brightness = 1023, 225 .max_brightness = 1023, 226 }; 227 228 return devm_backlight_device_register(dev, dev_name(dev), dev, dsi, 229 &sofef00_panel_bl_ops, &props); 230 } 231 232 static int sofef00_panel_probe(struct mipi_dsi_device *dsi) 233 { 234 struct device *dev = &dsi->dev; 235 struct sofef00_panel *ctx; 236 int ret; 237 238 ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL); 239 if (!ctx) 240 return -ENOMEM; 241 242 ctx->mode = of_device_get_match_data(dev); 243 244 if (!ctx->mode) { 245 dev_err(dev, "Missing device mode\n"); 246 return -ENODEV; 247 } 248 249 ctx->supply = devm_regulator_get(dev, "vddio"); 250 if (IS_ERR(ctx->supply)) 251 return dev_err_probe(dev, PTR_ERR(ctx->supply), 252 "Failed to get vddio regulator\n"); 253 254 ctx->reset_gpio = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH); 255 if (IS_ERR(ctx->reset_gpio)) 256 return dev_err_probe(dev, PTR_ERR(ctx->reset_gpio), 257 "Failed to get reset-gpios\n"); 258 259 ctx->dsi = dsi; 260 mipi_dsi_set_drvdata(dsi, ctx); 261 262 dsi->lanes = 4; 263 dsi->format = MIPI_DSI_FMT_RGB888; 264 265 drm_panel_init(&ctx->panel, dev, &sofef00_panel_panel_funcs, 266 DRM_MODE_CONNECTOR_DSI); 267 268 ctx->panel.backlight = sofef00_create_backlight(dsi); 269 if (IS_ERR(ctx->panel.backlight)) 270 return dev_err_probe(dev, PTR_ERR(ctx->panel.backlight), 271 "Failed to create backlight\n"); 272 273 drm_panel_add(&ctx->panel); 274 275 ret = mipi_dsi_attach(dsi); 276 if (ret < 0) { 277 dev_err(dev, "Failed to attach to DSI host: %d\n", ret); 278 drm_panel_remove(&ctx->panel); 279 return ret; 280 } 281 282 return 0; 283 } 284 285 static void sofef00_panel_remove(struct mipi_dsi_device *dsi) 286 { 287 struct sofef00_panel *ctx = mipi_dsi_get_drvdata(dsi); 288 int ret; 289 290 ret = mipi_dsi_detach(dsi); 291 if (ret < 0) 292 dev_err(&dsi->dev, "Failed to detach from DSI host: %d\n", ret); 293 294 drm_panel_remove(&ctx->panel); 295 } 296 297 static const struct of_device_id sofef00_panel_of_match[] = { 298 { // OnePlus 6 / enchilada 299 .compatible = "samsung,sofef00", 300 .data = &enchilada_panel_mode, 301 }, 302 { // OnePlus 6T / fajita 303 .compatible = "samsung,s6e3fc2x01", 304 .data = &fajita_panel_mode, 305 }, 306 { /* sentinel */ } 307 }; 308 MODULE_DEVICE_TABLE(of, sofef00_panel_of_match); 309 310 static struct mipi_dsi_driver sofef00_panel_driver = { 311 .probe = sofef00_panel_probe, 312 .remove = sofef00_panel_remove, 313 .driver = { 314 .name = "panel-oneplus6", 315 .of_match_table = sofef00_panel_of_match, 316 }, 317 }; 318 319 module_mipi_dsi_driver(sofef00_panel_driver); 320 321 MODULE_AUTHOR("Caleb Connolly <caleb@connolly.tech>"); 322 MODULE_DESCRIPTION("DRM driver for Samsung AMOLED DSI panels found in OnePlus 6/6T phones"); 323 MODULE_LICENSE("GPL v2"); 324