Quelle  panel-dpi.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Generic MIPI DPI Panel Driver
 *
 * Copyright (C) 2013 Texas Instruments
 * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
 */

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

#include <video/omapfb_dss.h>
#include <video/of_display_timing.h>

struct panel_drv_data {
 struct omap_dss_device dssdev;
 struct omap_dss_device *in;

 int data_lines;

 struct omap_video_timings videomode;

 struct gpio_desc *enable_gpio;
};

#define to_panel_data(p) container_of(p, struct panel_drv_data, dssdev)

static int panel_dpi_connect(struct omap_dss_device *dssdev)
{
 struct panel_drv_data *ddata = to_panel_data(dssdev);
 struct omap_dss_device *in = ddata->in;

 if (omapdss_device_is_connected(dssdev))
  return 0;

 return in->ops.dpi->connect(in, dssdev);
}

static void panel_dpi_disconnect(struct omap_dss_device *dssdev)
{
 struct panel_drv_data *ddata = to_panel_data(dssdev);
 struct omap_dss_device *in = ddata->in;

 if (!omapdss_device_is_connected(dssdev))
  return;

 in->ops.dpi->disconnect(in, dssdev);
}

static int panel_dpi_enable(struct omap_dss_device *dssdev)
{
 struct panel_drv_data *ddata = to_panel_data(dssdev);
 struct omap_dss_device *in = ddata->in;
 int r;

 if (!omapdss_device_is_connected(dssdev))
  return -ENODEV;

 if (omapdss_device_is_enabled(dssdev))
  return 0;

 if (ddata->data_lines)
  in->ops.dpi->set_data_lines(in, ddata->data_lines);
 in->ops.dpi->set_timings(in, &ddata->videomode);

 r = in->ops.dpi->enable(in);
 if (r)
  return r;

 gpiod_set_value_cansleep(ddata->enable_gpio, 1);

 dssdev->state = OMAP_DSS_DISPLAY_ACTIVE;

 return 0;
}

static void panel_dpi_disable(struct omap_dss_device *dssdev)
{
 struct panel_drv_data *ddata = to_panel_data(dssdev);
 struct omap_dss_device *in = ddata->in;

 if (!omapdss_device_is_enabled(dssdev))
  return;

 gpiod_set_value_cansleep(ddata->enable_gpio, 0);

 in->ops.dpi->disable(in);

 dssdev->state = OMAP_DSS_DISPLAY_DISABLED;
}

static void panel_dpi_set_timings(struct omap_dss_device *dssdev,
  struct omap_video_timings *timings)
{
 struct panel_drv_data *ddata = to_panel_data(dssdev);
 struct omap_dss_device *in = ddata->in;

 ddata->videomode = *timings;
 dssdev->panel.timings = *timings;

 in->ops.dpi->set_timings(in, timings);
}

static void panel_dpi_get_timings(struct omap_dss_device *dssdev,
  struct omap_video_timings *timings)
{
 struct panel_drv_data *ddata = to_panel_data(dssdev);

 *timings = ddata->videomode;
}

static int panel_dpi_check_timings(struct omap_dss_device *dssdev,
  struct omap_video_timings *timings)
{
 struct panel_drv_data *ddata = to_panel_data(dssdev);
 struct omap_dss_device *in = ddata->in;

 return in->ops.dpi->check_timings(in, timings);
}

static struct omap_dss_driver panel_dpi_ops = {
 .connect = panel_dpi_connect,
 .disconnect = panel_dpi_disconnect,

 .enable  = panel_dpi_enable,
 .disable = panel_dpi_disable,

 .set_timings = panel_dpi_set_timings,
 .get_timings = panel_dpi_get_timings,
 .check_timings = panel_dpi_check_timings,

 .get_resolution = omapdss_default_get_resolution,
};

static int panel_dpi_probe_of(struct platform_device *pdev)
{
 struct panel_drv_data *ddata = platform_get_drvdata(pdev);
 struct device_node *node = pdev->dev.of_node;
 struct omap_dss_device *in;
 int r;
 struct display_timing timing;
 struct videomode vm;
 struct gpio_desc *gpio;

 gpio = devm_gpiod_get_optional(&pdev->dev, "enable", GPIOD_OUT_LOW);
 if (IS_ERR(gpio))
  return PTR_ERR(gpio);

 ddata->enable_gpio = gpio;

 r = of_get_display_timing(node, "panel-timing", &timing);
 if (r) {
  dev_err(&pdev->dev, "failed to get video timing\n");
  return r;
 }

 videomode_from_timing(&timing, &vm);
 videomode_to_omap_video_timings(&vm, &ddata->videomode);

 in = omapdss_of_find_source_for_first_ep(node);
 if (IS_ERR(in)) {
  dev_err(&pdev->dev, "failed to find video source\n");
  return PTR_ERR(in);
 }

 ddata->in = in;

 return 0;
}

static int panel_dpi_probe(struct platform_device *pdev)
{
 struct panel_drv_data *ddata;
 struct omap_dss_device *dssdev;
 int r;

 if (!pdev->dev.of_node)
  return -ENODEV;

 ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL);
 if (ddata == NULL)
  return -ENOMEM;

 platform_set_drvdata(pdev, ddata);

 r = panel_dpi_probe_of(pdev);
 if (r)
  return r;

 dssdev = &ddata->dssdev;
 dssdev->dev = &pdev->dev;
 dssdev->driver = &panel_dpi_ops;
 dssdev->type = OMAP_DISPLAY_TYPE_DPI;
 dssdev->owner = THIS_MODULE;
 dssdev->panel.timings = ddata->videomode;
 dssdev->phy.dpi.data_lines = ddata->data_lines;

 r = omapdss_register_display(dssdev);
 if (r) {
  dev_err(&pdev->dev, "Failed to register panel\n");
  goto err_reg;
 }

 return 0;

err_reg:
 omap_dss_put_device(ddata->in);
 return r;
}

static void panel_dpi_remove(struct platform_device *pdev)
{
 struct panel_drv_data *ddata = platform_get_drvdata(pdev);
 struct omap_dss_device *dssdev = &ddata->dssdev;
 struct omap_dss_device *in = ddata->in;

 omapdss_unregister_display(dssdev);

 panel_dpi_disable(dssdev);
 panel_dpi_disconnect(dssdev);

 omap_dss_put_device(in);
}

static const struct of_device_id panel_dpi_of_match[] = {
 { .compatible = "omapdss,panel-dpi", },
 {},
};

MODULE_DEVICE_TABLE(of, panel_dpi_of_match);

static struct platform_driver panel_dpi_driver = {
 .probe = panel_dpi_probe,
 .remove = panel_dpi_remove,
 .driver = {
  .name = "panel-dpi",
  .of_match_table = panel_dpi_of_match,
 },
};

module_platform_driver(panel_dpi_driver);

MODULE_AUTHOR("Tomi Valkeinen ");
MODULE_DESCRIPTION("Generic MIPI DPI Panel Driver");
MODULE_LICENSE("GPL");