root/drivers/gpu/drm/panel/panel-khadas-ts050.c
// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (C) 2020 BayLibre, SAS
 * Author: Neil Armstrong <narmstrong@baylibre.com>
 */

#include <linux/delay.h>
#include <linux/gpio/consumer.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/regulator/consumer.h>

#include <video/mipi_display.h>

#include <drm/drm_crtc.h>
#include <drm/drm_device.h>
#include <drm/drm_mipi_dsi.h>
#include <drm/drm_modes.h>
#include <drm/drm_panel.h>

struct khadas_ts050_panel {
        struct drm_panel base;
        struct mipi_dsi_device *link;

        struct regulator *supply;
        struct gpio_desc *reset_gpio;
        struct gpio_desc *enable_gpio;
        struct khadas_ts050_panel_data *panel_data;
};

struct khadas_ts050_panel_cmd {
        u8 cmd;
        u8 data[55];
        u8 size;
};

struct khadas_ts050_panel_data {
        struct khadas_ts050_panel_cmd *init_code;
        int len;
};

static const struct khadas_ts050_panel_cmd ts050v2_init_code[] = {
        {0xB9, {0xFF, 0x83, 0x99}, 0x03},
        {0xBA, {0x63, 0x23, 0x68, 0xCF}, 0x04},
        {0xD2, {0x55}, 0x01},
        {0xB1, {0x02, 0x04, 0x70, 0x90, 0x01, 0x32, 0x33,
                        0x11, 0x11, 0x4D, 0x57, 0x56, 0x73, 0x02, 0x02}, 0x0f},
        {0xB2, {0x00, 0x80, 0x80, 0xAE, 0x0A, 0x0E, 0x75, 0x11, 0x00, 0x00, 0x00}, 0x0b},
        {0xB4, {0x00, 0xFF, 0x04, 0xA4, 0x02, 0xA0, 0x00, 0x00, 0x10, 0x00, 0x00, 0x02,
                        0x00, 0x24,     0x02, 0x04, 0x0A, 0x21, 0x03, 0x00, 0x00, 0x08, 0xA6, 0x88,
                        0x04, 0xA4, 0x02, 0xA0, 0x00, 0x00,     0x10, 0x00, 0x00, 0x02, 0x00, 0x24,
                        0x02, 0x04, 0x0A, 0x00, 0x00, 0x08,     0xA6, 0x00, 0x08, 0x11}, 0x2e},
        {0xD3, {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18,
                        0x18, 0x32, 0x10, 0x09, 0x00, 0x09, 0x32,
                        0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
                        0x00, 0x00, 0x11, 0x00, 0x02, 0x02, 0x03, 0x00, 0x00, 0x00, 0x0A,
                        0x40}, 0x21},
        {0xD5, {0x18, 0x18, 0x18, 0x18, 0x21, 0x20, 0x18, 0x18, 0x19, 0x19, 0x19,
                        0x19, 0x18, 0x18, 0x18, 0x18, 0x03, 0x02, 0x01, 0x00, 0x2F, 0x2F,
                        0x30, 0x30, 0x31, 0x31, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18}, 0x20},
        {0xD6, {0x18, 0x18, 0x18, 0x18, 0x20, 0x21, 0x19, 0x19, 0x18, 0x18, 0x19,
                        0x19, 0x18, 0x18, 0x18, 0x18, 0x00, 0x01, 0x02, 0x03, 0x2F, 0x2F,
                        0x30, 0x30, 0x31, 0x31, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18}, 0x20},
        {0xD8, {0x0A, 0xBE, 0xFA, 0xA0, 0x0A, 0xBE, 0xFA, 0xA0}, 0x08},
        {0xBD, {0x01}, 0x01},
        {0xD8, {0x0F, 0xFF, 0xFF, 0xE0, 0x0F, 0xFF, 0xFF, 0xE0}, 0x08},
        {0xBD, {0x02}, 0x01},
        {0xD8, {0x0F, 0xFF, 0xFF, 0xE0, 0x0F, 0xFF, 0xFF, 0xE0}, 0x08},
        {0xBD, {0x00}, 0x01},
        {0xE0, {0x01, 0x35, 0x41, 0x3B, 0x79, 0x81, 0x8C, 0x85, 0x8E,
                        0x95, 0x9B, 0xA0, 0xA4, 0xAB, 0xB1, 0xB3, 0xB7, 0xC5, 0xBD, 0xC5,
                        0xB6, 0xC2, 0xC2, 0x62, 0x5D, 0x66, 0x73, 0x01, 0x35, 0x41, 0x3B,
                        0x79, 0x81, 0x8C, 0x85, 0x8E, 0x95, 0x9B, 0xA0, 0xA4, 0xAB, 0xB1,
                        0xB3, 0xB7, 0xB5, 0xBD, 0xC5, 0xB6, 0xC2, 0xC2, 0x62, 0x5D, 0x66,
                        0x73}, 0x36},
        {0xB6, {0x97, 0x97}, 0x02},
        {0xCC, {0xC8}, 0x02},
        {0xBF, {0x40, 0x41, 0x50, 0x19}, 0x04},
        {0xC6, {0xFF, 0xF9}, 0x02},
        {0xC0, {0x25, 0x5A}, 0x02},
};

