Quelle  panel-arm-versatile.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * Panel driver for the ARM Versatile family reference designs from
 * ARM Limited.
 *
 * Author:
 * Linus Walleij <linus.wallei@linaro.org>
 *
 * On the Versatile AB, these panels come mounted on daughterboards
 * named "IB1" or "IB2" (Interface Board 1 & 2 respectively.) They
 * are documented in ARM DUI 0225D Appendix C and D. These daughter
 * boards support TFT display panels.
 *
 * - The IB1 is a passive board where the display connector defines a
 *   few wires for encoding the display type for autodetection,
 *   suitable display settings can then be looked up from this setting.
 *   The magic bits can be read out from the system controller.
 *
 * - The IB2 is a more complex board intended for GSM phone development
 *   with some logic and a control register, which needs to be accessed
 *   and the board display needs to be turned on explicitly.
 *
 * On the Versatile PB, a special CLCD adaptor board is available
 * supporting the same displays as the Versatile AB, plus one more
 * Epson QCIF display.
 *
 */

#include <linux/bitops.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/mfd/syscon.h>
#include <linux/mod_devicetable.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/regmap.h>

#include <video/of_videomode.h>
#include <video/videomode.h>

#include <drm/drm_modes.h>
#include <drm/drm_panel.h>

/*
 * This configuration register in the Versatile and RealView
 * family is uniformly present but appears more and more
 * unutilized starting with the RealView series.
 */
#define SYS_CLCD   0x50

/* The Versatile can detect the connected panel type */
#define SYS_CLCD_CLCDID_MASK  (BIT(8)|BIT(9)|BIT(10)|BIT(11)|BIT(12))
#define SYS_CLCD_ID_SANYO_3_8  (0x00 << 8)
#define SYS_CLCD_ID_SHARP_8_4  (0x01 << 8)
#define SYS_CLCD_ID_EPSON_2_2  (0x02 << 8)
#define SYS_CLCD_ID_SANYO_2_5  (0x07 << 8)
#define SYS_CLCD_ID_VGA   (0x1f << 8)

/* IB2 control register for the Versatile daughterboard */
#define IB2_CTRL   0x00
#define IB2_CTRL_LCD_SD   BIT(1) /* 1 = shut down LCD */
#define IB2_CTRL_LCD_BL_ON  BIT(0)
#define IB2_CTRL_LCD_MASK  (BIT(0)|BIT(1))

/**
 * struct versatile_panel_type - lookup struct for the supported panels
 */
struct versatile_panel_type {
 /**
  * @name: the name of this panel
 */
 const char *name;
 /**
  * @magic: the magic value from the detection register
 */
 u32 magic;
 /**
  * @mode: the DRM display mode for this panel
 */
 struct drm_display_mode mode;
 /**
  * @bus_flags: the DRM bus flags for this panel e.g. inverted clock
 */
 u32 bus_flags;
 /**
  * @width_mm: the panel width in mm
 */
 u32 width_mm;
 /**
  * @height_mm: the panel height in mm
 */
 u32 height_mm;
 /**
  * @ib2: the panel may be connected on an IB2 daughterboard
 */
 bool ib2;
};

/**
 * struct versatile_panel - state container for the Versatile panels
 */
struct versatile_panel {
 /**
  * @dev: the container device
 */
 struct device *dev;
 /**
  * @panel: the DRM panel instance for this device
 */
 struct drm_panel panel;
 /**
  * @panel_type: the Versatile panel type as detected
 */
 const struct versatile_panel_type *panel_type;
 /**
  * @map: map to the parent syscon where the main register reside
 */
 struct regmap *map;
 /**
  * @ib2_map: map to the IB2 syscon, if applicable
 */
 struct regmap *ib2_map;
};

