Quelle  panel-lincolntech-lcd197.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (C) 2024 BayLibre, SAS
 * Author: Jerome Brunet <jbrunet@baylibre.com>
 */

#include <linux/gpio/consumer.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/regulator/consumer.h>

#include <video/mipi_display.h>

#include <drm/drm_device.h>
#include <drm/drm_probe_helper.h>
#include <drm/drm_mipi_dsi.h>
#include <drm/drm_modes.h>
#include <drm/drm_panel.h>

struct lincoln_lcd197_panel {
 struct drm_panel panel;
 struct mipi_dsi_device *dsi;
 struct regulator *supply;
 struct gpio_desc *enable_gpio;
 struct gpio_desc *reset_gpio;
};

static inline
struct lincoln_lcd197_panel *to_lincoln_lcd197_panel(struct drm_panel *panel)
{
 return container_of(panel, struct lincoln_lcd197_panel, panel);
}

static int lincoln_lcd197_panel_prepare(struct drm_panel *panel)
{
 struct lincoln_lcd197_panel *lcd = to_lincoln_lcd197_panel(panel);
 struct mipi_dsi_multi_context ctx = { .dsi = lcd->dsi };
 int err;

 gpiod_set_value_cansleep(lcd->enable_gpio, 0);
 err = regulator_enable(lcd->supply);
 if (err < 0)
  return err;

 gpiod_set_value_cansleep(lcd->enable_gpio, 1);
 usleep_range(1000, 2000);
 gpiod_set_value_cansleep(lcd->reset_gpio, 1);
 usleep_range(5000, 6000);
 gpiod_set_value_cansleep(lcd->reset_gpio, 0);
 msleep(50);

 mipi_dsi_dcs_write_seq_multi(&ctx, 0xb9, 0xff, 0x83, 0x99);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xd2, 0x55);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xb1, 0x02, 0x04, 0x70, 0x90, 0x01,
          0x32, 0x33, 0x11, 0x11, 0x4d, 0x57, 0x56, 0x73,
          0x02, 0x02);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xb2, 0x00, 0x80, 0x80, 0xae, 0x0a,
          0x0e, 0x75, 0x11, 0x00, 0x00, 0x00);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xb4, 0x00, 0xff, 0x04, 0xa4, 0x02,
          0xa0, 0x00, 0x00, 0x10, 0x00, 0x00, 0x02, 0x00,
          0x24, 0x02, 0x04, 0x0a, 0x21, 0x03, 0x00, 0x00,
          0x08, 0xa6, 0x88, 0x04, 0xa4, 0x02, 0xa0, 0x00,
          0x00, 0x10, 0x00, 0x00, 0x02, 0x00, 0x24, 0x02,
          0x04, 0x0a, 0x00, 0x00, 0x08, 0xa6, 0x00, 0x08,
          0x11);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xd3, 0x00, 0x00, 0x00, 0x00, 0x00,
          0x00, 0x18, 0x18, 0x32, 0x10, 0x09, 0x00, 0x09,
          0x32, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
          0x00, 0x00, 0x11, 0x00, 0x02, 0x02, 0x03, 0x00,
          0x00, 0x00, 0x0a, 0x40);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xd5, 0x18, 0x18, 0x18, 0x18, 0x21,
          0x20, 0x18, 0x18, 0x19, 0x19, 0x19, 0x19, 0x18,
          0x18, 0x18, 0x18, 0x03, 0x02, 0x01, 0x00, 0x2f,
          0x2f, 0x30, 0x30, 0x31, 0x31, 0x18, 0x18, 0x18,
          0x18, 0x18, 0x18);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xd6, 0x18, 0x18, 0x18, 0x18, 0x20,
          0x21, 0x19, 0x19, 0x18, 0x18, 0x19, 0x19, 0x18,
          0x18, 0x18, 0x18, 0x00, 0x01, 0x02, 0x03, 0x2f,
          0x2f, 0x30, 0x30, 0x31, 0x31, 0x18, 0x18, 0x18,
          0x18, 0x18, 0x18);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xbd, 0x01);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xd8, 0x0a, 0xbe, 0xfa, 0xa0, 0x0a,
          0xbe, 0xfa, 0xa0);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xd8, 0x0f, 0xff, 0xff, 0xe0, 0x0f,
          0xff, 0xff, 0xe0);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xbd, 0x02);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xd8, 0x0f, 0xff, 0xff, 0xe0, 0x0f,
          0xff, 0xff, 0xe0);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xe0, 0x01, 0x11, 0x1c, 0x17, 0x39,
          0x43, 0x54, 0x51, 0x5a, 0x64, 0x6c, 0x74, 0x7a,
          0x83, 0x8d, 0x92, 0x99, 0xa4, 0xa9, 0xb4, 0xaa,
          0xba, 0xbe, 0x63, 0x5e, 0x69, 0x73, 0x01, 0x11,
          0x1c, 0x17, 0x39, 0x43, 0x54, 0x51, 0x5a, 0x64,
          0x6c, 0x74, 0x7a, 0x83, 0x8d, 0x92, 0x99, 0xa4,
          0xa7, 0xb2, 0xa9, 0xba, 0xbe, 0x63, 0x5e, 0x69,
          0x73);
 mipi_dsi_usleep_range(&ctx, 200, 300);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xb6, 0x92, 0x92);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xcc, 0x00);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xbf, 0x40, 0x41, 0x50, 0x49);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xc6, 0xff, 0xf9);
 mipi_dsi_dcs_write_seq_multi(&ctx, 0xc0, 0x25, 0x5a);
 mipi_dsi_dcs_write_seq_multi(&ctx, MIPI_DCS_SET_ADDRESS_MODE, 0x02);
 mipi_dsi_dcs_exit_sleep_mode_multi(&ctx);
 mipi_dsi_msleep(&ctx, 120);

 if (ctx.accum_err) {
  gpiod_set_value_cansleep(lcd->enable_gpio, 0);
  gpiod_set_value_cansleep(lcd->reset_gpio, 1);
  regulator_disable(lcd->supply);
 }

 return ctx.accum_err;
}

