0001
0002
0003
0004
0005
0006
0007 #include <linux/delay.h>
0008 #include <linux/gpio/consumer.h>
0009 #include <linux/module.h>
0010 #include <linux/of.h>
0011 #include <linux/of_device.h>
0012 #include <linux/regulator/consumer.h>
0013 #include <linux/swab.h>
0014 #include <linux/backlight.h>
0015
0016 #include <video/mipi_display.h>
0017
0018 #include <drm/drm_mipi_dsi.h>
0019 #include <drm/drm_modes.h>
0020 #include <drm/drm_panel.h>
0021
0022 struct sofef00_panel {
0023 struct drm_panel panel;
0024 struct mipi_dsi_device *dsi;
0025 struct regulator *supply;
0026 struct gpio_desc *reset_gpio;
0027 const struct drm_display_mode *mode;
0028 bool prepared;
0029 };
0030
0031 static inline
0032 struct sofef00_panel *to_sofef00_panel(struct drm_panel *panel)
0033 {
0034 return container_of(panel, struct sofef00_panel, panel);
0035 }
0036
0037 #define dsi_dcs_write_seq(dsi, seq...) do { \
0038 static const u8 d[] = { seq }; \
0039 int ret; \
0040 ret = mipi_dsi_dcs_write_buffer(dsi, d, ARRAY_SIZE(d)); \
0041 if (ret < 0) \
0042 return ret; \
0043 } while (0)
0044
0045 static void sofef00_panel_reset(struct sofef00_panel *ctx)
0046 {
0047 gpiod_set_value_cansleep(ctx->reset_gpio, 0);
0048 usleep_range(5000, 6000);
0049 gpiod_set_value_cansleep(ctx->reset_gpio, 1);
0050 usleep_range(2000, 3000);
0051 gpiod_set_value_cansleep(ctx->reset_gpio, 0);
0052 usleep_range(12000, 13000);
0053 }
0054
0055 static int sofef00_panel_on(struct sofef00_panel *ctx)
0056 {
0057 struct mipi_dsi_device *dsi = ctx->dsi;
0058 struct device *dev = &dsi->dev;
0059 int ret;
0060
0061 dsi->mode_flags |= MIPI_DSI_MODE_LPM;
0062
0063 ret = mipi_dsi_dcs_exit_sleep_mode(dsi);
0064 if (ret < 0) {
0065 dev_err(dev, "Failed to exit sleep mode: %d\n", ret);
0066 return ret;
0067 }
0068 usleep_range(10000, 11000);
0069
0070 dsi_dcs_write_seq(dsi, 0xf0, 0x5a, 0x5a);
0071
0072 ret = mipi_dsi_dcs_set_tear_on(dsi, MIPI_DSI_DCS_TEAR_MODE_VBLANK);
0073 if (ret < 0) {
0074 dev_err(dev, "Failed to set tear on: %d\n", ret);
0075 return ret;
0076 }
0077
0078 dsi_dcs_write_seq(dsi, 0xf0, 0xa5, 0xa5);
0079 dsi_dcs_write_seq(dsi, 0xf0, 0x5a, 0x5a);
0080 dsi_dcs_write_seq(dsi, 0xb0, 0x07);
0081 dsi_dcs_write_seq(dsi, 0xb6, 0x12);
0082 dsi_dcs_write_seq(dsi, 0xf0, 0xa5, 0xa5);
0083 dsi_dcs_write_seq(dsi, MIPI_DCS_WRITE_CONTROL_DISPLAY, 0x20);
0084 dsi_dcs_write_seq(dsi, MIPI_DCS_WRITE_POWER_SAVE, 0x00);
0085
0086 ret = mipi_dsi_dcs_set_display_on(dsi);
0087 if (ret < 0) {
0088 dev_err(dev, "Failed to set display on: %d\n", ret);
0089 return ret;
0090 }
0091
0092 return 0;
0093 }
0094
0095 static int sofef00_panel_off(struct sofef00_panel *ctx)
0096 {
0097 struct mipi_dsi_device *dsi = ctx->dsi;
0098 struct device *dev = &dsi->dev;
0099 int ret;
0100
0101 dsi->mode_flags &= ~MIPI_DSI_MODE_LPM;
0102
0103 ret = mipi_dsi_dcs_set_display_off(dsi);
0104 if (ret < 0) {
0105 dev_err(dev, "Failed to set display off: %d\n", ret);
0106 return ret;
0107 }
0108 msleep(40);
0109
0110 ret = mipi_dsi_dcs_enter_sleep_mode(dsi);
0111 if (ret < 0) {
0112 dev_err(dev, "Failed to enter sleep mode: %d\n", ret);
0113 return ret;
0114 }
0115 msleep(160);
0116
0117 return 0;
0118 }
0119
0120 static int sofef00_panel_prepare(struct drm_panel *panel)
0121 {
0122 struct sofef00_panel *ctx = to_sofef00_panel(panel);
0123 struct device *dev = &ctx->dsi->dev;
0124 int ret;
0125
0126 if (ctx->prepared)
0127 return 0;
0128
0129 ret = regulator_enable(ctx->supply);
0130 if (ret < 0) {
0131 dev_err(dev, "Failed to enable regulator: %d\n", ret);
0132 return ret;
0133 }
0134
0135 sofef00_panel_reset(ctx);
0136
0137 ret = sofef00_panel_on(ctx);
0138 if (ret < 0) {
0139 dev_err(dev, "Failed to initialize panel: %d\n", ret);
0140 gpiod_set_value_cansleep(ctx->reset_gpio, 1);
0141 return ret;
0142 }
0143
0144 ctx->prepared = true;
0145 return 0;
0146 }
0147
0148 static int sofef00_panel_unprepare(struct drm_panel *panel)
0149 {
0150 struct sofef00_panel *ctx = to_sofef00_panel(panel);
0151 struct device *dev = &ctx->dsi->dev;
0152 int ret;
0153
0154 if (!ctx->prepared)
0155 return 0;
0156
0157 ret = sofef00_panel_off(ctx);
0158 if (ret < 0)
0159 dev_err(dev, "Failed to un-initialize panel: %d\n", ret);
0160
0161 regulator_disable(ctx->supply);
0162
0163 ctx->prepared = false;
0164 return 0;
0165 }
0166
0167 static const struct drm_display_mode enchilada_panel_mode = {
0168 .clock = (1080 + 112 + 16 + 36) * (2280 + 36 + 8 + 12) * 60 / 1000,
0169 .hdisplay = 1080,
0170 .hsync_start = 1080 + 112,
0171 .hsync_end = 1080 + 112 + 16,
0172 .htotal = 1080 + 112 + 16 + 36,
0173 .vdisplay = 2280,
0174 .vsync_start = 2280 + 36,
0175 .vsync_end = 2280 + 36 + 8,
0176 .vtotal = 2280 + 36 + 8 + 12,
0177 .width_mm = 68,
0178 .height_mm = 145,
0179 };
0180
0181 static const struct drm_display_mode fajita_panel_mode = {
0182 .clock = (1080 + 72 + 16 + 36) * (2340 + 32 + 4 + 18) * 60 / 1000,
0183 .hdisplay = 1080,
0184 .hsync_start = 1080 + 72,
0185 .hsync_end = 1080 + 72 + 16,
0186 .htotal = 1080 + 72 + 16 + 36,
0187 .vdisplay = 2340,
0188 .vsync_start = 2340 + 32,
0189 .vsync_end = 2340 + 32 + 4,
0190 .vtotal = 2340 + 32 + 4 + 18,
0191 .width_mm = 68,
0192 .height_mm = 145,
0193 };
0194
0195 static int sofef00_panel_get_modes(struct drm_panel *panel, struct drm_connector *connector)
0196 {
0197 struct drm_display_mode *mode;
0198 struct sofef00_panel *ctx = to_sofef00_panel(panel);
0199
0200 mode = drm_mode_duplicate(connector->dev, ctx->mode);
0201 if (!mode)
0202 return -ENOMEM;
0203
0204 drm_mode_set_name(mode);
0205
0206 mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
0207 connector->display_info.width_mm = mode->width_mm;
0208 connector->display_info.height_mm = mode->height_mm;
0209 drm_mode_probed_add(connector, mode);
0210
0211 return 1;
0212 }
0213
0214 static const struct drm_panel_funcs sofef00_panel_panel_funcs = {
0215 .prepare = sofef00_panel_prepare,
0216 .unprepare = sofef00_panel_unprepare,
0217 .get_modes = sofef00_panel_get_modes,
0218 };
0219
0220 static int sofef00_panel_bl_update_status(struct backlight_device *bl)
0221 {
0222 struct mipi_dsi_device *dsi = bl_get_data(bl);
0223 int err;
0224 u16 brightness;
0225
0226 brightness = (u16)backlight_get_brightness(bl);
0227
0228 brightness = __swab16(brightness);
0229
0230 err = mipi_dsi_dcs_set_display_brightness(dsi, brightness);
0231 if (err < 0)
0232 return err;
0233
0234 return 0;
0235 }
0236
0237 static const struct backlight_ops sofef00_panel_bl_ops = {
0238 .update_status = sofef00_panel_bl_update_status,
0239 };
0240
0241 static struct backlight_device *
0242 sofef00_create_backlight(struct mipi_dsi_device *dsi)
0243 {
0244 struct device *dev = &dsi->dev;
0245 const struct backlight_properties props = {
0246 .type = BACKLIGHT_PLATFORM,
0247 .brightness = 1023,
0248 .max_brightness = 1023,
0249 };
0250
0251 return devm_backlight_device_register(dev, dev_name(dev), dev, dsi,
0252 &sofef00_panel_bl_ops, &props);
0253 }
0254
0255 static int sofef00_panel_probe(struct mipi_dsi_device *dsi)
0256 {
0257 struct device *dev = &dsi->dev;
0258 struct sofef00_panel *ctx;
0259 int ret;
0260
0261 ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL);
0262 if (!ctx)
0263 return -ENOMEM;
0264
0265 ctx->mode = of_device_get_match_data(dev);
0266
0267 if (!ctx->mode) {
0268 dev_err(dev, "Missing device mode\n");
0269 return -ENODEV;
0270 }
0271
0272 ctx->supply = devm_regulator_get(dev, "vddio");
0273 if (IS_ERR(ctx->supply))
0274 return dev_err_probe(dev, PTR_ERR(ctx->supply),
0275 "Failed to get vddio regulator\n");
0276
0277 ctx->reset_gpio = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH);
0278 if (IS_ERR(ctx->reset_gpio))
0279 return dev_err_probe(dev, PTR_ERR(ctx->reset_gpio),
0280 "Failed to get reset-gpios\n");
0281
0282 ctx->dsi = dsi;
0283 mipi_dsi_set_drvdata(dsi, ctx);
0284
0285 dsi->lanes = 4;
0286 dsi->format = MIPI_DSI_FMT_RGB888;
0287
0288 drm_panel_init(&ctx->panel, dev, &sofef00_panel_panel_funcs,
0289 DRM_MODE_CONNECTOR_DSI);
0290
0291 ctx->panel.backlight = sofef00_create_backlight(dsi);
0292 if (IS_ERR(ctx->panel.backlight))
0293 return dev_err_probe(dev, PTR_ERR(ctx->panel.backlight),
0294 "Failed to create backlight\n");
0295
0296 drm_panel_add(&ctx->panel);
0297
0298 ret = mipi_dsi_attach(dsi);
0299 if (ret < 0) {
0300 dev_err(dev, "Failed to attach to DSI host: %d\n", ret);
0301 drm_panel_remove(&ctx->panel);
0302 return ret;
0303 }
0304
0305 return 0;
0306 }
0307
0308 static int sofef00_panel_remove(struct mipi_dsi_device *dsi)
0309 {
0310 struct sofef00_panel *ctx = mipi_dsi_get_drvdata(dsi);
0311 int ret;
0312
0313 ret = mipi_dsi_detach(dsi);
0314 if (ret < 0)
0315 dev_err(&dsi->dev, "Failed to detach from DSI host: %d\n", ret);
0316
0317 drm_panel_remove(&ctx->panel);
0318
0319 return 0;
0320 }
0321
0322 static const struct of_device_id sofef00_panel_of_match[] = {
0323 {
0324 .compatible = "samsung,sofef00",
0325 .data = &enchilada_panel_mode,
0326 },
0327 {
0328 .compatible = "samsung,s6e3fc2x01",
0329 .data = &fajita_panel_mode,
0330 },
0331 { }
0332 };
0333 MODULE_DEVICE_TABLE(of, sofef00_panel_of_match);
0334
0335 static struct mipi_dsi_driver sofef00_panel_driver = {
0336 .probe = sofef00_panel_probe,
0337 .remove = sofef00_panel_remove,
0338 .driver = {
0339 .name = "panel-oneplus6",
0340 .of_match_table = sofef00_panel_of_match,
0341 },
0342 };
0343
0344 module_mipi_dsi_driver(sofef00_panel_driver);
0345
0346 MODULE_AUTHOR("Caleb Connolly <caleb@connolly.tech>");
0347 MODULE_DESCRIPTION("DRM driver for Samsung AMOLED DSI panels found in OnePlus 6/6T phones");
0348 MODULE_LICENSE("GPL v2");