/* Only the CMD1 User Command set is documented */
static const struct khadas_ts050_panel_cmd ts050_init_code[] = {
        /* Select Unknown CMD Page (Undocumented) */
        {0xff, {0xee}, 0x01},
        /* Reload CMD1: Don't reload default value to register */
        {0xfb, {0x01}, 0x01},
        {0x1f, {0x45}, 0x01},
        {0x24, {0x4f}, 0x01},
        {0x38, {0xc8}, 0x01},
        {0x39, {0x27}, 0x01},
        {0x1e, {0x77}, 0x01},
        {0x1d, {0x0f}, 0x01},
        {0x7e, {0x71}, 0x01},
        {0x7c, {0x03}, 0x01},
        {0xff, {0x00}, 0x01},
        {0xfb, {0x01}, 0x01},
        {0x35, {0x01}, 0x01},
        /* Select CMD2 Page0 (Undocumented) */
        {0xff, {0x01}, 0x01},
        /* Reload CMD1: Don't reload default value to register */
        {0xfb, {0x01}, 0x01},
        {0x00, {0x01}, 0x01},
        {0x01, {0x55}, 0x01},
        {0x02, {0x40}, 0x01},
        {0x05, {0x40}, 0x01},
        {0x06, {0x4a}, 0x01},
        {0x07, {0x24}, 0x01},
        {0x08, {0x0c}, 0x01},
        {0x0b, {0x7d}, 0x01},
        {0x0c, {0x7d}, 0x01},
        {0x0e, {0xb0}, 0x01},
        {0x0f, {0xae}, 0x01},
        {0x11, {0x10}, 0x01},
        {0x12, {0x10}, 0x01},
        {0x13, {0x03}, 0x01},
        {0x14, {0x4a}, 0x01},
        {0x15, {0x12}, 0x01},
        {0x16, {0x12}, 0x01},
        {0x18, {0x00}, 0x01},
        {0x19, {0x77}, 0x01},
        {0x1a, {0x55}, 0x01},
        {0x1b, {0x13}, 0x01},
        {0x1c, {0x00}, 0x01},
        {0x1d, {0x00}, 0x01},
        {0x1e, {0x13}, 0x01},
        {0x1f, {0x00}, 0x01},
        {0x23, {0x00}, 0x01},
        {0x24, {0x00}, 0x01},
        {0x25, {0x00}, 0x01},
        {0x26, {0x00}, 0x01},
        {0x27, {0x00}, 0x01},
        {0x28, {0x00}, 0x01},
        {0x35, {0x00}, 0x01},
        {0x66, {0x00}, 0x01},
        {0x58, {0x82}, 0x01},
        {0x59, {0x02}, 0x01},
        {0x5a, {0x02}, 0x01},
        {0x5b, {0x02}, 0x01},
        {0x5c, {0x82}, 0x01},
        {0x5d, {0x82}, 0x01},
        {0x5e, {0x02}, 0x01},
        {0x5f, {0x02}, 0x01},
        {0x72, {0x31}, 0x01},
        /* Select CMD2 Page4 (Undocumented) */
        {0xff, {0x05}, 0x01},
        /* Reload CMD1: Don't reload default value to register */
        {0xfb, {0x01}, 0x01},
        {0x00, {0x01}, 0x01},
        {0x01, {0x0b}, 0x01},
        {0x02, {0x0c}, 0x01},
        {0x03, {0x09}, 0x01},
        {0x04, {0x0a}, 0x01},
        {0x05, {0x00}, 0x01},
        {0x06, {0x0f}, 0x01},
        {0x07, {0x10}, 0x01},
        {0x08, {0x00}, 0x01},
        {0x09, {0x00}, 0x01},
        {0x0a, {0x00}, 0x01},
        {0x0b, {0x00}, 0x01},
        {0x0c, {0x00}, 0x01},
        {0x0d, {0x13}, 0x01},
        {0x0e, {0x15}, 0x01},
        {0x0f, {0x17}, 0x01},
        {0x10, {0x01}, 0x01},
        {0x11, {0x0b}, 0x01},
        {0x12, {0x0c}, 0x01},
        {0x13, {0x09}, 0x01},
        {0x14, {0x0a}, 0x01},
        {0x15, {0x00}, 0x01},
        {0x16, {0x0f}, 0x01},
        {0x17, {0x10}, 0x01},
        {0x18, {0x00}, 0x01},
        {0x19, {0x00}, 0x01},
        {0x1a, {0x00}, 0x01},
        {0x1b, {0x00}, 0x01},
        {0x1c, {0x00}, 0x01},
        {0x1d, {0x13}, 0x01},
        {0x1e, {0x15}, 0x01},
        {0x1f, {0x17}, 0x01},
        {0x20, {0x00}, 0x01},
        {0x21, {0x03}, 0x01},
        {0x22, {0x01}, 0x01},
        {0x23, {0x40}, 0x01},
        {0x24, {0x40}, 0x01},
        {0x25, {0xed}, 0x01},
        {0x29, {0x58}, 0x01},
        {0x2a, {0x12}, 0x01},
        {0x2b, {0x01}, 0x01},
        {0x4b, {0x06}, 0x01},
        {0x4c, {0x11}, 0x01},
        {0x4d, {0x20}, 0x01},
        {0x4e, {0x02}, 0x01},
        {0x4f, {0x02}, 0x01},
        {0x50, {0x20}, 0x01},
        {0x51, {0x61}, 0x01},
        {0x52, {0x01}, 0x01},
        {0x53, {0x63}, 0x01},
        {0x54, {0x77}, 0x01},
        {0x55, {0xed}, 0x01},
        {0x5b, {0x00}, 0x01},
        {0x5c, {0x00}, 0x01},
        {0x5d, {0x00}, 0x01},
        {0x5e, {0x00}, 0x01},
        {0x5f, {0x15}, 0x01},
        {0x60, {0x75}, 0x01},
        {0x61, {0x00}, 0x01},
        {0x62, {0x00}, 0x01},
        {0x63, {0x00}, 0x01},
        {0x64, {0x00}, 0x01},
        {0x65, {0x00}, 0x01},
        {0x66, {0x00}, 0x01},
        {0x67, {0x00}, 0x01},
        {0x68, {0x04}, 0x01},
        {0x69, {0x00}, 0x01},
        {0x6a, {0x00}, 0x01},
        {0x6c, {0x40}, 0x01},
        {0x75, {0x01}, 0x01},
        {0x76, {0x01}, 0x01},
        {0x7a, {0x80}, 0x01},
        {0x7b, {0xa3}, 0x01},
        {0x7c, {0xd8}, 0x01},
        {0x7d, {0x60}, 0x01},
        {0x7f, {0x15}, 0x01},
        {0x80, {0x81}, 0x01},
        {0x83, {0x05}, 0x01},
        {0x93, {0x08}, 0x01},
        {0x94, {0x10}, 0x01},
        {0x8a, {0x00}, 0x01},
        {0x9b, {0x0f}, 0x01},
        {0xea, {0xff}, 0x01},
        {0xec, {0x00}, 0x01},
        /* Select CMD2 Page0 (Undocumented) */
        {0xff, {0x01}, 0x01},
        /* Reload CMD1: Don't reload default value to register */
        {0xfb, {0x01}, 0x01},
        {0x75, {0x00}, 0x01},
        {0x76, {0xdf}, 0x01},
        {0x77, {0x00}, 0x01},
        {0x78, {0xe4}, 0x01},
        {0x79, {0x00}, 0x01},
        {0x7a, {0xed}, 0x01},
        {0x7b, {0x00}, 0x01},
        {0x7c, {0xf6}, 0x01},
        {0x7d, {0x00}, 0x01},
        {0x7e, {0xff}, 0x01},
        {0x7f, {0x01}, 0x01},
        {0x80, {0x07}, 0x01},
        {0x81, {0x01}, 0x01},
        {0x82, {0x10}, 0x01},
        {0x83, {0x01}, 0x01},
        {0x84, {0x18}, 0x01},
        {0x85, {0x01}, 0x01},
        {0x86, {0x20}, 0x01},
        {0x87, {0x01}, 0x01},
        {0x88, {0x3d}, 0x01},
        {0x89, {0x01}, 0x01},
        {0x8a, {0x56}, 0x01},
        {0x8b, {0x01}, 0x01},
        {0x8c, {0x84}, 0x01},
        {0x8d, {0x01}, 0x01},
        {0x8e, {0xab}, 0x01},
        {0x8f, {0x01}, 0x01},
        {0x90, {0xec}, 0x01},
        {0x91, {0x02}, 0x01},
        {0x92, {0x22}, 0x01},
        {0x93, {0x02}, 0x01},
        {0x94, {0x23}, 0x01},
        {0x95, {0x02}, 0x01},
        {0x96, {0x55}, 0x01},
        {0x97, {0x02}, 0x01},
        {0x98, {0x8b}, 0x01},
        {0x99, {0x02}, 0x01},
        {0x9a, {0xaf}, 0x01},
        {0x9b, {0x02}, 0x01},
        {0x9c, {0xdf}, 0x01},
        {0x9d, {0x03}, 0x01},
        {0x9e, {0x01}, 0x01},
        {0x9f, {0x03}, 0x01},
        {0xa0, {0x2c}, 0x01},
        {0xa2, {0x03}, 0x01},
        {0xa3, {0x39}, 0x01},
        {0xa4, {0x03}, 0x01},
        {0xa5, {0x47}, 0x01},
        {0xa6, {0x03}, 0x01},
        {0xa7, {0x56}, 0x01},
        {0xa9, {0x03}, 0x01},
        {0xaa, {0x66}, 0x01},
        {0xab, {0x03}, 0x01},
        {0xac, {0x76}, 0x01},
        {0xad, {0x03}, 0x01},
        {0xae, {0x85}, 0x01},
        {0xaf, {0x03}, 0x01},
        {0xb0, {0x90}, 0x01},
        {0xb1, {0x03}, 0x01},
        {0xb2, {0xcb}, 0x01},
        {0xb3, {0x00}, 0x01},
        {0xb4, {0xdf}, 0x01},
        {0xb5, {0x00}, 0x01},
        {0xb6, {0xe4}, 0x01},
        {0xb7, {0x00}, 0x01},
        {0xb8, {0xed}, 0x01},
        {0xb9, {0x00}, 0x01},
        {0xba, {0xf6}, 0x01},
        {0xbb, {0x00}, 0x01},
        {0xbc, {0xff}, 0x01},
        {0xbd, {0x01}, 0x01},
        {0xbe, {0x07}, 0x01},
        {0xbf, {0x01}, 0x01},
        {0xc0, {0x10}, 0x01},
        {0xc1, {0x01}, 0x01},
        {0xc2, {0x18}, 0x01},
        {0xc3, {0x01}, 0x01},
        {0xc4, {0x20}, 0x01},
        {0xc5, {0x01}, 0x01},
        {0xc6, {0x3d}, 0x01},
        {0xc7, {0x01}, 0x01},
        {0xc8, {0x56}, 0x01},
        {0xc9, {0x01}, 0x01},
        {0xca, {0x84}, 0x01},
        {0xcb, {0x01}, 0x01},
        {0xcc, {0xab}, 0x01},
        {0xcd, {0x01}, 0x01},
        {0xce, {0xec}, 0x01},
        {0xcf, {0x02}, 0x01},
        {0xd0, {0x22}, 0x01},
        {0xd1, {0x02}, 0x01},
        {0xd2, {0x23}, 0x01},
        {0xd3, {0x02}, 0x01},
        {0xd4, {0x55}, 0x01},
        {0xd5, {0x02}, 0x01},
        {0xd6, {0x8b}, 0x01},
        {0xd7, {0x02}, 0x01},
        {0xd8, {0xaf}, 0x01},
        {0xd9, {0x02}, 0x01},
        {0xda, {0xdf}, 0x01},
        {0xdb, {0x03}, 0x01},
        {0xdc, {0x01}, 0x01},
        {0xdd, {0x03}, 0x01},
        {0xde, {0x2c}, 0x01},
        {0xdf, {0x03}, 0x01},
        {0xe0, {0x39}, 0x01},
        {0xe1, {0x03}, 0x01},
        {0xe2, {0x47}, 0x01},
        {0xe3, {0x03}, 0x01},
        {0xe4, {0x56}, 0x01},
        {0xe5, {0x03}, 0x01},
        {0xe6, {0x66}, 0x01},
        {0xe7, {0x03}, 0x01},
        {0xe8, {0x76}, 0x01},
        {0xe9, {0x03}, 0x01},
        {0xea, {0x85}, 0x01},
        {0xeb, {0x03}, 0x01},
        {0xec, {0x90}, 0x01},
        {0xed, {0x03}, 0x01},
        {0xee, {0xcb}, 0x01},
        {0xef, {0x00}, 0x01},
        {0xf0, {0xbb}, 0x01},
        {0xf1, {0x00}, 0x01},
        {0xf2, {0xc0}, 0x01},
        {0xf3, {0x00}, 0x01},
        {0xf4, {0xcc}, 0x01},
        {0xf5, {0x00}, 0x01},
        {0xf6, {0xd6}, 0x01},
        {0xf7, {0x00}, 0x01},
        {0xf8, {0xe1}, 0x01},
        {0xf9, {0x00}, 0x01},
        {0xfa, {0xea}, 0x01},
        /* Select CMD2 Page2 (Undocumented) */
        {0xff, {0x02}, 0x01},
        /* Reload CMD1: Don't reload default value to register */
        {0xfb, {0x01}, 0x01},
        {0x00, {0x00}, 0x01},
        {0x01, {0xf4}, 0x01},
        {0x02, {0x00}, 0x01},
        {0x03, {0xef}, 0x01},
        {0x04, {0x01}, 0x01},
        {0x05, {0x07}, 0x01},
        {0x06, {0x01}, 0x01},
        {0x07, {0x28}, 0x01},
        {0x08, {0x01}, 0x01},
        {0x09, {0x44}, 0x01},
        {0x0a, {0x01}, 0x01},
        {0x0b, {0x76}, 0x01},
        {0x0c, {0x01}, 0x01},
        {0x0d, {0xa0}, 0x01},
        {0x0e, {0x01}, 0x01},
        {0x0f, {0xe7}, 0x01},
        {0x10, {0x02}, 0x01},
        {0x11, {0x1f}, 0x01},
        {0x12, {0x02}, 0x01},
        {0x13, {0x22}, 0x01},
        {0x14, {0x02}, 0x01},
        {0x15, {0x54}, 0x01},
        {0x16, {0x02}, 0x01},
        {0x17, {0x8b}, 0x01},
        {0x18, {0x02}, 0x01},
        {0x19, {0xaf}, 0x01},
        {0x1a, {0x02}, 0x01},
        {0x1b, {0xe0}, 0x01},
        {0x1c, {0x03}, 0x01},
        {0x1d, {0x01}, 0x01},
        {0x1e, {0x03}, 0x01},
        {0x1f, {0x2d}, 0x01},
        {0x20, {0x03}, 0x01},
        {0x21, {0x39}, 0x01},
        {0x22, {0x03}, 0x01},
        {0x23, {0x47}, 0x01},
        {0x24, {0x03}, 0x01},
        {0x25, {0x57}, 0x01},
        {0x26, {0x03}, 0x01},
        {0x27, {0x65}, 0x01},
        {0x28, {0x03}, 0x01},
        {0x29, {0x77}, 0x01},
        {0x2a, {0x03}, 0x01},
        {0x2b, {0x85}, 0x01},
        {0x2d, {0x03}, 0x01},
        {0x2f, {0x8f}, 0x01},
        {0x30, {0x03}, 0x01},
        {0x31, {0xcb}, 0x01},
        {0x32, {0x00}, 0x01},
        {0x33, {0xbb}, 0x01},
        {0x34, {0x00}, 0x01},
        {0x35, {0xc0}, 0x01},
        {0x36, {0x00}, 0x01},
        {0x37, {0xcc}, 0x01},
        {0x38, {0x00}, 0x01},
        {0x39, {0xd6}, 0x01},
        {0x3a, {0x00}, 0x01},
        {0x3b, {0xe1}, 0x01},
        {0x3d, {0x00}, 0x01},
        {0x3f, {0xea}, 0x01},
        {0x40, {0x00}, 0x01},
        {0x41, {0xf4}, 0x01},
        {0x42, {0x00}, 0x01},
        {0x43, {0xfe}, 0x01},
        {0x44, {0x01}, 0x01},
        {0x45, {0x07}, 0x01},
        {0x46, {0x01}, 0x01},
        {0x47, {0x28}, 0x01},
        {0x48, {0x01}, 0x01},
        {0x49, {0x44}, 0x01},
        {0x4a, {0x01}, 0x01},
        {0x4b, {0x76}, 0x01},
        {0x4c, {0x01}, 0x01},
        {0x4d, {0xa0}, 0x01},
        {0x4e, {0x01}, 0x01},
        {0x4f, {0xe7}, 0x01},
        {0x50, {0x02}, 0x01},
        {0x51, {0x1f}, 0x01},
        {0x52, {0x02}, 0x01},
        {0x53, {0x22}, 0x01},
        {0x54, {0x02}, 0x01},
        {0x55, {0x54}, 0x01},
        {0x56, {0x02}, 0x01},
        {0x58, {0x8b}, 0x01},
        {0x59, {0x02}, 0x01},
        {0x5a, {0xaf}, 0x01},
        {0x5b, {0x02}, 0x01},
        {0x5c, {0xe0}, 0x01},
        {0x5d, {0x03}, 0x01},
        {0x5e, {0x01}, 0x01},
        {0x5f, {0x03}, 0x01},
        {0x60, {0x2d}, 0x01},
        {0x61, {0x03}, 0x01},
        {0x62, {0x39}, 0x01},
        {0x63, {0x03}, 0x01},
        {0x64, {0x47}, 0x01},
        {0x65, {0x03}, 0x01},
        {0x66, {0x57}, 0x01},
        {0x67, {0x03}, 0x01},
        {0x68, {0x65}, 0x01},
        {0x69, {0x03}, 0x01},
        {0x6a, {0x77}, 0x01},
        {0x6b, {0x03}, 0x01},
        {0x6c, {0x85}, 0x01},
        {0x6d, {0x03}, 0x01},
        {0x6e, {0x8f}, 0x01},
        {0x6f, {0x03}, 0x01},
        {0x70, {0xcb}, 0x01},
        {0x71, {0x00}, 0x01},
        {0x72, {0x00}, 0x01},
        {0x73, {0x00}, 0x01},
        {0x74, {0x21}, 0x01},
        {0x75, {0x00}, 0x01},
        {0x76, {0x4c}, 0x01},
        {0x77, {0x00}, 0x01},
        {0x78, {0x6b}, 0x01},
        {0x79, {0x00}, 0x01},
        {0x7a, {0x85}, 0x01},
        {0x7b, {0x00}, 0x01},
        {0x7c, {0x9a}, 0x01},
        {0x7d, {0x00}, 0x01},
        {0x7e, {0xad}, 0x01},
        {0x7f, {0x00}, 0x01},
        {0x80, {0xbe}, 0x01},
        {0x81, {0x00}, 0x01},
        {0x82, {0xcd}, 0x01},
        {0x83, {0x01}, 0x01},
        {0x84, {0x01}, 0x01},
        {0x85, {0x01}, 0x01},
        {0x86, {0x29}, 0x01},
        {0x87, {0x01}, 0x01},
        {0x88, {0x68}, 0x01},
        {0x89, {0x01}, 0x01},
        {0x8a, {0x98}, 0x01},
        {0x8b, {0x01}, 0x01},
        {0x8c, {0xe5}, 0x01},
        {0x8d, {0x02}, 0x01},
        {0x8e, {0x1e}, 0x01},
        {0x8f, {0x02}, 0x01},
        {0x90, {0x30}, 0x01},
        {0x91, {0x02}, 0x01},
        {0x92, {0x52}, 0x01},
        {0x93, {0x02}, 0x01},
        {0x94, {0x88}, 0x01},
        {0x95, {0x02}, 0x01},
        {0x96, {0xaa}, 0x01},
        {0x97, {0x02}, 0x01},
        {0x98, {0xd7}, 0x01},
        {0x99, {0x02}, 0x01},
        {0x9a, {0xf7}, 0x01},
        {0x9b, {0x03}, 0x01},
        {0x9c, {0x21}, 0x01},
        {0x9d, {0x03}, 0x01},
        {0x9e, {0x2e}, 0x01},
        {0x9f, {0x03}, 0x01},
        {0xa0, {0x3d}, 0x01},
        {0xa2, {0x03}, 0x01},
        {0xa3, {0x4c}, 0x01},
        {0xa4, {0x03}, 0x01},
        {0xa5, {0x5e}, 0x01},
        {0xa6, {0x03}, 0x01},
        {0xa7, {0x71}, 0x01},
        {0xa9, {0x03}, 0x01},
        {0xaa, {0x86}, 0x01},
        {0xab, {0x03}, 0x01},
        {0xac, {0x94}, 0x01},
        {0xad, {0x03}, 0x01},
        {0xae, {0xfa}, 0x01},
        {0xaf, {0x00}, 0x01},
        {0xb0, {0x00}, 0x01},
        {0xb1, {0x00}, 0x01},
        {0xb2, {0x21}, 0x01},
        {0xb3, {0x00}, 0x01},
        {0xb4, {0x4c}, 0x01},
        {0xb5, {0x00}, 0x01},
        {0xb6, {0x6b}, 0x01},
        {0xb7, {0x00}, 0x01},
        {0xb8, {0x85}, 0x01},
        {0xb9, {0x00}, 0x01},
        {0xba, {0x9a}, 0x01},
        {0xbb, {0x00}, 0x01},
        {0xbc, {0xad}, 0x01},
        {0xbd, {0x00}, 0x01},
        {0xbe, {0xbe}, 0x01},
        {0xbf, {0x00}, 0x01},
        {0xc0, {0xcd}, 0x01},
        {0xc1, {0x01}, 0x01},
        {0xc2, {0x01}, 0x01},
        {0xc3, {0x01}, 0x01},
        {0xc4, {0x29}, 0x01},
        {0xc5, {0x01}, 0x01},
        {0xc6, {0x68}, 0x01},
        {0xc7, {0x01}, 0x01},
        {0xc8, {0x98}, 0x01},
        {0xc9, {0x01}, 0x01},
        {0xca, {0xe5}, 0x01},
        {0xcb, {0x02}, 0x01},
        {0xcc, {0x1e}, 0x01},
        {0xcd, {0x02}, 0x01},
        {0xce, {0x20}, 0x01},
        {0xcf, {0x02}, 0x01},
        {0xd0, {0x52}, 0x01},
        {0xd1, {0x02}, 0x01},
        {0xd2, {0x88}, 0x01},
        {0xd3, {0x02}, 0x01},
        {0xd4, {0xaa}, 0x01},
        {0xd5, {0x02}, 0x01},
        {0xd6, {0xd7}, 0x01},
        {0xd7, {0x02}, 0x01},
        {0xd8, {0xf7}, 0x01},
        {0xd9, {0x03}, 0x01},
        {0xda, {0x21}, 0x01},
        {0xdb, {0x03}, 0x01},
        {0xdc, {0x2e}, 0x01},
        {0xdd, {0x03}, 0x01},
        {0xde, {0x3d}, 0x01},
        {0xdf, {0x03}, 0x01},
        {0xe0, {0x4c}, 0x01},
        {0xe1, {0x03}, 0x01},
        {0xe2, {0x5e}, 0x01},
        {0xe3, {0x03}, 0x01},
        {0xe4, {0x71}, 0x01},
        {0xe5, {0x03}, 0x01},
        {0xe6, {0x86}, 0x01},
        {0xe7, {0x03}, 0x01},
        {0xe8, {0x94}, 0x01},
        {0xe9, {0x03}, 0x01},
        {0xea, {0xfa}, 0x01},
        /* Select CMD2 Page0 (Undocumented) */
        {0xff, {0x01}, 0x01},
        /* Reload CMD1: Don't reload default value to register */
        {0xfb, {0x01}, 0x01},
        /* Select CMD2 Page1 (Undocumented) */
        {0xff, {0x02}, 0x01},
        /* Reload CMD1: Don't reload default value to register */
        {0xfb, {0x01}, 0x01},
        /* Select CMD2 Page3 (Undocumented) */
        {0xff, {0x04}, 0x01},
        /* Reload CMD1: Don't reload default value to register */
        {0xfb, {0x01}, 0x01},
        /* Select CMD1 */
        {0xff, {0x00}, 0x01},
        {0xd3, {0x22}, 0x01}, /* RGBMIPICTRL: VSYNC back porch = 34 */
        {0xd4, {0x04}, 0x01}, /* RGBMIPICTRL: VSYNC front porch = 4 */
};

