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 S1751453AbeDDJ6N (ORCPT <rfc822;w@1wt.eu>);
        Wed, 4 Apr 2018 05:58:13 -0400
Received: from mail.bootlin.com ([62.4.15.54]:42963 "EHLO mail.bootlin.com"
        rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP
        id S1750916AbeDDJ5m (ORCPT <rfc822;linux-kernel@vger.kernel.org>);
        Wed, 4 Apr 2018 05:57:42 -0400
From: Maxime Ripard <maxime.ripard@bootlin.com>
To: Thierry Reding <thierry.reding@gmail.com>,
        Chen-Yu Tsai <wens@csie.org>,
        Maxime Ripard <maxime.ripard@bootlin.com>,
        Mark Rutland <mark.rutland@arm.com>, Rob Herring <robh+dt@kernel.org>,
        Frank Rowand <frowand.list@gmail.com>
Cc: dri-devel@lists.freedesktop.org, Gustavo Padovan <gustavo@padovan.org>,
        Daniel Vetter <daniel.vetter@intel.com>,
        Maarten Lankhorst <maarten.lankhorst@linux.intel.com>,
        Sean Paul <seanpaul@chromium.org>, devicetree@vger.kernel.org,
        linux-arm-kernel@lists.infradead.org, linux-kernel@vger.kernel.org,
        Thomas Petazzoni <thomas.petazzoni@bootlin.com>
Subject: [PATCH v4 6/8] drm/panel: Add Ilitek ILI9881c panel driver
Date: Wed,  4 Apr 2018 11:57:14 +0200
Message-Id: <a99bb44577ae18e77e60dba904618db23ee5dca7.1522835818.git-series.maxime.ripard@bootlin.com>
X-Mailer: git-send-email 2.14.3
In-Reply-To: <cover.a3617c4362eac8783f412525e52cf5552d19095d.1522835818.git-series.maxime.ripard@bootlin.com>
References: <cover.a3617c4362eac8783f412525e52cf5552d19095d.1522835818.git-series.maxime.ripard@bootlin.com>
In-Reply-To: <cover.a3617c4362eac8783f412525e52cf5552d19095d.1522835818.git-series.maxime.ripard@bootlin.com>
References: <cover.a3617c4362eac8783f412525e52cf5552d19095d.1522835818.git-series.maxime.ripard@bootlin.com>
Sender: linux-kernel-owner@vger.kernel.org
List-ID: <linux-kernel.vger.kernel.org>
X-Mailing-List: linux-kernel@vger.kernel.org

The LHR050H41 panel is the panel shipped with the BananaPi M2-Magic, and is
based on the Ilitek ILI9881c Controller. Add a driver for it, modelled
after the other Ilitek controller drivers.

Signed-off-by: Maxime Ripard <maxime.ripard@bootlin.com>
---
 drivers/gpu/drm/panel/Kconfig                 |   9 +-
 drivers/gpu/drm/panel/Makefile                |   1 +-
 drivers/gpu/drm/panel/panel-ilitek-ili9881c.c | 489 +++++++++++++++++++-
 3 files changed, 499 insertions(+)
 create mode 100644 drivers/gpu/drm/panel/panel-ilitek-ili9881c.c

diff --git a/drivers/gpu/drm/panel/Kconfig b/drivers/gpu/drm/panel/Kconfig
index 25682ff3449a..6020c30a33b3 100644
--- a/drivers/gpu/drm/panel/Kconfig
+++ b/drivers/gpu/drm/panel/Kconfig
@@ -46,6 +46,15 @@ config DRM_PANEL_ILITEK_IL9322
 	  Say Y here if you want to enable support for Ilitek IL9322
 	  QVGA (320x240) RGB, YUV and ITU-T BT.656 panels.
 
+config DRM_PANEL_ILITEK_ILI9881C
+	tristate "Ilitek ILI9881C-based panels"
+	depends on OF
+	depends on DRM_MIPI_DSI
+	depends on BACKLIGHT_CLASS_DEVICE
+	help
+	  Say Y if you want to enable support for panels based on the
+	  Ilitek ILI9881c controller.
+
 config DRM_PANEL_INNOLUX_P079ZCA
 	tristate "Innolux P079ZCA panel"
 	depends on OF
diff --git a/drivers/gpu/drm/panel/Makefile b/drivers/gpu/drm/panel/Makefile
index f26efc11d746..5ccaaa9d13af 100644
--- a/drivers/gpu/drm/panel/Makefile
+++ b/drivers/gpu/drm/panel/Makefile
@@ -3,6 +3,7 @@ obj-$(CONFIG_DRM_PANEL_ARM_VERSATILE) += panel-arm-versatile.o
 obj-$(CONFIG_DRM_PANEL_LVDS) += panel-lvds.o
 obj-$(CONFIG_DRM_PANEL_SIMPLE) += panel-simple.o
 obj-$(CONFIG_DRM_PANEL_ILITEK_IL9322) += panel-ilitek-ili9322.o
+obj-$(CONFIG_DRM_PANEL_ILITEK_ILI9881C) += panel-ilitek-ili9881c.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
diff --git a/drivers/gpu/drm/panel/panel-ilitek-ili9881c.c b/drivers/gpu/drm/panel/panel-ilitek-ili9881c.c
new file mode 100644
index 000000000000..8992a6431c30
--- /dev/null
+++ b/drivers/gpu/drm/panel/panel-ilitek-ili9881c.c
@@ -0,0 +1,489 @@
+// SPDX-License-Identifier: GPL-2.0+
+/*
+ * Copyright (C) 2017, Free Electrons
+ * Author: Maxime Ripard <maxime.ripard@free-electrons.com>
+ */
+
+#include <linux/backlight.h>
+#include <linux/delay.h>
+#include <linux/device.h>
+#include <linux/err.h>
+#include <linux/errno.h>
+#include <linux/fb.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+
+#include <linux/gpio/consumer.h>
+
+#include <drm/drm_mipi_dsi.h>
+#include <drm/drm_modes.h>
+#include <drm/drm_panel.h>
+
+#include <video/mipi_display.h>
+
+struct ili9881c {
+	struct drm_panel	panel;
+	struct mipi_dsi_device	*dsi;
+
+	struct backlight_device *backlight;
+	struct gpio_desc	*power;
+	struct gpio_desc	*reset;
+};
+
+enum ili9881c_op {
+	ILI9881C_SWITCH_PAGE,
+	ILI9881C_COMMAND,
+};
+
+struct ili9881c_instr {
+	enum ili9881c_op	op;
+
+	union arg {
+		struct cmd {
+			u8	cmd;
+			u8	data;
+		} cmd;
+		u8	page;
+	} arg;
+};
+
+#define ILI9881C_SWITCH_PAGE_INSTR(_page)	\
+	{					\
+		.op = ILI9881C_SWITCH_PAGE,	\
+		.arg = {			\
+			.page = (_page),	\
+		},				\
+	}
+
+#define ILI9881C_COMMAND_INSTR(_cmd, _data)		\
+	{						\
+		.op = ILI9881C_COMMAND,		\
+		.arg = {				\
+			.cmd = {			\
+				.cmd = (_cmd),		\
+				.data = (_data),	\
+			},				\
+		},					\
+	}
+
+static struct ili9881c_instr ili9881c_init[] = {
+	ILI9881C_SWITCH_PAGE_INSTR(3),
+	ILI9881C_COMMAND_INSTR(0x01, 0x00),
+	ILI9881C_COMMAND_INSTR(0x02, 0x00),
+	ILI9881C_COMMAND_INSTR(0x03, 0x73),
+	ILI9881C_COMMAND_INSTR(0x04, 0x03),
+	ILI9881C_COMMAND_INSTR(0x05, 0x00),
+	ILI9881C_COMMAND_INSTR(0x06, 0x06),
+	ILI9881C_COMMAND_INSTR(0x07, 0x06),
+	ILI9881C_COMMAND_INSTR(0x08, 0x00),
+	ILI9881C_COMMAND_INSTR(0x09, 0x18),
+	ILI9881C_COMMAND_INSTR(0x0a, 0x04),
+	ILI9881C_COMMAND_INSTR(0x0b, 0x00),
+	ILI9881C_COMMAND_INSTR(0x0c, 0x02),
+	ILI9881C_COMMAND_INSTR(0x0d, 0x03),
+	ILI9881C_COMMAND_INSTR(0x0e, 0x00),
+	ILI9881C_COMMAND_INSTR(0x0f, 0x25),
+	ILI9881C_COMMAND_INSTR(0x10, 0x25),
+	ILI9881C_COMMAND_INSTR(0x11, 0x00),
+	ILI9881C_COMMAND_INSTR(0x12, 0x00),
+	ILI9881C_COMMAND_INSTR(0x13, 0x00),
+	ILI9881C_COMMAND_INSTR(0x14, 0x00),
+	ILI9881C_COMMAND_INSTR(0x15, 0x00),
+	ILI9881C_COMMAND_INSTR(0x16, 0x0C),
+	ILI9881C_COMMAND_INSTR(0x17, 0x00),
+	ILI9881C_COMMAND_INSTR(0x18, 0x00),
+	ILI9881C_COMMAND_INSTR(0x19, 0x00),
+	ILI9881C_COMMAND_INSTR(0x1a, 0x00),
+	ILI9881C_COMMAND_INSTR(0x1b, 0x00),
+	ILI9881C_COMMAND_INSTR(0x1c, 0x00),
+	ILI9881C_COMMAND_INSTR(0x1d, 0x00),
+	ILI9881C_COMMAND_INSTR(0x1e, 0xC0),
+	ILI9881C_COMMAND_INSTR(0x1f, 0x80),
+	ILI9881C_COMMAND_INSTR(0x20, 0x04),
+	ILI9881C_COMMAND_INSTR(0x21, 0x01),
+	ILI9881C_COMMAND_INSTR(0x22, 0x00),
+	ILI9881C_COMMAND_INSTR(0x23, 0x00),
+	ILI9881C_COMMAND_INSTR(0x24, 0x00),
+	ILI9881C_COMMAND_INSTR(0x25, 0x00),
+	ILI9881C_COMMAND_INSTR(0x26, 0x00),
+	ILI9881C_COMMAND_INSTR(0x27, 0x00),
+	ILI9881C_COMMAND_INSTR(0x28, 0x33),
+	ILI9881C_COMMAND_INSTR(0x29, 0x03),
+	ILI9881C_COMMAND_INSTR(0x2a, 0x00),
+	ILI9881C_COMMAND_INSTR(0x2b, 0x00),
+	ILI9881C_COMMAND_INSTR(0x2c, 0x00),
+	ILI9881C_COMMAND_INSTR(0x2d, 0x00),
+	ILI9881C_COMMAND_INSTR(0x2e, 0x00),
+	ILI9881C_COMMAND_INSTR(0x2f, 0x00),
+	ILI9881C_COMMAND_INSTR(0x30, 0x00),
+	ILI9881C_COMMAND_INSTR(0x31, 0x00),
+	ILI9881C_COMMAND_INSTR(0x32, 0x00),
+	ILI9881C_COMMAND_INSTR(0x33, 0x00),
+	ILI9881C_COMMAND_INSTR(0x34, 0x04),
+	ILI9881C_COMMAND_INSTR(0x35, 0x00),
+	ILI9881C_COMMAND_INSTR(0x36, 0x00),
+	ILI9881C_COMMAND_INSTR(0x37, 0x00),
+	ILI9881C_COMMAND_INSTR(0x38, 0x3C),
+	ILI9881C_COMMAND_INSTR(0x39, 0x00),
+	ILI9881C_COMMAND_INSTR(0x3a, 0x00),
+	ILI9881C_COMMAND_INSTR(0x3b, 0x00),
+	ILI9881C_COMMAND_INSTR(0x3c, 0x00),
+	ILI9881C_COMMAND_INSTR(0x3d, 0x00),
+	ILI9881C_COMMAND_INSTR(0x3e, 0x00),
+	ILI9881C_COMMAND_INSTR(0x3f, 0x00),
+	ILI9881C_COMMAND_INSTR(0x40, 0x00),
+	ILI9881C_COMMAND_INSTR(0x41, 0x00),
+	ILI9881C_COMMAND_INSTR(0x42, 0x00),
+	ILI9881C_COMMAND_INSTR(0x43, 0x00),
+	ILI9881C_COMMAND_INSTR(0x44, 0x00),
+	ILI9881C_COMMAND_INSTR(0x50, 0x01),
+	ILI9881C_COMMAND_INSTR(0x51, 0x23),
+	ILI9881C_COMMAND_INSTR(0x52, 0x45),
+	ILI9881C_COMMAND_INSTR(0x53, 0x67),
+	ILI9881C_COMMAND_INSTR(0x54, 0x89),
+	ILI9881C_COMMAND_INSTR(0x55, 0xab),
+	ILI9881C_COMMAND_INSTR(0x56, 0x01),
+	ILI9881C_COMMAND_INSTR(0x57, 0x23),
+	ILI9881C_COMMAND_INSTR(0x58, 0x45),
+	ILI9881C_COMMAND_INSTR(0x59, 0x67),
+	ILI9881C_COMMAND_INSTR(0x5a, 0x89),
+	ILI9881C_COMMAND_INSTR(0x5b, 0xab),
+	ILI9881C_COMMAND_INSTR(0x5c, 0xcd),
+	ILI9881C_COMMAND_INSTR(0x5d, 0xef),
+	ILI9881C_COMMAND_INSTR(0x5e, 0x11),
+	ILI9881C_COMMAND_INSTR(0x5f, 0x02),
+	ILI9881C_COMMAND_INSTR(0x60, 0x02),
+	ILI9881C_COMMAND_INSTR(0x61, 0x02),
+	ILI9881C_COMMAND_INSTR(0x62, 0x02),
+	ILI9881C_COMMAND_INSTR(0x63, 0x02),
+	ILI9881C_COMMAND_INSTR(0x64, 0x02),
+	ILI9881C_COMMAND_INSTR(0x65, 0x02),
+	ILI9881C_COMMAND_INSTR(0x66, 0x02),
+	ILI9881C_COMMAND_INSTR(0x67, 0x02),
+	ILI9881C_COMMAND_INSTR(0x68, 0x02),
+	ILI9881C_COMMAND_INSTR(0x69, 0x02),
+	ILI9881C_COMMAND_INSTR(0x6a, 0x0C),
+	ILI9881C_COMMAND_INSTR(0x6b, 0x02),
+	ILI9881C_COMMAND_INSTR(0x6c, 0x0F),
+	ILI9881C_COMMAND_INSTR(0x6d, 0x0E),
+	ILI9881C_COMMAND_INSTR(0x6e, 0x0D),
+	ILI9881C_COMMAND_INSTR(0x6f, 0x06),
+	ILI9881C_COMMAND_INSTR(0x70, 0x07),
+	ILI9881C_COMMAND_INSTR(0x71, 0x02),
+	ILI9881C_COMMAND_INSTR(0x72, 0x02),
+	ILI9881C_COMMAND_INSTR(0x73, 0x02),
+	ILI9881C_COMMAND_INSTR(0x74, 0x02),
+	ILI9881C_COMMAND_INSTR(0x75, 0x02),
+	ILI9881C_COMMAND_INSTR(0x76, 0x02),
+	ILI9881C_COMMAND_INSTR(0x77, 0x02),
+	ILI9881C_COMMAND_INSTR(0x78, 0x02),
+	ILI9881C_COMMAND_INSTR(0x79, 0x02),
+	ILI9881C_COMMAND_INSTR(0x7a, 0x02),
+	ILI9881C_COMMAND_INSTR(0x7b, 0x02),
+	ILI9881C_COMMAND_INSTR(0x7c, 0x02),
+	ILI9881C_COMMAND_INSTR(0x7d, 0x02),
+	ILI9881C_COMMAND_INSTR(0x7e, 0x02),
+	ILI9881C_COMMAND_INSTR(0x7f, 0x02),
+	ILI9881C_COMMAND_INSTR(0x80, 0x0C),
+	ILI9881C_COMMAND_INSTR(0x81, 0x02),
+	ILI9881C_COMMAND_INSTR(0x82, 0x0F),
+	ILI9881C_COMMAND_INSTR(0x83, 0x0E),
+	ILI9881C_COMMAND_INSTR(0x84, 0x0D),
+	ILI9881C_COMMAND_INSTR(0x85, 0x06),
+	ILI9881C_COMMAND_INSTR(0x86, 0x07),
+	ILI9881C_COMMAND_INSTR(0x87, 0x02),
+	ILI9881C_COMMAND_INSTR(0x88, 0x02),
+	ILI9881C_COMMAND_INSTR(0x89, 0x02),
+	ILI9881C_COMMAND_INSTR(0x8A, 0x02),
+	ILI9881C_SWITCH_PAGE_INSTR(4),
+	ILI9881C_COMMAND_INSTR(0x6C, 0x15),
+	ILI9881C_COMMAND_INSTR(0x6E, 0x22),
+	ILI9881C_COMMAND_INSTR(0x6F, 0x33),
+	ILI9881C_COMMAND_INSTR(0x3A, 0xA4),
+	ILI9881C_COMMAND_INSTR(0x8D, 0x0D),
+	ILI9881C_COMMAND_INSTR(0x87, 0xBA),
+	ILI9881C_COMMAND_INSTR(0x26, 0x76),
+	ILI9881C_COMMAND_INSTR(0xB2, 0xD1),
+	ILI9881C_SWITCH_PAGE_INSTR(1),
+	ILI9881C_COMMAND_INSTR(0x22, 0x0A),
+	ILI9881C_COMMAND_INSTR(0x53, 0xDC),
+	ILI9881C_COMMAND_INSTR(0x55, 0xA7),
+	ILI9881C_COMMAND_INSTR(0x50, 0x78),
+	ILI9881C_COMMAND_INSTR(0x51, 0x78),
+	ILI9881C_COMMAND_INSTR(0x31, 0x02),
+	ILI9881C_COMMAND_INSTR(0x60, 0x14),
+	ILI9881C_COMMAND_INSTR(0xA0, 0x2A),
+	ILI9881C_COMMAND_INSTR(0xA1, 0x39),
+	ILI9881C_COMMAND_INSTR(0xA2, 0x46),
+	ILI9881C_COMMAND_INSTR(0xA3, 0x0e),
+	ILI9881C_COMMAND_INSTR(0xA4, 0x12),
+	ILI9881C_COMMAND_INSTR(0xA5, 0x25),
+	ILI9881C_COMMAND_INSTR(0xA6, 0x19),
+	ILI9881C_COMMAND_INSTR(0xA7, 0x1d),
+	ILI9881C_COMMAND_INSTR(0xA8, 0xa6),
+	ILI9881C_COMMAND_INSTR(0xA9, 0x1C),
+	ILI9881C_COMMAND_INSTR(0xAA, 0x29),
+	ILI9881C_COMMAND_INSTR(0xAB, 0x85),
+	ILI9881C_COMMAND_INSTR(0xAC, 0x1C),
+	ILI9881C_COMMAND_INSTR(0xAD, 0x1B),
+	ILI9881C_COMMAND_INSTR(0xAE, 0x51),
+	ILI9881C_COMMAND_INSTR(0xAF, 0x22),
+	ILI9881C_COMMAND_INSTR(0xB0, 0x2d),
+	ILI9881C_COMMAND_INSTR(0xB1, 0x4f),
+	ILI9881C_COMMAND_INSTR(0xB2, 0x59),
+	ILI9881C_COMMAND_INSTR(0xB3, 0x3F),
+	ILI9881C_COMMAND_INSTR(0xC0, 0x2A),
+	ILI9881C_COMMAND_INSTR(0xC1, 0x3a),
+	ILI9881C_COMMAND_INSTR(0xC2, 0x45),
+	ILI9881C_COMMAND_INSTR(0xC3, 0x0e),
+	ILI9881C_COMMAND_INSTR(0xC4, 0x11),
+	ILI9881C_COMMAND_INSTR(0xC5, 0x24),
+	ILI9881C_COMMAND_INSTR(0xC6, 0x1a),
+	ILI9881C_COMMAND_INSTR(0xC7, 0x1c),
+	ILI9881C_COMMAND_INSTR(0xC8, 0xaa),
+	ILI9881C_COMMAND_INSTR(0xC9, 0x1C),
+	ILI9881C_COMMAND_INSTR(0xCA, 0x29),
+	ILI9881C_COMMAND_INSTR(0xCB, 0x96),
+	ILI9881C_COMMAND_INSTR(0xCC, 0x1C),
+	ILI9881C_COMMAND_INSTR(0xCD, 0x1B),
+	ILI9881C_COMMAND_INSTR(0xCE, 0x51),
+	ILI9881C_COMMAND_INSTR(0xCF, 0x22),
+	ILI9881C_COMMAND_INSTR(0xD0, 0x2b),
+	ILI9881C_COMMAND_INSTR(0xD1, 0x4b),
+	ILI9881C_COMMAND_INSTR(0xD2, 0x59),
+	ILI9881C_COMMAND_INSTR(0xD3, 0x3F),
+};
+
+static inline struct ili9881c *panel_to_ili9881c(struct drm_panel *panel)
+{
+	return container_of(panel, struct ili9881c, panel);
+}
+
+static int ili9881c_switch_page(struct ili9881c *ctx, u8 page)
+{
+	u8 buf[4] = { 0xff, 0x98, 0x81, page };
+	int ret;
+
+	ret = mipi_dsi_dcs_write_buffer(ctx->dsi, buf, sizeof(buf));
+	if (ret < 0)
+		return ret;
+
+	return 0;
+}
+
+static int ili9881c_send_cmd_data(struct ili9881c *ctx, u8 cmd, u8 data)
+{
+	u8 buf[2] = { cmd, data };
+	int ret;
+
+	ret = mipi_dsi_dcs_write_buffer(ctx->dsi, buf, sizeof(buf));
+	if (ret < 0)
+		return ret;
+
+	return 0;
+}
+
+static int ili9881c_prepare(struct drm_panel *panel)
+{
+	struct ili9881c *ctx = panel_to_ili9881c(panel);
+	unsigned int i;
+	int ret;
+
+	/* Power the panel */
+	gpiod_set_value(ctx->power, 1);
+	msleep(5);
+
+	/* And reset it */
+	gpiod_set_value(ctx->reset, 1);
+	msleep(20);
+
+	gpiod_set_value(ctx->reset, 0);
+	msleep(20);
+
+	for (i = 0; i < ARRAY_SIZE(ili9881c_init); i++) {
+		struct ili9881c_instr *instr = &ili9881c_init[i];
+
+		if (instr->op == ILI9881C_SWITCH_PAGE)
+			ret = ili9881c_switch_page(ctx, instr->arg.page);
+		else if (instr->op == ILI9881C_COMMAND)
+			ret = ili9881c_send_cmd_data(ctx, instr->arg.cmd.cmd,
+						      instr->arg.cmd.data);
+
+		if (ret)
+			return ret;
+	}
+
+	ret = ili9881c_switch_page(ctx, 0);
+	if (ret)
+		return ret;
+
+	ret = mipi_dsi_dcs_set_tear_on(ctx->dsi, MIPI_DSI_DCS_TEAR_MODE_VBLANK);
+	if (ret)
+		return ret;
+
+	mipi_dsi_dcs_exit_sleep_mode(ctx->dsi);
+	if (ret)
+		return ret;
+
+	return 0;
+}
+
+static int ili9881c_enable(struct drm_panel *panel)
+{
+	struct ili9881c *ctx = panel_to_ili9881c(panel);
+
+	msleep(120);
+
+	mipi_dsi_dcs_set_display_on(ctx->dsi);
+	backlight_enable(ctx->backlight);
+
+	return 0;
+}
+
+static int ili9881c_disable(struct drm_panel *panel)
+{
+	struct ili9881c *ctx = panel_to_ili9881c(panel);
+
+	backlight_disable(ctx->backlight);
+	return mipi_dsi_dcs_set_display_off(ctx->dsi);
+}
+
+static int ili9881c_unprepare(struct drm_panel *panel)
+{
+	struct ili9881c *ctx = panel_to_ili9881c(panel);
+
+	mipi_dsi_dcs_enter_sleep_mode(ctx->dsi);
+	gpiod_set_value(ctx->power, 0);
+	gpiod_set_value(ctx->reset, 1);
+
+	return 0;
+}
+
+static const struct drm_display_mode default_mode = {
+	.clock		= 62000,
+	.vrefresh	= 60,
+
+	.hdisplay	= 720,
+	.hsync_start	= 720 + 10,
+	.hsync_end	= 720 + 10 + 20,
+	.htotal		= 720 + 10 + 20 + 30,
+
+	.vdisplay	= 1280,
+	.vsync_start	= 1280 + 10,
+	.vsync_end	= 1280 + 10 + 10,
+	.vtotal		= 1280 + 10 + 10 + 20,
+};
+
+static int ili9881c_get_modes(struct drm_panel *panel)
+{
+	struct drm_connector *connector = panel->connector;
+	struct ili9881c *ctx = panel_to_ili9881c(panel);
+	struct drm_display_mode *mode;
+
+	mode = drm_mode_duplicate(panel->drm, &default_mode);
+	if (!mode) {
+		dev_err(&ctx->dsi->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);
+
+	mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
+	drm_mode_probed_add(connector, mode);
+
+	panel->connector->display_info.width_mm = 62;
+	panel->connector->display_info.height_mm = 110;
+
+	return 1;
+}
+
+static const struct drm_panel_funcs ili9881c_funcs = {
+	.prepare	= ili9881c_prepare,
+	.unprepare	= ili9881c_unprepare,
+	.enable		= ili9881c_enable,
+	.disable	= ili9881c_disable,
+	.get_modes	= ili9881c_get_modes,
+};
+
+static int ili9881c_dsi_probe(struct mipi_dsi_device *dsi)
+{
+	struct device_node *np;
+	struct ili9881c *ctx;
+	int ret;
+
+	ctx = devm_kzalloc(&dsi->dev, sizeof(*ctx), GFP_KERNEL);
+	if (!ctx)
+		return -ENOMEM;
+	mipi_dsi_set_drvdata(dsi, ctx);
+	ctx->dsi = dsi;
+
+	drm_panel_init(&ctx->panel);
+	ctx->panel.dev = &dsi->dev;
+	ctx->panel.funcs = &ili9881c_funcs;
+
+	ctx->power = devm_gpiod_get(&dsi->dev, "power", GPIOD_OUT_LOW);
+	if (IS_ERR(ctx->power)) {
+		dev_err(&dsi->dev, "Couldn't get our power GPIO\n");
+		return PTR_ERR(ctx->power);
+	}
+
+	ctx->reset = devm_gpiod_get(&dsi->dev, "reset", GPIOD_OUT_LOW);
+	if (IS_ERR(ctx->reset)) {
+		dev_err(&dsi->dev, "Couldn't get our reset GPIO\n");
+		return PTR_ERR(ctx->reset);
+	}
+
+	np = of_parse_phandle(dsi->dev.of_node, "backlight", 0);
+	if (np) {
+		ctx->backlight = of_find_backlight_by_node(np);
+		of_node_put(np);
+
+		if (!ctx->backlight)
+			return -EPROBE_DEFER;
+	}
+
+	ret = drm_panel_add(&ctx->panel);
+	if (ret < 0)
+		return ret;
+
+	dsi->mode_flags = MIPI_DSI_MODE_VIDEO_SYNC_PULSE;
+	dsi->format = MIPI_DSI_FMT_RGB888;
+	dsi->lanes = 4;
+
+	return mipi_dsi_attach(dsi);
+}
+
+static int ili9881c_dsi_remove(struct mipi_dsi_device *dsi)
+{
+	struct ili9881c *ctx = mipi_dsi_get_drvdata(dsi);
+
+	mipi_dsi_detach(dsi);
+	drm_panel_remove(&ctx->panel);
+
+	if (ctx->backlight)
+		put_device(&ctx->backlight->dev);
+
+	return 0;
+}
+
+static const struct of_device_id ili9881c_of_match[] = {
+	{ .compatible = "bananapi,lhr050h41" },
+	{ }
+};
+MODULE_DEVICE_TABLE(of, ili9881c_of_match);
+
+static struct mipi_dsi_driver ili9881c_dsi_driver = {
+	.probe		= ili9881c_dsi_probe,
+	.remove		= ili9881c_dsi_remove,
+	.driver = {
+		.name		= "ili9881c-dsi",
+		.of_match_table	= ili9881c_of_match,
+	},
+};
+module_mipi_dsi_driver(ili9881c_dsi_driver);
+
+MODULE_AUTHOR("Maxime Ripard <maxime.ripard@free-electrons.com>");
+MODULE_DESCRIPTION("Ilitek ILI9881C Controller Driver");
+MODULE_LICENSE("GPL v2");
-- 
git-series 0.9.1

From mboxrd@z Thu Jan  1 00:00:00 1970
From: Maxime Ripard <maxime.ripard@bootlin.com>
Subject: [PATCH v4 6/8] drm/panel: Add Ilitek ILI9881c panel driver
Date: Wed,  4 Apr 2018 11:57:14 +0200
Message-ID: <a99bb44577ae18e77e60dba904618db23ee5dca7.1522835818.git-series.maxime.ripard@bootlin.com>
References: <cover.a3617c4362eac8783f412525e52cf5552d19095d.1522835818.git-series.maxime.ripard@bootlin.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: <cover.a3617c4362eac8783f412525e52cf5552d19095d.1522835818.git-series.maxime.ripard@bootlin.com>
In-Reply-To: <cover.a3617c4362eac8783f412525e52cf5552d19095d.1522835818.git-series.maxime.ripard@bootlin.com>
References: <cover.a3617c4362eac8783f412525e52cf5552d19095d.1522835818.git-series.maxime.ripard@bootlin.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: Thierry Reding <thierry.reding@gmail.com>, Chen-Yu Tsai <wens@csie.org>, Maxime Ripard <maxime.ripard@bootlin.com>, Mark Rutland <mark.rutland@arm.com>, Rob Herring <robh+dt@kernel.org>, Frank Rowand <frowand.list@gmail.com>
Cc: devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, dri-devel@lists.freedesktop.org, Thomas Petazzoni <thomas.petazzoni@bootlin.com>, Daniel Vetter <daniel.vetter@intel.com>, linux-arm-kernel@lists.infradead.org
List-Id: devicetree@vger.kernel.org
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=

From mboxrd@z Thu Jan  1 00:00:00 1970
From: maxime.ripard@bootlin.com (Maxime Ripard)
Date: Wed,  4 Apr 2018 11:57:14 +0200
Subject: [PATCH v4 6/8] drm/panel: Add Ilitek ILI9881c panel driver
In-Reply-To: <cover.a3617c4362eac8783f412525e52cf5552d19095d.1522835818.git-series.maxime.ripard@bootlin.com>
References: <cover.a3617c4362eac8783f412525e52cf5552d19095d.1522835818.git-series.maxime.ripard@bootlin.com>
Message-ID: <a99bb44577ae18e77e60dba904618db23ee5dca7.1522835818.git-series.maxime.ripard@bootlin.com>
To: linux-arm-kernel@lists.infradead.org
List-Id: linux-arm-kernel.lists.infradead.org

The LHR050H41 panel is the panel shipped with the BananaPi M2-Magic, and is
based on the Ilitek ILI9881c Controller. Add a driver for it, modelled
after the other Ilitek controller drivers.

Signed-off-by: Maxime Ripard <maxime.ripard@bootlin.com>
---
 drivers/gpu/drm/panel/Kconfig                 |   9 +-
 drivers/gpu/drm/panel/Makefile                |   1 +-
 drivers/gpu/drm/panel/panel-ilitek-ili9881c.c | 489 +++++++++++++++++++-
 3 files changed, 499 insertions(+)
 create mode 100644 drivers/gpu/drm/panel/panel-ilitek-ili9881c.c

diff --git a/drivers/gpu/drm/panel/Kconfig b/drivers/gpu/drm/panel/Kconfig
index 25682ff3449a..6020c30a33b3 100644
--- a/drivers/gpu/drm/panel/Kconfig
+++ b/drivers/gpu/drm/panel/Kconfig
@@ -46,6 +46,15 @@ config DRM_PANEL_ILITEK_IL9322
 	  Say Y here if you want to enable support for Ilitek IL9322
 	  QVGA (320x240) RGB, YUV and ITU-T BT.656 panels.
 
+config DRM_PANEL_ILITEK_ILI9881C
+	tristate "Ilitek ILI9881C-based panels"
+	depends on OF
+	depends on DRM_MIPI_DSI
+	depends on BACKLIGHT_CLASS_DEVICE
+	help
+	  Say Y if you want to enable support for panels based on the
+	  Ilitek ILI9881c controller.
+
 config DRM_PANEL_INNOLUX_P079ZCA
 	tristate "Innolux P079ZCA panel"
 	depends on OF
diff --git a/drivers/gpu/drm/panel/Makefile b/drivers/gpu/drm/panel/Makefile
index f26efc11d746..5ccaaa9d13af 100644
--- a/drivers/gpu/drm/panel/Makefile
+++ b/drivers/gpu/drm/panel/Makefile
@@ -3,6 +3,7 @@ obj-$(CONFIG_DRM_PANEL_ARM_VERSATILE) += panel-arm-versatile.o
 obj-$(CONFIG_DRM_PANEL_LVDS) += panel-lvds.o
 obj-$(CONFIG_DRM_PANEL_SIMPLE) += panel-simple.o
 obj-$(CONFIG_DRM_PANEL_ILITEK_IL9322) += panel-ilitek-ili9322.o
+obj-$(CONFIG_DRM_PANEL_ILITEK_ILI9881C) += panel-ilitek-ili9881c.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
diff --git a/drivers/gpu/drm/panel/panel-ilitek-ili9881c.c b/drivers/gpu/drm/panel/panel-ilitek-ili9881c.c
new file mode 100644
index 000000000000..8992a6431c30
--- /dev/null
+++ b/drivers/gpu/drm/panel/panel-ilitek-ili9881c.c
@@ -0,0 +1,489 @@
+// SPDX-License-Identifier: GPL-2.0+
+/*
+ * Copyright (C) 2017, Free Electrons
+ * Author: Maxime Ripard <maxime.ripard@free-electrons.com>
+ */
+
+#include <linux/backlight.h>
+#include <linux/delay.h>
+#include <linux/device.h>
+#include <linux/err.h>
+#include <linux/errno.h>
+#include <linux/fb.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+
+#include <linux/gpio/consumer.h>
+
+#include <drm/drm_mipi_dsi.h>
+#include <drm/drm_modes.h>
+#include <drm/drm_panel.h>
+
+#include <video/mipi_display.h>
+
+struct ili9881c {
+	struct drm_panel	panel;
+	struct mipi_dsi_device	*dsi;
+
+	struct backlight_device *backlight;
+	struct gpio_desc	*power;
+	struct gpio_desc	*reset;
+};
+
+enum ili9881c_op {
+	ILI9881C_SWITCH_PAGE,
+	ILI9881C_COMMAND,
+};
+
+struct ili9881c_instr {
+	enum ili9881c_op	op;
+
+	union arg {
+		struct cmd {
+			u8	cmd;
+			u8	data;
+		} cmd;
+		u8	page;
+	} arg;
+};
+
+#define ILI9881C_SWITCH_PAGE_INSTR(_page)	\
+	{					\
+		.op = ILI9881C_SWITCH_PAGE,	\
+		.arg = {			\
+			.page = (_page),	\
+		},				\
+	}
+
+#define ILI9881C_COMMAND_INSTR(_cmd, _data)		\
+	{						\
+		.op = ILI9881C_COMMAND,		\
+		.arg = {				\
+			.cmd = {			\
+				.cmd = (_cmd),		\
+				.data = (_data),	\
+			},				\
+		},					\
+	}
+
+static struct ili9881c_instr ili9881c_init[] = {
+	ILI9881C_SWITCH_PAGE_INSTR(3),
+	ILI9881C_COMMAND_INSTR(0x01, 0x00),
+	ILI9881C_COMMAND_INSTR(0x02, 0x00),
+	ILI9881C_COMMAND_INSTR(0x03, 0x73),
+	ILI9881C_COMMAND_INSTR(0x04, 0x03),
+	ILI9881C_COMMAND_INSTR(0x05, 0x00),
+	ILI9881C_COMMAND_INSTR(0x06, 0x06),
+	ILI9881C_COMMAND_INSTR(0x07, 0x06),
+	ILI9881C_COMMAND_INSTR(0x08, 0x00),
+	ILI9881C_COMMAND_INSTR(0x09, 0x18),
+	ILI9881C_COMMAND_INSTR(0x0a, 0x04),
+	ILI9881C_COMMAND_INSTR(0x0b, 0x00),
+	ILI9881C_COMMAND_INSTR(0x0c, 0x02),
+	ILI9881C_COMMAND_INSTR(0x0d, 0x03),
+	ILI9881C_COMMAND_INSTR(0x0e, 0x00),
+	ILI9881C_COMMAND_INSTR(0x0f, 0x25),
+	ILI9881C_COMMAND_INSTR(0x10, 0x25),
+	ILI9881C_COMMAND_INSTR(0x11, 0x00),
+	ILI9881C_COMMAND_INSTR(0x12, 0x00),
+	ILI9881C_COMMAND_INSTR(0x13, 0x00),
+	ILI9881C_COMMAND_INSTR(0x14, 0x00),
+	ILI9881C_COMMAND_INSTR(0x15, 0x00),
+	ILI9881C_COMMAND_INSTR(0x16, 0x0C),
+	ILI9881C_COMMAND_INSTR(0x17, 0x00),
+	ILI9881C_COMMAND_INSTR(0x18, 0x00),
+	ILI9881C_COMMAND_INSTR(0x19, 0x00),
+	ILI9881C_COMMAND_INSTR(0x1a, 0x00),
+	ILI9881C_COMMAND_INSTR(0x1b, 0x00),
+	ILI9881C_COMMAND_INSTR(0x1c, 0x00),
+	ILI9881C_COMMAND_INSTR(0x1d, 0x00),
+	ILI9881C_COMMAND_INSTR(0x1e, 0xC0),
+	ILI9881C_COMMAND_INSTR(0x1f, 0x80),
+	ILI9881C_COMMAND_INSTR(0x20, 0x04),
+	ILI9881C_COMMAND_INSTR(0x21, 0x01),
+	ILI9881C_COMMAND_INSTR(0x22, 0x00),
+	ILI9881C_COMMAND_INSTR(0x23, 0x00),
+	ILI9881C_COMMAND_INSTR(0x24, 0x00),
+	ILI9881C_COMMAND_INSTR(0x25, 0x00),
+	ILI9881C_COMMAND_INSTR(0x26, 0x00),
+	ILI9881C_COMMAND_INSTR(0x27, 0x00),
+	ILI9881C_COMMAND_INSTR(0x28, 0x33),
+	ILI9881C_COMMAND_INSTR(0x29, 0x03),
+	ILI9881C_COMMAND_INSTR(0x2a, 0x00),
+	ILI9881C_COMMAND_INSTR(0x2b, 0x00),
+	ILI9881C_COMMAND_INSTR(0x2c, 0x00),
+	ILI9881C_COMMAND_INSTR(0x2d, 0x00),
+	ILI9881C_COMMAND_INSTR(0x2e, 0x00),
+	ILI9881C_COMMAND_INSTR(0x2f, 0x00),
+	ILI9881C_COMMAND_INSTR(0x30, 0x00),
+	ILI9881C_COMMAND_INSTR(0x31, 0x00),
+	ILI9881C_COMMAND_INSTR(0x32, 0x00),
+	ILI9881C_COMMAND_INSTR(0x33, 0x00),
+	ILI9881C_COMMAND_INSTR(0x34, 0x04),
+	ILI9881C_COMMAND_INSTR(0x35, 0x00),
+	ILI9881C_COMMAND_INSTR(0x36, 0x00),
+	ILI9881C_COMMAND_INSTR(0x37, 0x00),
+	ILI9881C_COMMAND_INSTR(0x38, 0x3C),
+	ILI9881C_COMMAND_INSTR(0x39, 0x00),
+	ILI9881C_COMMAND_INSTR(0x3a, 0x00),
+	ILI9881C_COMMAND_INSTR(0x3b, 0x00),
+	ILI9881C_COMMAND_INSTR(0x3c, 0x00),
+	ILI9881C_COMMAND_INSTR(0x3d, 0x00),
+	ILI9881C_COMMAND_INSTR(0x3e, 0x00),
+	ILI9881C_COMMAND_INSTR(0x3f, 0x00),
+	ILI9881C_COMMAND_INSTR(0x40, 0x00),
+	ILI9881C_COMMAND_INSTR(0x41, 0x00),
+	ILI9881C_COMMAND_INSTR(0x42, 0x00),
+	ILI9881C_COMMAND_INSTR(0x43, 0x00),
+	ILI9881C_COMMAND_INSTR(0x44, 0x00),
+	ILI9881C_COMMAND_INSTR(0x50, 0x01),
+	ILI9881C_COMMAND_INSTR(0x51, 0x23),
+	ILI9881C_COMMAND_INSTR(0x52, 0x45),
+	ILI9881C_COMMAND_INSTR(0x53, 0x67),
+	ILI9881C_COMMAND_INSTR(0x54, 0x89),
+	ILI9881C_COMMAND_INSTR(0x55, 0xab),
+	ILI9881C_COMMAND_INSTR(0x56, 0x01),
+	ILI9881C_COMMAND_INSTR(0x57, 0x23),
+	ILI9881C_COMMAND_INSTR(0x58, 0x45),
+	ILI9881C_COMMAND_INSTR(0x59, 0x67),
+	ILI9881C_COMMAND_INSTR(0x5a, 0x89),
+	ILI9881C_COMMAND_INSTR(0x5b, 0xab),
+	ILI9881C_COMMAND_INSTR(0x5c, 0xcd),
+	ILI9881C_COMMAND_INSTR(0x5d, 0xef),
+	ILI9881C_COMMAND_INSTR(0x5e, 0x11),
+	ILI9881C_COMMAND_INSTR(0x5f, 0x02),
+	ILI9881C_COMMAND_INSTR(0x60, 0x02),
+	ILI9881C_COMMAND_INSTR(0x61, 0x02),
+	ILI9881C_COMMAND_INSTR(0x62, 0x02),
+	ILI9881C_COMMAND_INSTR(0x63, 0x02),
+	ILI9881C_COMMAND_INSTR(0x64, 0x02),
+	ILI9881C_COMMAND_INSTR(0x65, 0x02),
+	ILI9881C_COMMAND_INSTR(0x66, 0x02),
+	ILI9881C_COMMAND_INSTR(0x67, 0x02),
+	ILI9881C_COMMAND_INSTR(0x68, 0x02),
+	ILI9881C_COMMAND_INSTR(0x69, 0x02),
+	ILI9881C_COMMAND_INSTR(0x6a, 0x0C),
+	ILI9881C_COMMAND_INSTR(0x6b, 0x02),
+	ILI9881C_COMMAND_INSTR(0x6c, 0x0F),
+	ILI9881C_COMMAND_INSTR(0x6d, 0x0E),
+	ILI9881C_COMMAND_INSTR(0x6e, 0x0D),
+	ILI9881C_COMMAND_INSTR(0x6f, 0x06),
+	ILI9881C_COMMAND_INSTR(0x70, 0x07),
+	ILI9881C_COMMAND_INSTR(0x71, 0x02),
+	ILI9881C_COMMAND_INSTR(0x72, 0x02),
+	ILI9881C_COMMAND_INSTR(0x73, 0x02),
+	ILI9881C_COMMAND_INSTR(0x74, 0x02),
+	ILI9881C_COMMAND_INSTR(0x75, 0x02),
+	ILI9881C_COMMAND_INSTR(0x76, 0x02),
+	ILI9881C_COMMAND_INSTR(0x77, 0x02),
+	ILI9881C_COMMAND_INSTR(0x78, 0x02),
+	ILI9881C_COMMAND_INSTR(0x79, 0x02),
+	ILI9881C_COMMAND_INSTR(0x7a, 0x02),
+	ILI9881C_COMMAND_INSTR(0x7b, 0x02),
+	ILI9881C_COMMAND_INSTR(0x7c, 0x02),
+	ILI9881C_COMMAND_INSTR(0x7d, 0x02),
+	ILI9881C_COMMAND_INSTR(0x7e, 0x02),
+	ILI9881C_COMMAND_INSTR(0x7f, 0x02),
+	ILI9881C_COMMAND_INSTR(0x80, 0x0C),
+	ILI9881C_COMMAND_INSTR(0x81, 0x02),
+	ILI9881C_COMMAND_INSTR(0x82, 0x0F),
+	ILI9881C_COMMAND_INSTR(0x83, 0x0E),
+	ILI9881C_COMMAND_INSTR(0x84, 0x0D),
+	ILI9881C_COMMAND_INSTR(0x85, 0x06),
+	ILI9881C_COMMAND_INSTR(0x86, 0x07),
+	ILI9881C_COMMAND_INSTR(0x87, 0x02),
+	ILI9881C_COMMAND_INSTR(0x88, 0x02),
+	ILI9881C_COMMAND_INSTR(0x89, 0x02),
+	ILI9881C_COMMAND_INSTR(0x8A, 0x02),
+	ILI9881C_SWITCH_PAGE_INSTR(4),
+	ILI9881C_COMMAND_INSTR(0x6C, 0x15),
+	ILI9881C_COMMAND_INSTR(0x6E, 0x22),
+	ILI9881C_COMMAND_INSTR(0x6F, 0x33),
+	ILI9881C_COMMAND_INSTR(0x3A, 0xA4),
+	ILI9881C_COMMAND_INSTR(0x8D, 0x0D),
+	ILI9881C_COMMAND_INSTR(0x87, 0xBA),
+	ILI9881C_COMMAND_INSTR(0x26, 0x76),
+	ILI9881C_COMMAND_INSTR(0xB2, 0xD1),
+	ILI9881C_SWITCH_PAGE_INSTR(1),
+	ILI9881C_COMMAND_INSTR(0x22, 0x0A),
+	ILI9881C_COMMAND_INSTR(0x53, 0xDC),
+	ILI9881C_COMMAND_INSTR(0x55, 0xA7),
+	ILI9881C_COMMAND_INSTR(0x50, 0x78),
+	ILI9881C_COMMAND_INSTR(0x51, 0x78),
+	ILI9881C_COMMAND_INSTR(0x31, 0x02),
+	ILI9881C_COMMAND_INSTR(0x60, 0x14),
+	ILI9881C_COMMAND_INSTR(0xA0, 0x2A),
+	ILI9881C_COMMAND_INSTR(0xA1, 0x39),
+	ILI9881C_COMMAND_INSTR(0xA2, 0x46),
+	ILI9881C_COMMAND_INSTR(0xA3, 0x0e),
+	ILI9881C_COMMAND_INSTR(0xA4, 0x12),
+	ILI9881C_COMMAND_INSTR(0xA5, 0x25),
+	ILI9881C_COMMAND_INSTR(0xA6, 0x19),
+	ILI9881C_COMMAND_INSTR(0xA7, 0x1d),
+	ILI9881C_COMMAND_INSTR(0xA8, 0xa6),
+	ILI9881C_COMMAND_INSTR(0xA9, 0x1C),
+	ILI9881C_COMMAND_INSTR(0xAA, 0x29),
+	ILI9881C_COMMAND_INSTR(0xAB, 0x85),
+	ILI9881C_COMMAND_INSTR(0xAC, 0x1C),
+	ILI9881C_COMMAND_INSTR(0xAD, 0x1B),
+	ILI9881C_COMMAND_INSTR(0xAE, 0x51),
+	ILI9881C_COMMAND_INSTR(0xAF, 0x22),
+	ILI9881C_COMMAND_INSTR(0xB0, 0x2d),
+	ILI9881C_COMMAND_INSTR(0xB1, 0x4f),
+	ILI9881C_COMMAND_INSTR(0xB2, 0x59),
+	ILI9881C_COMMAND_INSTR(0xB3, 0x3F),
+	ILI9881C_COMMAND_INSTR(0xC0, 0x2A),
+	ILI9881C_COMMAND_INSTR(0xC1, 0x3a),
+	ILI9881C_COMMAND_INSTR(0xC2, 0x45),
+	ILI9881C_COMMAND_INSTR(0xC3, 0x0e),
+	ILI9881C_COMMAND_INSTR(0xC4, 0x11),
+	ILI9881C_COMMAND_INSTR(0xC5, 0x24),
+	ILI9881C_COMMAND_INSTR(0xC6, 0x1a),
+	ILI9881C_COMMAND_INSTR(0xC7, 0x1c),
+	ILI9881C_COMMAND_INSTR(0xC8, 0xaa),
+	ILI9881C_COMMAND_INSTR(0xC9, 0x1C),
+	ILI9881C_COMMAND_INSTR(0xCA, 0x29),
+	ILI9881C_COMMAND_INSTR(0xCB, 0x96),
+	ILI9881C_COMMAND_INSTR(0xCC, 0x1C),
+	ILI9881C_COMMAND_INSTR(0xCD, 0x1B),
+	ILI9881C_COMMAND_INSTR(0xCE, 0x51),
+	ILI9881C_COMMAND_INSTR(0xCF, 0x22),
+	ILI9881C_COMMAND_INSTR(0xD0, 0x2b),
+	ILI9881C_COMMAND_INSTR(0xD1, 0x4b),
+	ILI9881C_COMMAND_INSTR(0xD2, 0x59),
+	ILI9881C_COMMAND_INSTR(0xD3, 0x3F),
+};
+
+static inline struct ili9881c *panel_to_ili9881c(struct drm_panel *panel)
+{
+	return container_of(panel, struct ili9881c, panel);
+}
+
+static int ili9881c_switch_page(struct ili9881c *ctx, u8 page)
+{
+	u8 buf[4] = { 0xff, 0x98, 0x81, page };
+	int ret;
+
+	ret = mipi_dsi_dcs_write_buffer(ctx->dsi, buf, sizeof(buf));
+	if (ret < 0)
+		return ret;
+
+	return 0;
+}
+
+static int ili9881c_send_cmd_data(struct ili9881c *ctx, u8 cmd, u8 data)
+{
+	u8 buf[2] = { cmd, data };
+	int ret;
+
+	ret = mipi_dsi_dcs_write_buffer(ctx->dsi, buf, sizeof(buf));
+	if (ret < 0)
+		return ret;
+
+	return 0;
+}
+
+static int ili9881c_prepare(struct drm_panel *panel)
+{
+	struct ili9881c *ctx = panel_to_ili9881c(panel);
+	unsigned int i;
+	int ret;
+
+	/* Power the panel */
+	gpiod_set_value(ctx->power, 1);
+	msleep(5);
+
+	/* And reset it */
+	gpiod_set_value(ctx->reset, 1);
+	msleep(20);
+
+	gpiod_set_value(ctx->reset, 0);
+	msleep(20);
+
+	for (i = 0; i < ARRAY_SIZE(ili9881c_init); i++) {
+		struct ili9881c_instr *instr = &ili9881c_init[i];
+
+		if (instr->op == ILI9881C_SWITCH_PAGE)
+			ret = ili9881c_switch_page(ctx, instr->arg.page);
+		else if (instr->op == ILI9881C_COMMAND)
+			ret = ili9881c_send_cmd_data(ctx, instr->arg.cmd.cmd,
+						      instr->arg.cmd.data);
+
+		if (ret)
+			return ret;
+	}
+
+	ret = ili9881c_switch_page(ctx, 0);
+	if (ret)
+		return ret;
+
+	ret = mipi_dsi_dcs_set_tear_on(ctx->dsi, MIPI_DSI_DCS_TEAR_MODE_VBLANK);
+	if (ret)
+		return ret;
+
+	mipi_dsi_dcs_exit_sleep_mode(ctx->dsi);
+	if (ret)
+		return ret;
+
+	return 0;
+}
+
+static int ili9881c_enable(struct drm_panel *panel)
+{
+	struct ili9881c *ctx = panel_to_ili9881c(panel);
+
+	msleep(120);
+
+	mipi_dsi_dcs_set_display_on(ctx->dsi);
+	backlight_enable(ctx->backlight);
+
+	return 0;
+}
+
+static int ili9881c_disable(struct drm_panel *panel)
+{
+	struct ili9881c *ctx = panel_to_ili9881c(panel);
+
+	backlight_disable(ctx->backlight);
+	return mipi_dsi_dcs_set_display_off(ctx->dsi);
+}
+
+static int ili9881c_unprepare(struct drm_panel *panel)
+{
+	struct ili9881c *ctx = panel_to_ili9881c(panel);
+
+	mipi_dsi_dcs_enter_sleep_mode(ctx->dsi);
+	gpiod_set_value(ctx->power, 0);
+	gpiod_set_value(ctx->reset, 1);
+
+	return 0;
+}
+
+static const struct drm_display_mode default_mode = {
+	.clock		= 62000,
+	.vrefresh	= 60,
+
+	.hdisplay	= 720,
+	.hsync_start	= 720 + 10,
+	.hsync_end	= 720 + 10 + 20,
+	.htotal		= 720 + 10 + 20 + 30,
+
+	.vdisplay	= 1280,
+	.vsync_start	= 1280 + 10,
+	.vsync_end	= 1280 + 10 + 10,
+	.vtotal		= 1280 + 10 + 10 + 20,
+};
+
+static int ili9881c_get_modes(struct drm_panel *panel)
+{
+	struct drm_connector *connector = panel->connector;
+	struct ili9881c *ctx = panel_to_ili9881c(panel);
+	struct drm_display_mode *mode;
+
+	mode = drm_mode_duplicate(panel->drm, &default_mode);
+	if (!mode) {
+		dev_err(&ctx->dsi->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);
+
+	mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
+	drm_mode_probed_add(connector, mode);
+
+	panel->connector->display_info.width_mm = 62;
+	panel->connector->display_info.height_mm = 110;
+
+	return 1;
+}
+
+static const struct drm_panel_funcs ili9881c_funcs = {
+	.prepare	= ili9881c_prepare,
+	.unprepare	= ili9881c_unprepare,
+	.enable		= ili9881c_enable,
+	.disable	= ili9881c_disable,
+	.get_modes	= ili9881c_get_modes,
+};
+
+static int ili9881c_dsi_probe(struct mipi_dsi_device *dsi)
+{
+	struct device_node *np;
+	struct ili9881c *ctx;
+	int ret;
+
+	ctx = devm_kzalloc(&dsi->dev, sizeof(*ctx), GFP_KERNEL);
+	if (!ctx)
+		return -ENOMEM;
+	mipi_dsi_set_drvdata(dsi, ctx);
+	ctx->dsi = dsi;
+
+	drm_panel_init(&ctx->panel);
+	ctx->panel.dev = &dsi->dev;
+	ctx->panel.funcs = &ili9881c_funcs;
+
+	ctx->power = devm_gpiod_get(&dsi->dev, "power", GPIOD_OUT_LOW);
+	if (IS_ERR(ctx->power)) {
+		dev_err(&dsi->dev, "Couldn't get our power GPIO\n");
+		return PTR_ERR(ctx->power);
+	}
+
+	ctx->reset = devm_gpiod_get(&dsi->dev, "reset", GPIOD_OUT_LOW);
+	if (IS_ERR(ctx->reset)) {
+		dev_err(&dsi->dev, "Couldn't get our reset GPIO\n");
+		return PTR_ERR(ctx->reset);
+	}
+
+	np = of_parse_phandle(dsi->dev.of_node, "backlight", 0);
+	if (np) {
+		ctx->backlight = of_find_backlight_by_node(np);
+		of_node_put(np);
+
+		if (!ctx->backlight)
+			return -EPROBE_DEFER;
+	}
+
+	ret = drm_panel_add(&ctx->panel);
+	if (ret < 0)
+		return ret;
+
+	dsi->mode_flags = MIPI_DSI_MODE_VIDEO_SYNC_PULSE;
+	dsi->format = MIPI_DSI_FMT_RGB888;
+	dsi->lanes = 4;
+
+	return mipi_dsi_attach(dsi);
+}
+
+static int ili9881c_dsi_remove(struct mipi_dsi_device *dsi)
+{
+	struct ili9881c *ctx = mipi_dsi_get_drvdata(dsi);
+
+	mipi_dsi_detach(dsi);
+	drm_panel_remove(&ctx->panel);
+
+	if (ctx->backlight)
+		put_device(&ctx->backlight->dev);
+
+	return 0;
+}
+
+static const struct of_device_id ili9881c_of_match[] = {
+	{ .compatible = "bananapi,lhr050h41" },
+	{ }
+};
+MODULE_DEVICE_TABLE(of, ili9881c_of_match);
+
+static struct mipi_dsi_driver ili9881c_dsi_driver = {
+	.probe		= ili9881c_dsi_probe,
+	.remove		= ili9881c_dsi_remove,
+	.driver = {
+		.name		= "ili9881c-dsi",
+		.of_match_table	= ili9881c_of_match,
+	},
+};
+module_mipi_dsi_driver(ili9881c_dsi_driver);
+
+MODULE_AUTHOR("Maxime Ripard <maxime.ripard@free-electrons.com>");
+MODULE_DESCRIPTION("Ilitek ILI9881C Controller Driver");
+MODULE_LICENSE("GPL v2");
-- 
git-series 0.9.1