static const struct versatile_panel_type versatile_panels[] = {
 /*
  * Sanyo TM38QV67A02A - 3.8 inch QVGA (320x240) Color TFT
  * found on the Versatile AB IB1 connector or the Versatile
  * PB adaptor board connector.
 */
 {
  .name = "Sanyo TM38QV67A02A",
  .magic = SYS_CLCD_ID_SANYO_3_8,
  .width_mm = 79,
  .height_mm = 54,
  .mode = {
   .clock = 10000,
   .hdisplay = 320,
   .hsync_start = 320 + 6,
   .hsync_end = 320 + 6 + 6,
   .htotal = 320 + 6 + 6 + 6,
   .vdisplay = 240,
   .vsync_start = 240 + 5,
   .vsync_end = 240 + 5 + 6,
   .vtotal = 240 + 5 + 6 + 5,
   .flags = DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC,
  },
 },
 /*
  * Sharp LQ084V1DG21 640x480 VGA Color TFT module
  * found on the Versatile AB IB1 connector or the Versatile
  * PB adaptor board connector.
 */
 {
  .name = "Sharp LQ084V1DG21",
  .magic = SYS_CLCD_ID_SHARP_8_4,
  .width_mm = 171,
  .height_mm = 130,
  .mode = {
   .clock = 25000,
   .hdisplay = 640,
   .hsync_start = 640 + 24,
   .hsync_end = 640 + 24 + 96,
   .htotal = 640 + 24 + 96 + 24,
   .vdisplay = 480,
   .vsync_start = 480 + 11,
   .vsync_end = 480 + 11 + 2,
   .vtotal = 480 + 11 + 2 + 32,
   .flags = DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC,
  },
 },
 /*
  * Epson L2F50113T00 - 2.2 inch QCIF 176x220 Color TFT
  * found on the Versatile PB adaptor board connector.
 */
 {
  .name = "Epson L2F50113T00",
  .magic = SYS_CLCD_ID_EPSON_2_2,
  .width_mm = 34,
  .height_mm = 45,
  .mode = {
   .clock = 62500,
   .hdisplay = 176,
   .hsync_start = 176 + 2,
   .hsync_end = 176 + 2 + 3,
   .htotal = 176 + 2 + 3 + 3,
   .vdisplay = 220,
   .vsync_start = 220 + 0,
   .vsync_end = 220 + 0 + 2,
   .vtotal = 220 + 0 + 2 + 1,
   .flags = DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC,
  },
  .bus_flags = DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE,
 },
 /*
  * Sanyo ALR252RGT 240x320 portrait display found on the
  * Versatile AB IB2 daughterboard for GSM prototyping.
 */
 {
  .name = "Sanyo ALR252RGT",
  .magic = SYS_CLCD_ID_SANYO_2_5,
  .width_mm = 37,
  .height_mm = 50,
  .mode = {
   .clock = 5400,
   .hdisplay = 240,
   .hsync_start = 240 + 10,
   .hsync_end = 240 + 10 + 10,
   .htotal = 240 + 10 + 10 + 20,
   .vdisplay = 320,
   .vsync_start = 320 + 2,
   .vsync_end = 320 + 2 + 2,
   .vtotal = 320 + 2 + 2 + 2,
   .flags = DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC,
  },
  .bus_flags = DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE,
  .ib2 = true,
 },
};

static inline struct versatile_panel *
to_versatile_panel(struct drm_panel *panel)
{
 return container_of(panel, struct versatile_panel, panel);
}

static int versatile_panel_disable(struct drm_panel *panel)
{
 struct versatile_panel *vpanel = to_versatile_panel(panel);

 /* If we're on an IB2 daughterboard, turn off display */
 if (vpanel->ib2_map) {
  dev_dbg(vpanel->dev, "disable IB2 display\n");
  regmap_update_bits(vpanel->ib2_map,
       IB2_CTRL,
       IB2_CTRL_LCD_MASK,
       IB2_CTRL_LCD_SD);
 }

 return 0;
}

static int versatile_panel_enable(struct drm_panel *panel)
{
 struct versatile_panel *vpanel = to_versatile_panel(panel);

 /* If we're on an IB2 daughterboard, turn on display */
 if (vpanel->ib2_map) {
  dev_dbg(vpanel->dev, "enable IB2 display\n");
  regmap_update_bits(vpanel->ib2_map,
       IB2_CTRL,
       IB2_CTRL_LCD_MASK,
       IB2_CTRL_LCD_BL_ON);
 }

 return 0;
}