static struct khadas_ts050_panel_data ts050_panel_data = {
        .init_code = (struct khadas_ts050_panel_cmd *)ts050_init_code,
        .len = ARRAY_SIZE(ts050_init_code)
};

static struct khadas_ts050_panel_data ts050v2_panel_data = {
        .init_code = (struct khadas_ts050_panel_cmd *)ts050v2_init_code,
        .len = ARRAY_SIZE(ts050v2_init_code)
};

static inline
struct khadas_ts050_panel *to_khadas_ts050_panel(struct drm_panel *panel)
{
        return container_of(panel, struct khadas_ts050_panel, base);
}

static int khadas_ts050_panel_prepare(struct drm_panel *panel)
{
        struct khadas_ts050_panel *khadas_ts050 = to_khadas_ts050_panel(panel);
        unsigned int i;
        int err;

        gpiod_set_value_cansleep(khadas_ts050->enable_gpio, 0);

        err = regulator_enable(khadas_ts050->supply);
        if (err < 0)
                return err;

        gpiod_set_value_cansleep(khadas_ts050->enable_gpio, 1);

        msleep(60);

        gpiod_set_value_cansleep(khadas_ts050->reset_gpio, 1);

        usleep_range(10000, 11000);

        gpiod_set_value_cansleep(khadas_ts050->reset_gpio, 0);

        /* Select CMD2 page 4 (Undocumented) */
        mipi_dsi_dcs_write(khadas_ts050->link, 0xff, (u8[]){ 0x05 }, 1);

        /* Reload CMD1: Don't reload default value to register */
        mipi_dsi_dcs_write(khadas_ts050->link, 0xfb, (u8[]){ 0x01 }, 1);

        mipi_dsi_dcs_write(khadas_ts050->link, 0xc5, (u8[]){ 0x01 }, 1);

        msleep(100);

        for (i = 0; i < khadas_ts050->panel_data->len; i++) {
                err = mipi_dsi_dcs_write(khadas_ts050->link,
                                                khadas_ts050->panel_data->init_code[i].cmd,
                                                &khadas_ts050->panel_data->init_code[i].data,
                                                khadas_ts050->panel_data->init_code[i].size);
                if (err < 0) {
                        dev_err(panel->dev, "failed write cmds: %d\n", err);
                        goto poweroff;
                }
        }

        err = mipi_dsi_dcs_exit_sleep_mode(khadas_ts050->link);
        if (err < 0) {
                dev_err(panel->dev, "failed to exit sleep mode: %d\n", err);
                goto poweroff;
        }

        msleep(120);

        /* Select CMD1 */
        mipi_dsi_dcs_write(khadas_ts050->link, 0xff, (u8[]){ 0x00 }, 1);

        err = mipi_dsi_dcs_set_tear_on(khadas_ts050->link,
                                       MIPI_DSI_DCS_TEAR_MODE_VBLANK);
        if (err < 0) {
                dev_err(panel->dev, "failed to set tear on: %d\n", err);
                goto poweroff;
        }

        err = mipi_dsi_dcs_set_display_on(khadas_ts050->link);
        if (err < 0) {
                dev_err(panel->dev, "failed to set display on: %d\n", err);
                goto poweroff;
        }

        usleep_range(10000, 11000);

        return 0;

poweroff:
        gpiod_set_value_cansleep(khadas_ts050->enable_gpio, 0);
        gpiod_set_value_cansleep(khadas_ts050->reset_gpio, 1);

        regulator_disable(khadas_ts050->supply);

        return err;
}

