From mboxrd@z Thu Jan  1 00:00:00 1970
Return-Path: <linux-kernel-owner@vger.kernel.org>
Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand
        id S1751916AbdCOHUp (ORCPT <rfc822;w@1wt.eu>);
        Wed, 15 Mar 2017 03:20:45 -0400
Received: from mail-pg0-f68.google.com ([74.125.83.68]:32892 "EHLO
        mail-pg0-f68.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org
        with ESMTP id S1751480AbdCOHTZ (ORCPT
        <rfc822;linux-kernel@vger.kernel.org>);
        Wed, 15 Mar 2017 03:19:25 -0400
From: Chris Zhong <zyw@rock-chips.com>
To: linux-rockchip@lists.infradead.org
Cc: Chris Zhong <zyw@rock-chips.com>,
        Thierry Reding <thierry.reding@gmail.com>,
        David Airlie <airlied@linux.ie>, linux-kernel@vger.kernel.org,
        dri-devel@lists.freedesktop.org
Subject: [PATCH v2 2/2] drm/panel: add innolux,p079zca panel driver
Date: Wed, 15 Mar 2017 15:19:13 +0800
Message-Id: <1489562353-10313-2-git-send-email-zyw@rock-chips.com>
X-Mailer: git-send-email 2.6.3
In-Reply-To: <1489562353-10313-1-git-send-email-zyw@rock-chips.com>
References: <1489562353-10313-1-git-send-email-zyw@rock-chips.com>
Sender: linux-kernel-owner@vger.kernel.org
List-ID: <linux-kernel.vger.kernel.org>
X-Mailing-List: linux-kernel@vger.kernel.org

Support Innolux P079ZCA 7.85" 768x1024 TFT LCD panel, it is a MIPI DSI
panel.

Signed-off-by: Chris Zhong <zyw@rock-chips.com>
---

Changes in v2:
- add some error check
- always use Low power mode to send commend
- add comments for all the sleep
- use DRM_DEV_ERROR instead of dev_err

 drivers/gpu/drm/panel/Kconfig                 |  11 +
 drivers/gpu/drm/panel/Makefile                |   1 +
 drivers/gpu/drm/panel/panel-innolux-p079zca.c | 344 ++++++++++++++++++++++++++
 3 files changed, 356 insertions(+)
 create mode 100644 drivers/gpu/drm/panel/panel-innolux-p079zca.c

diff --git a/drivers/gpu/drm/panel/Kconfig b/drivers/gpu/drm/panel/Kconfig
index 62aba97..99dd010 100644
--- a/drivers/gpu/drm/panel/Kconfig
+++ b/drivers/gpu/drm/panel/Kconfig
@@ -18,6 +18,17 @@ config DRM_PANEL_SIMPLE
 	  that it can be automatically turned off when the panel goes into a
 	  low power state.
 
+config DRM_PANEL_INNOLUX_P079ZCA
+	tristate "Innolux P079ZCA panel"
+	depends on OF
+	depends on DRM_MIPI_DSI
+	depends on BACKLIGHT_CLASS_DEVICE
+	help
+	  Say Y here if you want to enable support for Innolux P079ZCA
+	  TFT-LCD modules. The panel has a 1024x768 resolution and uses
+	  24 bit RGB per pixel. It provides a MIPI DSI interface to
+	  the host and has a built-in LED backlight.
+
 config DRM_PANEL_JDI_LT070ME05000
 	tristate "JDI LT070ME05000 WUXGA DSI panel"
 	depends on OF
diff --git a/drivers/gpu/drm/panel/Makefile b/drivers/gpu/drm/panel/Makefile
index a5c7ec0..bda2aa4 100644
--- a/drivers/gpu/drm/panel/Makefile
+++ b/drivers/gpu/drm/panel/Makefile
@@ -1,4 +1,5 @@
 obj-$(CONFIG_DRM_PANEL_SIMPLE) += panel-simple.o
+obj-$(CONFIG_DRM_PANEL_INNOLUX_P079ZCA) += panel-innolux-p079zca.o
 obj-$(CONFIG_DRM_PANEL_JDI_LT070ME05000) += panel-jdi-lt070me05000.o
 obj-$(CONFIG_DRM_PANEL_LG_LG4573) += panel-lg-lg4573.o
 obj-$(CONFIG_DRM_PANEL_PANASONIC_VVX10F034N00) += panel-panasonic-vvx10f034n00.o
diff --git a/drivers/gpu/drm/panel/panel-innolux-p079zca.c b/drivers/gpu/drm/panel/panel-innolux-p079zca.c
new file mode 100644
index 0000000..b8c34e0
--- /dev/null
+++ b/drivers/gpu/drm/panel/panel-innolux-p079zca.c
@@ -0,0 +1,344 @@
+/*
+ * Copyright (c) 2017, Fuzhou Rockchip Electronics Co., Ltd
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ */
+
+#include <linux/backlight.h>
+#include <linux/gpio/consumer.h>
+#include <linux/module.h>
+#include <linux/of.h>
+#include <linux/regulator/consumer.h>
+
+#include <drm/drmP.h>
+#include <drm/drm_crtc.h>
+#include <drm/drm_mipi_dsi.h>
+#include <drm/drm_panel.h>
+
+#include <video/mipi_display.h>
+
+struct innolux_panel {
+	struct drm_panel base;
+	struct mipi_dsi_device *link;
+
+	struct backlight_device *backlight;
+	struct regulator *supply;
+	struct gpio_desc *enable_gpio;
+
+	bool prepared;
+	bool enabled;
+};
+
+static inline struct innolux_panel *to_innolux_panel(struct drm_panel *panel)
+{
+	return container_of(panel, struct innolux_panel, base);
+}
+
+static int innolux_panel_disable(struct drm_panel *panel)
+{
+	struct innolux_panel *innolux = to_innolux_panel(panel);
+	int err;
+
+	if (!innolux->enabled)
+		return 0;
+
+	if (innolux->backlight) {
+		innolux->backlight->props.power = FB_BLANK_POWERDOWN;
+		backlight_update_status(innolux->backlight);
+	}
+
+	err = mipi_dsi_dcs_set_display_off(innolux->link);
+	if (err < 0)
+		DRM_DEV_ERROR(panel->dev, "failed to set display off: %d\n",
+			      err);
+
+	innolux->enabled = false;
+
+	return 0;
+}
+
+static int innolux_panel_unprepare(struct drm_panel *panel)
+{
+	struct innolux_panel *innolux = to_innolux_panel(panel);
+	int err;
+
+	if (!innolux->prepared)
+		return 0;
+
+	err = mipi_dsi_dcs_enter_sleep_mode(innolux->link);
+	if (err < 0) {
+		DRM_DEV_ERROR(panel->dev, "failed to enter sleep mode: %d\n",
+			      err);
+		return err;
+	}
+
+	gpiod_set_value_cansleep(innolux->enable_gpio, 0);
+
+	/* T8: 80ms - 1000ms */
+	msleep(80);
+
+	err = regulator_disable(innolux->supply);
+	if (err < 0)
+		return err;
+
+	innolux->prepared = false;
+
+	return 0;
+}
+
+static int innolux_panel_prepare(struct drm_panel *panel)
+{
+	struct innolux_panel *innolux = to_innolux_panel(panel);
+	int err, ret;
+
+	if (innolux->prepared)
+		return 0;
+
+	gpiod_set_value_cansleep(innolux->enable_gpio, 0);
+
+	err = regulator_enable(innolux->supply);
+	if (err < 0)
+		return err;
+
+	/* T2: 15ms - 1000ms */
+	usleep_range(15000, 16000);
+
+	gpiod_set_value_cansleep(innolux->enable_gpio, 1);
+
+	/* T4: 15ms - 1000ms */
+	usleep_range(15000, 16000);
+
+	err = mipi_dsi_dcs_exit_sleep_mode(innolux->link);
+	if (err < 0) {
+		DRM_DEV_ERROR(panel->dev, "failed to exit sleep mode: %d\n",
+			      err);
+		goto poweroff;
+	}
+
+	/* T6: 120ms - 1000ms*/
+	msleep(120);
+
+	err = mipi_dsi_dcs_set_display_on(innolux->link);
+	if (err < 0) {
+		DRM_DEV_ERROR(panel->dev, "failed to set display on: %d\n",
+			      err);
+		goto poweroff;
+	}
+
+	/* T7: 5ms */
+	usleep_range(5000, 6000);
+
+	innolux->prepared = true;
+
+	return 0;
+
+poweroff:
+	ret = regulator_disable(innolux->supply);
+	if (ret)
+		return ret;
+
+	gpiod_set_value_cansleep(innolux->enable_gpio, 0);
+	return err;
+}
+
+static int innolux_panel_enable(struct drm_panel *panel)
+{
+	struct innolux_panel *innolux = to_innolux_panel(panel);
+	int ret;
+
+	if (innolux->enabled)
+		return 0;
+
+	if (innolux->backlight) {
+		innolux->backlight->props.power = FB_BLANK_UNBLANK;
+		ret = backlight_update_status(innolux->backlight);
+		if (ret) {
+			DRM_DEV_ERROR(panel->drm->dev,
+				      "Failed to enable backlight %d\n", ret);
+			return ret;
+		}
+	}
+
+	innolux->enabled = true;
+
+	return 0;
+}
+
+static const struct drm_display_mode default_mode = {
+	.clock = 56900,
+	.hdisplay = 768,
+	.hsync_start = 768 + 40,
+	.hsync_end = 768 + 40 + 40,
+	.htotal = 768 + 40 + 40 + 40,
+	.vdisplay = 1024,
+	.vsync_start = 1024 + 20,
+	.vsync_end = 1024 + 20 + 4,
+	.vtotal = 1024 + 20 + 4 + 20,
+	.vrefresh = 60,
+};
+
+static int innolux_panel_get_modes(struct drm_panel *panel)
+{
+	struct drm_display_mode *mode;
+
+	mode = drm_mode_duplicate(panel->drm, &default_mode);
+	if (!mode) {
+		DRM_DEV_ERROR(panel->drm->dev, "failed to add mode %ux%ux@%u\n",
+			      default_mode.hdisplay, default_mode.vdisplay,
+			      default_mode.vrefresh);
+		return -ENOMEM;
+	}
+
+	drm_mode_set_name(mode);
+
+	drm_mode_probed_add(panel->connector, mode);
+
+	panel->connector->display_info.width_mm = 120;
+	panel->connector->display_info.height_mm = 160;
+
+	return 1;
+}
+
+static const struct drm_panel_funcs innolux_panel_funcs = {
+	.disable = innolux_panel_disable,
+	.unprepare = innolux_panel_unprepare,
+	.prepare = innolux_panel_prepare,
+	.enable = innolux_panel_enable,
+	.get_modes = innolux_panel_get_modes,
+};
+
+static const struct of_device_id innolux_of_match[] = {
+	{ .compatible = "innolux,p079zca", },
+	{ }
+};
+MODULE_DEVICE_TABLE(of, innolux_of_match);
+
+static int innolux_panel_add(struct innolux_panel *innolux)
+{
+	struct device *dev = &innolux->link->dev;
+	struct device_node *np;
+	int err;
+
+	innolux->supply = devm_regulator_get(dev, "power");
+	if (IS_ERR(innolux->supply))
+		return PTR_ERR(innolux->supply);
+
+	innolux->enable_gpio = devm_gpiod_get_optional(dev, "enable",
+						       GPIOD_OUT_HIGH);
+	if (IS_ERR(innolux->enable_gpio)) {
+		err = PTR_ERR(innolux->enable_gpio);
+		dev_dbg(dev, "failed to get enable gpio: %d\n", err);
+		innolux->enable_gpio = NULL;
+	}
+
+	np = of_parse_phandle(dev->of_node, "backlight", 0);
+	if (np) {
+		innolux->backlight = of_find_backlight_by_node(np);
+		of_node_put(np);
+
+		if (!innolux->backlight)
+			return -EPROBE_DEFER;
+	}
+
+	drm_panel_init(&innolux->base);
+	innolux->base.funcs = &innolux_panel_funcs;
+	innolux->base.dev = &innolux->link->dev;
+
+	err = drm_panel_add(&innolux->base);
+	if (err < 0)
+		goto put_backlight;
+
+	return 0;
+
+put_backlight:
+	if (innolux->backlight)
+		put_device(&innolux->backlight->dev);
+
+	return err;
+}
+
+static void innolux_panel_del(struct innolux_panel *innolux)
+{
+	if (innolux->base.dev)
+		drm_panel_remove(&innolux->base);
+
+	if (innolux->backlight)
+		put_device(&innolux->backlight->dev);
+}
+
+static int innolux_panel_probe(struct mipi_dsi_device *dsi)
+{
+	struct innolux_panel *innolux;
+	int err;
+
+	dsi->lanes = 4;
+	dsi->format = MIPI_DSI_FMT_RGB888;
+	dsi->mode_flags = MIPI_DSI_MODE_VIDEO | MIPI_DSI_MODE_VIDEO_SYNC_PULSE |
+			  MIPI_DSI_MODE_LPM;
+
+	innolux = devm_kzalloc(&dsi->dev, sizeof(*innolux), GFP_KERNEL);
+	if (!innolux)
+		return -ENOMEM;
+
+	mipi_dsi_set_drvdata(dsi, innolux);
+
+	innolux->link = dsi;
+
+	err = innolux_panel_add(innolux);
+	if (err < 0)
+		return err;
+
+	err = mipi_dsi_attach(dsi);
+	return err;
+}
+
+static int innolux_panel_remove(struct mipi_dsi_device *dsi)
+{
+	struct innolux_panel *innolux = mipi_dsi_get_drvdata(dsi);
+	int err;
+
+	err = innolux_panel_unprepare(&innolux->base);
+	if (err < 0)
+		DRM_DEV_ERROR(&dsi->dev, "failed to unprepare panel: %d\n",
+			      err);
+
+	err = innolux_panel_disable(&innolux->base);
+	if (err < 0)
+		DRM_DEV_ERROR(&dsi->dev, "failed to disable panel: %d\n", err);
+
+	err = mipi_dsi_detach(dsi);
+	if (err < 0)
+		DRM_DEV_ERROR(&dsi->dev, "failed to detach from DSI host: %d\n",
+			      err);
+
+	drm_panel_detach(&innolux->base);
+	innolux_panel_del(innolux);
+
+	return 0;
+}
+
+static void innolux_panel_shutdown(struct mipi_dsi_device *dsi)
+{
+	struct innolux_panel *innolux = mipi_dsi_get_drvdata(dsi);
+
+	innolux_panel_unprepare(&innolux->base);
+	innolux_panel_disable(&innolux->base);
+}
+
+static struct mipi_dsi_driver innolux_panel_driver = {
+	.driver = {
+		.name = "panel-innolux-p079zca",
+		.of_match_table = innolux_of_match,
+	},
+	.probe = innolux_panel_probe,
+	.remove = innolux_panel_remove,
+	.shutdown = innolux_panel_shutdown,
+};
+module_mipi_dsi_driver(innolux_panel_driver);
+
+MODULE_AUTHOR("Chris Zhong <zyw@rock-chips.com>");
+MODULE_DESCRIPTION("Innolux P079ZCA panel driver");
+MODULE_LICENSE("GPL v2");
-- 
2.6.3

From mboxrd@z Thu Jan  1 00:00:00 1970
From: Chris Zhong <zyw@rock-chips.com>
Subject: [PATCH v2 2/2] drm/panel: add innolux,p079zca panel driver
Date: Wed, 15 Mar 2017 15:19:13 +0800
Message-ID: <1489562353-10313-2-git-send-email-zyw@rock-chips.com>
References: <1489562353-10313-1-git-send-email-zyw@rock-chips.com>
Mime-Version: 1.0
Content-Type: text/plain; charset="utf-8"
Content-Transfer-Encoding: base64
Return-path: <dri-devel-bounces@lists.freedesktop.org>
In-Reply-To: <1489562353-10313-1-git-send-email-zyw@rock-chips.com>
List-Unsubscribe: <https://lists.freedesktop.org/mailman/options/dri-devel>,
 <mailto:dri-devel-request@lists.freedesktop.org?subject=unsubscribe>
List-Archive: <https://lists.freedesktop.org/archives/dri-devel>
List-Post: <mailto:dri-devel@lists.freedesktop.org>
List-Help: <mailto:dri-devel-request@lists.freedesktop.org?subject=help>
List-Subscribe: <https://lists.freedesktop.org/mailman/listinfo/dri-devel>,
 <mailto:dri-devel-request@lists.freedesktop.org?subject=subscribe>
Errors-To: dri-devel-bounces@lists.freedesktop.org
Sender: "dri-devel" <dri-devel-bounces@lists.freedesktop.org>
To: linux-rockchip@lists.infradead.org
Cc: Chris Zhong <zyw@rock-chips.com>, linux-kernel@vger.kernel.org, dri-devel@lists.freedesktop.org
List-Id: linux-rockchip.vger.kernel.org
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=