static int versatile_panel_get_modes(struct drm_panel *panel,
         struct drm_connector *connector)
{
 struct versatile_panel *vpanel = to_versatile_panel(panel);
 struct drm_display_mode *mode;

 connector->display_info.width_mm = vpanel->panel_type->width_mm;
 connector->display_info.height_mm = vpanel->panel_type->height_mm;
 connector->display_info.bus_flags = vpanel->panel_type->bus_flags;

 mode = drm_mode_duplicate(connector->dev, &vpanel->panel_type->mode);
 if (!mode)
  return -ENOMEM;
 drm_mode_set_name(mode);
 mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;

 mode->width_mm = vpanel->panel_type->width_mm;
 mode->height_mm = vpanel->panel_type->height_mm;
 drm_mode_probed_add(connector, mode);

 return 1;
}

static const struct drm_panel_funcs versatile_panel_drm_funcs = {
 .disable = versatile_panel_disable,
 .enable = versatile_panel_enable,
 .get_modes = versatile_panel_get_modes,
};

static int versatile_panel_probe(struct platform_device *pdev)
{
 struct device *dev = &pdev->dev;
 struct versatile_panel *vpanel;
 struct device *parent;
 struct regmap *map;
 int ret;
 u32 val;
 int i;

 parent = dev->parent;
 if (!parent) {
  dev_err(dev, "no parent for versatile panel\n");
  return -ENODEV;
 }
 map = syscon_node_to_regmap(parent->of_node);
 if (IS_ERR(map)) {
  dev_err(dev, "no regmap for versatile panel parent\n");
  return PTR_ERR(map);
 }

 vpanel = devm_drm_panel_alloc(dev, struct versatile_panel, panel,
          &versatile_panel_drm_funcs,
          DRM_MODE_CONNECTOR_DPI);
 if (IS_ERR(vpanel))
  return PTR_ERR(vpanel);

 ret = regmap_read(map, SYS_CLCD, &val);
 if (ret) {
  dev_err(dev, "cannot access syscon regs\n");
  return ret;
 }

 val &= SYS_CLCD_CLCDID_MASK;

 for (i = 0; i < ARRAY_SIZE(versatile_panels); i++) {
  const struct versatile_panel_type *pt;

  pt = &versatile_panels[i];
  if (pt->magic == val) {
   vpanel->panel_type = pt;
   break;
  }
 }

 /* No panel detected or VGA, let's leave this show */
 if (i == ARRAY_SIZE(versatile_panels)) {
  dev_info(dev, "no panel detected\n");
  return -ENODEV;
 }

 dev_info(dev, "detected: %s\n", vpanel->panel_type->name);
 vpanel->dev = dev;
 vpanel->map = map;

 /* Check if the panel is mounted on an IB2 daughterboard */
 if (vpanel->panel_type->ib2) {
  vpanel->ib2_map = syscon_regmap_lookup_by_compatible(
   "arm,versatile-ib2-syscon");
  if (IS_ERR(vpanel->ib2_map))
   vpanel->ib2_map = NULL;
  else
   dev_info(dev, "panel mounted on IB2 daughterboard\n");
 }

 drm_panel_add(&vpanel->panel);

 return 0;
}

static const struct of_device_id versatile_panel_match[] = {
 { .compatible = "arm,versatile-tft-panel", },
 {},
};
MODULE_DEVICE_TABLE(of, versatile_panel_match);

static struct platform_driver versatile_panel_driver = {
 .probe  = versatile_panel_probe,
 .driver  = {
  .name = "versatile-tft-panel",
  .of_match_table = versatile_panel_match,
 },
};
module_platform_driver(versatile_panel_driver);

MODULE_AUTHOR("Linus Walleij <linus.walleij@linaro.org>");
MODULE_DESCRIPTION("ARM Versatile panel driver");
MODULE_LICENSE("GPL v2");