static int lincoln_lcd197_panel_unprepare(struct drm_panel *panel)
{
 struct lincoln_lcd197_panel *lcd = to_lincoln_lcd197_panel(panel);
 struct mipi_dsi_multi_context ctx = { .dsi = lcd->dsi };

 mipi_dsi_dcs_enter_sleep_mode_multi(&ctx);
 mipi_dsi_usleep_range(&ctx, 5000, 6000);
 gpiod_set_value_cansleep(lcd->enable_gpio, 0);
 gpiod_set_value_cansleep(lcd->reset_gpio, 1);
 regulator_disable(lcd->supply);

 return ctx.accum_err;
}

static int lincoln_lcd197_panel_enable(struct drm_panel *panel)
{
 struct lincoln_lcd197_panel *lcd = to_lincoln_lcd197_panel(panel);
 struct mipi_dsi_multi_context ctx = { .dsi = lcd->dsi };

 mipi_dsi_dcs_set_display_on_multi(&ctx);
 mipi_dsi_msleep(&ctx, 20);

 return ctx.accum_err;
}

static int lincoln_lcd197_panel_disable(struct drm_panel *panel)
{
 struct lincoln_lcd197_panel *lcd = to_lincoln_lcd197_panel(panel);
 struct mipi_dsi_multi_context ctx = { .dsi = lcd->dsi };

 mipi_dsi_dcs_set_display_off_multi(&ctx);
 mipi_dsi_msleep(&ctx, 50);

 return ctx.accum_err;
}