static int khadas_ts050_panel_unprepare(struct drm_panel *panel)
{
        struct khadas_ts050_panel *khadas_ts050 = to_khadas_ts050_panel(panel);
        int err;

        err = mipi_dsi_dcs_enter_sleep_mode(khadas_ts050->link);
        if (err < 0)
                dev_err(panel->dev, "failed to enter sleep mode: %d\n", err);

        msleep(150);

        gpiod_set_value_cansleep(khadas_ts050->enable_gpio, 0);
        gpiod_set_value_cansleep(khadas_ts050->reset_gpio, 1);

        err = regulator_disable(khadas_ts050->supply);
        if (err < 0)
                return err;

        return 0;
}

static int khadas_ts050_panel_disable(struct drm_panel *panel)
{
        struct khadas_ts050_panel *khadas_ts050 = to_khadas_ts050_panel(panel);
        int err;

        err = mipi_dsi_dcs_set_display_off(khadas_ts050->link);
        if (err < 0)
                dev_err(panel->dev, "failed to set display off: %d\n", err);

        usleep_range(10000, 11000);

        return 0;
}

static const struct drm_display_mode default_mode = {
        .clock = 160000,
        .hdisplay = 1080,
        .hsync_start = 1080 + 117,
        .hsync_end = 1080 + 117 + 5,
        .htotal = 1080 + 117 + 5 + 160,
        .vdisplay = 1920,
        .vsync_start = 1920 + 4,
        .vsync_end = 1920 + 4 + 3,
        .vtotal = 1920 + 4 + 3 + 31,
        .flags = DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC,
};

