Signed-off-by: mark yao <yzq at rock-chips.com>
---
drivers/gpu/drm/rockchip/Makefile | 3 +-
drivers/gpu/drm/rockchip/rockchip_panel.c | 297 +++++++++++++++++++++++++++++
2 files changed, 299 insertions(+), 1 deletion(-)
create mode 100644 drivers/gpu/drm/rockchip/rockchip_panel.c
diff --git a/drivers/gpu/drm/rockchip/Makefile
b/drivers/gpu/drm/rockchip/Makefile
index 45c9d50..a5e5132 100644
--- a/drivers/gpu/drm/rockchip/Makefile
+++ b/drivers/gpu/drm/rockchip/Makefile
@@ -5,7 +5,8 @@
ccflags-y := -Iinclude/drm -Idrivers/gpu/drm/rockchip
rockchipdrm-y := rockchip_drm_drv.o rockchip_drm_gem.o \
- rockchip_drm_fb.o rockchip_drm_fbdev.o
+ rockchip_drm_fb.o rockchip_drm_fbdev.o \
+ rockchip_panel.o
obj-$(CONFIG_DRM_ROCKCHIP_CONNECTOR) += rockchip_drm_connector.o
obj-$(CONFIG_DRM_ROCKCHIP_LCDC) += rockchip_drm_lcdc.o
diff --git a/drivers/gpu/drm/rockchip/rockchip_panel.c
b/drivers/gpu/drm/rockchip/rockchip_panel.c
new file mode 100644
index 0000000..87401a2
--- /dev/null
+++ b/drivers/gpu/drm/rockchip/rockchip_panel.c
@@ -0,0 +1,297 @@
+/*
+ * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
+ * Author:mark yao <mark.yao at rock-chips.com>
+ *
+ * based on panel-simple.c
+ *
+ * This software is licensed under the terms of the GNU General Public
+ * License version 2, as published by the Free Software Foundation, and
+ * may be copied, distributed, and modified under those terms.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ */
+
+#include <linux/gpio.h>
+#include <linux/module.h>
+#include <linux/of_gpio.h>
+#include <linux/of_platform.h>
+#include <linux/platform_device.h>
+#include <video/of_videomode.h>
+#include <video/videomode.h>
+
+#include <drm/drmP.h>
+#include <drm/drm_crtc.h>
+#include <drm/drm_panel.h>
+
+#include "rockchip_drm_drv.h"
+
+/* TODO: convert to gpiod_*() API once it's been merged */
+#define GPIO_ACTIVE_LOW (1 << 0)
+
+struct pwr_gpio {
+ struct list_head head;
+ unsigned long enable_gpio_flags;
+ int enable_gpio;
+};
+
+struct rockchip_panel {
+ struct drm_panel base;
+ bool enabled;
+
+ struct drm_display_mode mode;
+ struct rockchip_panel_special priv;
+
+ struct list_head pwrlist;
+};
+
+static inline struct rockchip_panel *to_rockchip_panel(struct drm_panel *panel)
+{
+ return container_of(panel, struct rockchip_panel, base);
+}
+
+static int rockchip_panel_disable(struct drm_panel *panel)
+{
+ struct rockchip_panel *p = to_rockchip_panel(panel);
+ struct pwr_gpio *pwr;
+ struct list_head *pos;
+
+ if (!p->enabled)
+ return 0;
+
+ list_for_each(pos, &p->pwrlist) {
+ pwr = list_entry(pos, struct pwr_gpio, head);
+ if (gpio_is_valid(pwr->enable_gpio)) {
+ if (pwr->enable_gpio_flags & GPIO_ACTIVE_LOW)
+ gpio_set_value(pwr->enable_gpio, 1);
+ else
+ gpio_set_value(pwr->enable_gpio, 0);
+ }
+ }
+
+ p->enabled = false;
+
+ return 0;
+}
+
+static int rockchip_panel_enable(struct drm_panel *panel)
+{
+ struct rockchip_panel *p = to_rockchip_panel(panel);
+ struct pwr_gpio *pwr;
+ struct list_head *pos;
+
+ if (p->enabled)
+ return 0;
+
+ list_for_each(pos, &p->pwrlist) {
+ pwr = list_entry(pos, struct pwr_gpio, head);
+ if (gpio_is_valid(pwr->enable_gpio)) {
+ if (pwr->enable_gpio_flags & GPIO_ACTIVE_LOW)
+ gpio_set_value(pwr->enable_gpio, 0);
+ else
+ gpio_set_value(pwr->enable_gpio, 1);
+ }
+ }
+
+ p->enabled = true;
+
+ return 0;
+}
+
+static int rockchip_panel_get_modes(struct drm_panel *panel)
+{
+ struct rockchip_panel *p = to_rockchip_panel(panel);
+ struct drm_device *drm = panel->drm;
+ struct drm_connector *connector = panel->connector;
+ const struct drm_display_mode *m = &p->mode;
+ struct drm_display_mode *mode;
+
+ mode = drm_mode_duplicate(drm, m);
+ if (!mode) {
+ dev_err(drm->dev, "failed to add mode %ux%u@%u\n",
+ m->hdisplay, m->vdisplay, m->vrefresh);
+ return 0;
+ }
+
+ drm_mode_set_name(mode);
+ drm_mode_probed_add(connector, mode);
+
+ return 1;
+}
+
+static const struct drm_panel_funcs rockchip_panel_funcs = {
+ .disable = rockchip_panel_disable,
+ .enable = rockchip_panel_enable,
+ .get_modes = rockchip_panel_get_modes,
+};
+
+static int rockchip_name_to_face(const char *s)
+{
+ if (!s)
+ return 0;
+
+ if (strncmp(s, "r8g8b8", 6) == 0)
+ return ROCKCHIP_OUTFACE_P888;
+ else if (strncmp(s, "r6g6b6", 6) == 0)
+ return ROCKCHIP_OUTFACE_P666;
+ else if (strncmp(s, "r5g6b5", 6) == 0)
+ return ROCKCHIP_OUTFACE_P565;
+
+ DRM_ERROR("unsupport display output face[%s]\n", s);
+
+ return 0;
+}
+
+static int rockchip_panel_probe(struct platform_device *pdev)
+{
+ struct rockchip_panel *panel;
+ struct device *dev = &pdev->dev;
+ struct rockchip_panel_special *priv;
+ struct device_node *dn = dev->of_node;
+ struct device_node *np;
+ enum of_gpio_flags flags;
+ struct videomode vm;
+ const char *name;
+ struct pwr_gpio *pwr;
+ struct list_head *pos;
+ int value;
+ int err, i;
+ int num_gpio;
+
+ panel = devm_kzalloc(dev, sizeof(*panel), GFP_KERNEL);
+ if (!panel)
+ return -ENOMEM;
+
+ priv = &panel->priv;
+
+ INIT_LIST_HEAD(&panel->pwrlist);
+ num_gpio = of_gpio_named_count(dn, "enable-gpios");
+ for (i = 0; i < num_gpio; i++) {
+ pwr = kmalloc(sizeof(*pwr), GFP_KERNEL);
+ pwr->enable_gpio = of_get_named_gpio_flags(dn,
+ "enable-gpios", i,
+ &flags);
+ if (flags & OF_GPIO_ACTIVE_LOW)
+ pwr->enable_gpio_flags |= GPIO_ACTIVE_LOW;
+
+ if (gpio_is_valid(pwr->enable_gpio)) {
+ err = gpio_request(pwr->enable_gpio, NULL);
+ if (err < 0) {
+ dev_err(dev, "failed to request GPIO#%u: %d\n",
+ pwr->enable_gpio, err);
+ gpio_free(pwr->enable_gpio);
+ kfree(pwr);
+ continue;
+ }
+ value = (pwr->enable_gpio_flags & GPIO_ACTIVE_LOW) != 0;
+ err = gpio_direction_output(pwr->enable_gpio, value);
+ if (err < 0) {
+ dev_err(dev, "failed to setup GPIO%u: %d\n",
+ pwr->enable_gpio, err);
+ gpio_free(pwr->enable_gpio);
+ kfree(pwr);
+ continue;
+ }
+
+ list_add_tail(&pwr->head, &panel->pwrlist);
+ }
+ }
+
+ if (of_property_read_bool(dn, "color-swap-rb"))
+ priv->color_swap = ROCKCHIP_COLOR_SWAP_RB;
+
+ if (of_property_read_bool(dn, "color-swap-rg"))
+ priv->color_swap |= ROCKCHIP_COLOR_SWAP_RG;
+
+ if (of_property_read_bool(dn, "color-swap-gb"))
+ priv->color_swap |= ROCKCHIP_COLOR_SWAP_GB;
+
+ if (of_property_read_string(dn, "rockchip,output-face", &name))
+ /* default set it as RGB screen */
+ priv->out_face = ROCKCHIP_OUTFACE_P666;
+ else
+ priv->out_face = rockchip_name_to_face(name);
+
+ priv->pwr18 = of_property_read_bool(dn, "lcd-vcc18");
+ priv->dither = of_property_read_bool(dn, "output-dither");
+
+ np = of_get_child_by_name(dn, "display-timings");
+ if (!np) {
+ DRM_ERROR("can't find display timings\n");
+ return 0;
+ }
+
+ of_node_put(np);
+ memset(&vm, 0, sizeof(vm));
+
+ err = of_get_videomode(dn, &vm, 0);
+ if (err < 0)
+ return err;
+
+ drm_display_mode_from_videomode(&vm, &panel->mode);
+ panel->mode.type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
+
+ priv->flags = vm.flags;
+ panel->mode.private = (void *)priv;
+
+ drm_panel_init(&panel->base);
+ panel->base.dev = dev;
+ panel->base.funcs = &rockchip_panel_funcs;
+
+ err = drm_panel_add(&panel->base);
+ if (err < 0)
+ goto free_gpio;
+
+ dev_set_drvdata(dev, panel);
+
+ return 0;
+
+free_gpio:
+ list_for_each(pos, &panel->pwrlist) {
+ pwr = list_entry(pos, struct pwr_gpio, head);
+ if (gpio_is_valid(pwr->enable_gpio))
+ gpio_free(pwr->enable_gpio);
+ kfree(pwr);
+ }
+ return err;
+}
+
+static const struct of_device_id platform_of_match[] = {
+ {
+ .compatible = "rockchip,panel",
+ }, {
+ /* sentinel */
+ }
+};
+MODULE_DEVICE_TABLE(of, platform_of_match);
+
+static int rockchip_panel_remove(struct platform_device *pdev)
+{
+ struct rockchip_panel *panel = dev_get_drvdata(&pdev->dev);
+ struct pwr_gpio *pwr;
+ struct list_head *pos;
+
+ drm_panel_detach(&panel->base);
+ drm_panel_remove(&panel->base);
+
+ list_for_each(pos, &panel->pwrlist) {
+ pwr = list_entry(pos, struct pwr_gpio, head);
+ if (gpio_is_valid(pwr->enable_gpio))
+ gpio_free(pwr->enable_gpio);
+ kfree(pwr);
+ }
+
+ return 0;
+}
+
+struct platform_driver rockchip_panel_platform_driver = {
+ .driver = {
+ .name = "rockchip,panel",
+ .owner = THIS_MODULE,
+ .of_match_table = platform_of_match,
+ },
+ .probe = rockchip_panel_probe,
+ .remove = rockchip_panel_remove,
+};
--
1.7.9.5