static const struct drm_display_mode lcd197_mode = {
 .clock = 154002,
 .hdisplay = 1080,
 .hsync_start = 1080 + 20,
 .hsync_end = 1080 + 20 + 6,
 .htotal = 1080 + 204,
 .vdisplay = 1920,
 .vsync_start = 1920 + 4,
 .vsync_end = 1920 + 4 + 4,
 .vtotal = 1920 + 79,
 .flags = DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC,
 .width_mm = 79,
 .height_mm = 125,
 .type = DRM_MODE_TYPE_DRIVER,
};

static int lincoln_lcd197_panel_get_modes(struct drm_panel *panel,
       struct drm_connector *connector)
{
 return drm_connector_helper_get_modes_fixed(connector, &lcd197_mode);
}

static const struct drm_panel_funcs lincoln_lcd197_panel_funcs = {
 .prepare = lincoln_lcd197_panel_prepare,
 .unprepare = lincoln_lcd197_panel_unprepare,
 .enable = lincoln_lcd197_panel_enable,
 .disable = lincoln_lcd197_panel_disable,
 .get_modes = lincoln_lcd197_panel_get_modes,
};

static int lincoln_lcd197_panel_probe(struct mipi_dsi_device *dsi)
{
 struct lincoln_lcd197_panel *lcd;
 struct device *dev = &dsi->dev;
 int err;

 dsi->lanes = 4;
 dsi->format = MIPI_DSI_FMT_RGB888;
 dsi->mode_flags = (MIPI_DSI_MODE_VIDEO |
      MIPI_DSI_MODE_VIDEO_BURST);

 lcd = devm_drm_panel_alloc(dev, struct lincoln_lcd197_panel, panel,
       &lincoln_lcd197_panel_funcs,
       DRM_MODE_CONNECTOR_DSI);
 if (IS_ERR(lcd))
  return PTR_ERR(lcd);

 mipi_dsi_set_drvdata(dsi, lcd);
 lcd->dsi = dsi;

 lcd->supply = devm_regulator_get(dev, "power");
 if (IS_ERR(lcd->supply))
  return dev_err_probe(dev, PTR_ERR(lcd->supply),
         "failed to get power supply");

 lcd->enable_gpio = devm_gpiod_get(dev, "enable",
       GPIOD_OUT_HIGH);
 if (IS_ERR(lcd->enable_gpio))
  return dev_err_probe(dev, PTR_ERR(lcd->enable_gpio),
         "failed to get enable gpio");

 lcd->reset_gpio = devm_gpiod_get(dev, "reset",
       GPIOD_OUT_HIGH);
 if (IS_ERR(lcd->reset_gpio))
  return dev_err_probe(dev, PTR_ERR(lcd->reset_gpio),
         "failed to get reset gpio");

 err = drm_panel_of_backlight(&lcd->panel);
 if (err)
  return err;

 drm_panel_add(&lcd->panel);
 err = mipi_dsi_attach(dsi);
 if (err)
  drm_panel_remove(&lcd->panel);

 return err;
}

static void lincoln_lcd197_panel_remove(struct mipi_dsi_device *dsi)
{
 struct lincoln_lcd197_panel *lcd = mipi_dsi_get_drvdata(dsi);
 int err;

 err = mipi_dsi_detach(dsi);
 if (err < 0)
  dev_err(&dsi->dev, "failed to detach from DSI host: %d\n", err);

 drm_panel_remove(&lcd->panel);
}

static const struct of_device_id lincoln_lcd197_of_match[] = {
 { .compatible = "lincolntech,lcd197", },
 { /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, lincoln_lcd197_of_match);

static struct mipi_dsi_driver lincoln_lcd197_panel_driver = {
 .driver = {
  .name = "panel-lincolntech-lcd197",
  .of_match_table = lincoln_lcd197_of_match,
 },
 .probe = lincoln_lcd197_panel_probe,
 .remove = lincoln_lcd197_panel_remove,
};
module_mipi_dsi_driver(lincoln_lcd197_panel_driver);

MODULE_AUTHOR("Jerome Brunet ");
MODULE_DESCRIPTION("Lincoln Technologies LCD197 panel driver");
MODULE_LICENSE("GPL");