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