static int khadas_ts050_panel_get_modes(struct drm_panel *panel,
                                        struct drm_connector *connector)
{
        struct drm_display_mode *mode;

        mode = drm_mode_duplicate(connector->dev, &default_mode);
        if (!mode) {
                dev_err(panel->dev, "failed to add mode %ux%u@%u\n",
                        default_mode.hdisplay, default_mode.vdisplay,
                        drm_mode_vrefresh(&default_mode));
                return -ENOMEM;
        }

        drm_mode_set_name(mode);

        drm_mode_probed_add(connector, mode);

        connector->display_info.width_mm = 64;
        connector->display_info.height_mm = 118;
        connector->display_info.bpc = 8;

        return 1;
}

static const struct drm_panel_funcs khadas_ts050_panel_funcs = {
        .prepare = khadas_ts050_panel_prepare,
        .unprepare = khadas_ts050_panel_unprepare,
        .disable = khadas_ts050_panel_disable,
        .get_modes = khadas_ts050_panel_get_modes,
};

static const struct of_device_id khadas_ts050_of_match[] = {
        { .compatible = "khadas,ts050",    .data = &ts050_panel_data, },
        { .compatible = "khadas,ts050v2",  .data = &ts050v2_panel_data, },
        { /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, khadas_ts050_of_match);

static int khadas_ts050_panel_add(struct khadas_ts050_panel *khadas_ts050)
{
        struct device *dev = &khadas_ts050->link->dev;
        int err;

        khadas_ts050->supply = devm_regulator_get(dev, "power");
        if (IS_ERR(khadas_ts050->supply))
                return dev_err_probe(dev, PTR_ERR(khadas_ts050->supply),
                                     "failed to get power supply");

        khadas_ts050->reset_gpio = devm_gpiod_get(dev, "reset",
                                                  GPIOD_OUT_LOW);
        if (IS_ERR(khadas_ts050->reset_gpio))
                return dev_err_probe(dev, PTR_ERR(khadas_ts050->reset_gpio),
                                     "failed to get reset gpio");

        khadas_ts050->enable_gpio = devm_gpiod_get(dev, "enable",
                                                   GPIOD_OUT_HIGH);
        if (IS_ERR(khadas_ts050->enable_gpio))
                return dev_err_probe(dev, PTR_ERR(khadas_ts050->enable_gpio),
                                     "failed to get enable gpio");

        err = drm_panel_of_backlight(&khadas_ts050->base);
        if (err)
                return err;

        drm_panel_add(&khadas_ts050->base);

        return 0;
}

static int khadas_ts050_panel_probe(struct mipi_dsi_device *dsi)
{
        struct khadas_ts050_panel *khadas_ts050;
        int err;

        const void *data = of_device_get_match_data(&dsi->dev);

        if (!data) {
                dev_err(&dsi->dev, "No matching data\n");
                return -ENODEV;
        }

        dsi->lanes = 4;
        dsi->format = MIPI_DSI_FMT_RGB888;
        dsi->mode_flags = MIPI_DSI_MODE_VIDEO | MIPI_DSI_MODE_VIDEO_BURST |
                          MIPI_DSI_MODE_LPM | MIPI_DSI_MODE_NO_EOT_PACKET;

        khadas_ts050 = devm_drm_panel_alloc(&dsi->dev, __typeof(*khadas_ts050),
                                            base, &khadas_ts050_panel_funcs,
                                            DRM_MODE_CONNECTOR_DSI);

        if (IS_ERR(khadas_ts050))
                return PTR_ERR(khadas_ts050);

        khadas_ts050->panel_data = (struct khadas_ts050_panel_data *)data;
        mipi_dsi_set_drvdata(dsi, khadas_ts050);
        khadas_ts050->link = dsi;

        err = khadas_ts050_panel_add(khadas_ts050);
        if (err < 0)
                return err;

        err = mipi_dsi_attach(dsi);
        if (err)
                drm_panel_remove(&khadas_ts050->base);

        return err;
}

static void khadas_ts050_panel_remove(struct mipi_dsi_device *dsi)
{
        struct khadas_ts050_panel *khadas_ts050 = mipi_dsi_get_drvdata(dsi);
        int err;

        err = mipi_dsi_detach(dsi);
        if (err < 0)
                dev_err(&dsi->dev, "failed to detach from DSI host: %d\n", err);

        drm_panel_remove(&khadas_ts050->base);
}

static struct mipi_dsi_driver khadas_ts050_panel_driver = {
        .driver = {
                .name = "panel-khadas-ts050",
                .of_match_table = khadas_ts050_of_match,
        },
        .probe = khadas_ts050_panel_probe,
        .remove = khadas_ts050_panel_remove,
};
module_mipi_dsi_driver(khadas_ts050_panel_driver);

MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>");
MODULE_DESCRIPTION("Khadas TS050 panel driver");
MODULE_LICENSE("GPL v2");