833 lines
21 KiB
C
833 lines
21 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Raydium RM67191 MIPI-DSI panel driver
|
|
*
|
|
* Copyright 2019 NXP
|
|
*/
|
|
|
|
#include <linux/backlight.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/gpio/consumer.h>
|
|
#include <linux/media-bus-format.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_platform.h>
|
|
#include <linux/regulator/consumer.h>
|
|
|
|
#include <video/display_timing.h>
|
|
#include <video/mipi_display.h>
|
|
#include <video/of_display_timing.h>
|
|
#include <video/of_videomode.h>
|
|
#include <video/videomode.h>
|
|
|
|
#include <drm/drm_crtc.h>
|
|
#include <drm/drm_mipi_dsi.h>
|
|
#include <drm/drm_panel.h>
|
|
|
|
/* Panel specific color-format bits */
|
|
#define COL_FMT_16BPP 0x55
|
|
#define COL_FMT_18BPP 0x66
|
|
#define COL_FMT_24BPP 0x77
|
|
|
|
/* Write Manufacture Command Set Control */
|
|
#define WRMAUCCTR 0xFE
|
|
|
|
/* Manufacturer Command Set pages (CMD2) */
|
|
struct cmd_set_entry {
|
|
u8 cmd;
|
|
u8 param;
|
|
};
|
|
|
|
/*
|
|
* There is no description in the Reference Manual about these commands.
|
|
* We received them from vendor, so just use them as is.
|
|
*/
|
|
static const struct cmd_set_entry mcs_rm67191[] = {
|
|
{0xFE, 0x0B}, {0x28, 0x40}, {0x29, 0x4F}, {0xFE, 0x0E},
|
|
{0x4B, 0x00}, {0x4C, 0x0F}, {0x4D, 0x20}, {0x4E, 0x40},
|
|
{0x4F, 0x60}, {0x50, 0xA0}, {0x51, 0xC0}, {0x52, 0xE0},
|
|
{0x53, 0xFF}, {0xFE, 0x0D}, {0x18, 0x08}, {0x42, 0x00},
|
|
{0x08, 0x41}, {0x46, 0x02}, {0x72, 0x09}, {0xFE, 0x0A},
|
|
{0x24, 0x17}, {0x04, 0x07}, {0x1A, 0x0C}, {0x0F, 0x44},
|
|
{0xFE, 0x04}, {0x00, 0x0C}, {0x05, 0x08}, {0x06, 0x08},
|
|
{0x08, 0x08}, {0x09, 0x08}, {0x0A, 0xE6}, {0x0B, 0x8C},
|
|
{0x1A, 0x12}, {0x1E, 0xE0}, {0x29, 0x93}, {0x2A, 0x93},
|
|
{0x2F, 0x02}, {0x31, 0x02}, {0x33, 0x05}, {0x37, 0x2D},
|
|
{0x38, 0x2D}, {0x3A, 0x1E}, {0x3B, 0x1E}, {0x3D, 0x27},
|
|
{0x3F, 0x80}, {0x40, 0x40}, {0x41, 0xE0}, {0x4F, 0x2F},
|
|
{0x50, 0x1E}, {0xFE, 0x06}, {0x00, 0xCC}, {0x05, 0x05},
|
|
{0x07, 0xA2}, {0x08, 0xCC}, {0x0D, 0x03}, {0x0F, 0xA2},
|
|
{0x32, 0xCC}, {0x37, 0x05}, {0x39, 0x83}, {0x3A, 0xCC},
|
|
{0x41, 0x04}, {0x43, 0x83}, {0x44, 0xCC}, {0x49, 0x05},
|
|
{0x4B, 0xA2}, {0x4C, 0xCC}, {0x51, 0x03}, {0x53, 0xA2},
|
|
{0x75, 0xCC}, {0x7A, 0x03}, {0x7C, 0x83}, {0x7D, 0xCC},
|
|
{0x82, 0x02}, {0x84, 0x83}, {0x85, 0xEC}, {0x86, 0x0F},
|
|
{0x87, 0xFF}, {0x88, 0x00}, {0x8A, 0x02}, {0x8C, 0xA2},
|
|
{0x8D, 0xEA}, {0x8E, 0x01}, {0x8F, 0xE8}, {0xFE, 0x06},
|
|
{0x90, 0x0A}, {0x92, 0x06}, {0x93, 0xA0}, {0x94, 0xA8},
|
|
{0x95, 0xEC}, {0x96, 0x0F}, {0x97, 0xFF}, {0x98, 0x00},
|
|
{0x9A, 0x02}, {0x9C, 0xA2}, {0xAC, 0x04}, {0xFE, 0x06},
|
|
{0xB1, 0x12}, {0xB2, 0x17}, {0xB3, 0x17}, {0xB4, 0x17},
|
|
{0xB5, 0x17}, {0xB6, 0x11}, {0xB7, 0x08}, {0xB8, 0x09},
|
|
{0xB9, 0x06}, {0xBA, 0x07}, {0xBB, 0x17}, {0xBC, 0x17},
|
|
{0xBD, 0x17}, {0xBE, 0x17}, {0xBF, 0x17}, {0xC0, 0x17},
|
|
{0xC1, 0x17}, {0xC2, 0x17}, {0xC3, 0x17}, {0xC4, 0x0F},
|
|
{0xC5, 0x0E}, {0xC6, 0x00}, {0xC7, 0x01}, {0xC8, 0x10},
|
|
{0xFE, 0x06}, {0x95, 0xEC}, {0x8D, 0xEE}, {0x44, 0xEC},
|
|
{0x4C, 0xEC}, {0x32, 0xEC}, {0x3A, 0xEC}, {0x7D, 0xEC},
|
|
{0x75, 0xEC}, {0x00, 0xEC}, {0x08, 0xEC}, {0x85, 0xEC},
|
|
{0xA6, 0x21}, {0xA7, 0x05}, {0xA9, 0x06}, {0x82, 0x06},
|
|
{0x41, 0x06}, {0x7A, 0x07}, {0x37, 0x07}, {0x05, 0x06},
|
|
{0x49, 0x06}, {0x0D, 0x04}, {0x51, 0x04},
|
|
};
|
|
|
|
static const struct cmd_set_entry mcs_rm67199[] = {
|
|
{0xFE, 0xA0}, {0x2B, 0x18}, {0xFE, 0x70}, {0x7D, 0x05},
|
|
{0x5D, 0x0A}, {0x5A, 0x79}, {0x5C, 0x00}, {0x52, 0x00},
|
|
{0xFE, 0xD0}, {0x40, 0x02}, {0x13, 0x40}, {0xFE, 0x40},
|
|
{0x05, 0x08}, {0x06, 0x08}, {0x08, 0x08}, {0x09, 0x08},
|
|
{0x0A, 0xCA}, {0x0B, 0x88}, {0x20, 0x93}, {0x21, 0x93},
|
|
{0x24, 0x02}, {0x26, 0x02}, {0x28, 0x05}, {0x2A, 0x05},
|
|
{0x74, 0x2F}, {0x75, 0x1E}, {0xAD, 0x00}, {0xFE, 0x60},
|
|
{0x00, 0xCC}, {0x01, 0x00}, {0x02, 0x04}, {0x03, 0x00},
|
|
{0x04, 0x00}, {0x05, 0x07}, {0x06, 0x00}, {0x07, 0x88},
|
|
{0x08, 0x00}, {0x09, 0xCC}, {0x0A, 0x00}, {0x0B, 0x04},
|
|
{0x0C, 0x00}, {0x0D, 0x00}, {0x0E, 0x05}, {0x0F, 0x00},
|
|
{0x10, 0x88}, {0x11, 0x00}, {0x12, 0xCC}, {0x13, 0x0F},
|
|
{0x14, 0xFF}, {0x15, 0x04}, {0x16, 0x00}, {0x17, 0x06},
|
|
{0x18, 0x00}, {0x19, 0x96}, {0x1A, 0x00}, {0x24, 0xCC},
|
|
{0x25, 0x00}, {0x26, 0x02}, {0x27, 0x00}, {0x28, 0x00},
|
|
{0x29, 0x06}, {0x2A, 0x06}, {0x2B, 0x82}, {0x2D, 0x00},
|
|
{0x2F, 0xCC}, {0x30, 0x00}, {0x31, 0x02}, {0x32, 0x00},
|
|
{0x33, 0x00}, {0x34, 0x07}, {0x35, 0x06}, {0x36, 0x82},
|
|
{0x37, 0x00}, {0x38, 0xCC}, {0x39, 0x00}, {0x3A, 0x02},
|
|
{0x3B, 0x00}, {0x3D, 0x00}, {0x3F, 0x07}, {0x40, 0x00},
|
|
{0x41, 0x88}, {0x42, 0x00}, {0x43, 0xCC}, {0x44, 0x00},
|
|
{0x45, 0x02}, {0x46, 0x00}, {0x47, 0x00}, {0x48, 0x06},
|
|
{0x49, 0x02}, {0x4A, 0x8A}, {0x4B, 0x00}, {0x5F, 0xCA},
|
|
{0x60, 0x01}, {0x61, 0xE8}, {0x62, 0x09}, {0x63, 0x00},
|
|
{0x64, 0x07}, {0x65, 0x00}, {0x66, 0x30}, {0x67, 0x80},
|
|
{0x9B, 0x03}, {0xA9, 0x07}, {0xAA, 0x06}, {0xAB, 0x02},
|
|
{0xAC, 0x10}, {0xAD, 0x11}, {0xAE, 0x05}, {0xAF, 0x04},
|
|
{0xB0, 0x10}, {0xB1, 0x10}, {0xB2, 0x10}, {0xB3, 0x10},
|
|
{0xB4, 0x10}, {0xB5, 0x10}, {0xB6, 0x10}, {0xB7, 0x10},
|
|
{0xB8, 0x10}, {0xB9, 0x10}, {0xBA, 0x04}, {0xBB, 0x05},
|
|
{0xBC, 0x00}, {0xBD, 0x01}, {0xBE, 0x0A}, {0xBF, 0x10},
|
|
{0xC0, 0x11}, {0xFE, 0xA0}, {0x22, 0x00},
|
|
};
|
|
|
|
static const u32 rad_bus_formats[] = {
|
|
MEDIA_BUS_FMT_RGB888_1X24,
|
|
MEDIA_BUS_FMT_RGB666_1X18,
|
|
MEDIA_BUS_FMT_RGB565_1X16,
|
|
};
|
|
|
|
static const u32 rad_bus_flags = DRM_BUS_FLAG_DE_LOW |
|
|
DRM_BUS_FLAG_PIXDATA_SAMPLE_POSEDGE;
|
|
|
|
struct panel_desc {
|
|
/** @modes: Pointer to array of fixed modes appropriate for this panel. */
|
|
const struct drm_display_mode *modes;
|
|
|
|
/** @num_modes: Number of elements in modes array. */
|
|
unsigned int num_modes;
|
|
|
|
/** @size: Structure containing the physical size of this panel. */
|
|
struct {
|
|
/** @size.width: Width (in mm) of the active display area. */
|
|
unsigned int width;
|
|
|
|
/** @size.height: Height (in mm) of the active display area. */
|
|
unsigned int height;
|
|
} size;
|
|
};
|
|
|
|
struct rad_panel {
|
|
struct drm_panel panel;
|
|
struct mipi_dsi_device *dsi;
|
|
|
|
struct gpio_desc *reset;
|
|
struct backlight_device *backlight;
|
|
|
|
struct regulator_bulk_data *supplies;
|
|
unsigned int num_supplies;
|
|
|
|
bool prepared;
|
|
bool enabled;
|
|
|
|
const struct rad_platform_data *pdata;
|
|
|
|
const struct panel_desc *desc;
|
|
enum drm_panel_orientation orientation;
|
|
};
|
|
|
|
struct rad_platform_data {
|
|
int (*enable)(struct rad_panel *panel);
|
|
};
|
|
|
|
static const struct drm_display_mode default_mode = {
|
|
.clock = 132000,
|
|
.hdisplay = 1080,
|
|
.hsync_start = 1080 + 20,
|
|
.hsync_end = 1080 + 20 + 2,
|
|
.htotal = 1080 + 20 + 2 + 34,
|
|
.vdisplay = 1920,
|
|
.vsync_start = 1920 + 10,
|
|
.vsync_end = 1920 + 10 + 2,
|
|
.vtotal = 1920 + 10 + 2 + 4,
|
|
.width_mm = 68,
|
|
.height_mm = 121,
|
|
.flags = DRM_MODE_FLAG_NHSYNC |
|
|
DRM_MODE_FLAG_NVSYNC,
|
|
};
|
|
|
|
static inline struct rad_panel *to_rad_panel(struct drm_panel *panel)
|
|
{
|
|
return container_of(panel, struct rad_panel, panel);
|
|
}
|
|
|
|
static int rad_panel_push_cmd_list(struct mipi_dsi_device *dsi,
|
|
struct cmd_set_entry const *cmd_set,
|
|
size_t count)
|
|
{
|
|
size_t i;
|
|
int ret = 0;
|
|
|
|
for (i = 0; i < count; i++) {
|
|
const struct cmd_set_entry *entry = cmd_set++;
|
|
u8 buffer[2] = { entry->cmd, entry->param };
|
|
|
|
ret = mipi_dsi_generic_write(dsi, &buffer, sizeof(buffer));
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
|
|
return ret;
|
|
};
|
|
|
|
static int color_format_from_dsi_format(enum mipi_dsi_pixel_format format)
|
|
{
|
|
switch (format) {
|
|
case MIPI_DSI_FMT_RGB565:
|
|
return COL_FMT_16BPP;
|
|
case MIPI_DSI_FMT_RGB666:
|
|
case MIPI_DSI_FMT_RGB666_PACKED:
|
|
return COL_FMT_18BPP;
|
|
case MIPI_DSI_FMT_RGB888:
|
|
return COL_FMT_24BPP;
|
|
default:
|
|
return COL_FMT_24BPP; /* for backward compatibility */
|
|
}
|
|
};
|
|
|
|
static int rad_panel_prepare(struct drm_panel *panel)
|
|
{
|
|
struct rad_panel *rad = to_rad_panel(panel);
|
|
int ret;
|
|
|
|
if (rad->prepared)
|
|
return 0;
|
|
|
|
ret = regulator_bulk_enable(rad->num_supplies, rad->supplies);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* At lest 10ms needed between power-on and reset-out as RM specifies */
|
|
usleep_range(10000, 12000);
|
|
|
|
if (rad->reset) {
|
|
gpiod_set_value_cansleep(rad->reset, 0);
|
|
/*
|
|
* 50ms delay after reset-out, as per manufacturer initalization
|
|
* sequence.
|
|
*/
|
|
msleep(50);
|
|
}
|
|
|
|
rad->prepared = true;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rad_panel_unprepare(struct drm_panel *panel)
|
|
{
|
|
struct rad_panel *rad = to_rad_panel(panel);
|
|
int ret;
|
|
|
|
if (!rad->prepared)
|
|
return 0;
|
|
|
|
/*
|
|
* Right after asserting the reset, we need to release it, so that the
|
|
* touch driver can have an active connection with the touch controller
|
|
* even after the display is turned off.
|
|
*/
|
|
if (rad->reset) {
|
|
gpiod_set_value_cansleep(rad->reset, 1);
|
|
usleep_range(15000, 17000);
|
|
gpiod_set_value_cansleep(rad->reset, 0);
|
|
}
|
|
|
|
ret = regulator_bulk_disable(rad->num_supplies, rad->supplies);
|
|
if (ret)
|
|
return ret;
|
|
|
|
rad->prepared = false;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rm67191_enable(struct rad_panel *panel)
|
|
{
|
|
struct mipi_dsi_device *dsi = panel->dsi;
|
|
struct device *dev = &dsi->dev;
|
|
u8 dsi_mode;
|
|
int color_format = color_format_from_dsi_format(dsi->format);
|
|
int ret;
|
|
|
|
if (panel->enabled)
|
|
return 0;
|
|
|
|
dsi->mode_flags |= MIPI_DSI_MODE_LPM;
|
|
|
|
ret = rad_panel_push_cmd_list(dsi,
|
|
&mcs_rm67191[0],
|
|
ARRAY_SIZE(mcs_rm67191));
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to send MCS (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
|
|
/* Select User Command Set table (CMD1) */
|
|
ret = mipi_dsi_generic_write(dsi, (u8[]){ WRMAUCCTR, 0x00 }, 2);
|
|
if (ret < 0)
|
|
goto fail;
|
|
|
|
/* Software reset */
|
|
ret = mipi_dsi_dcs_soft_reset(dsi);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to do Software Reset (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
|
|
usleep_range(15000, 17000);
|
|
|
|
/* Set DSI mode */
|
|
dsi_mode = (dsi->mode_flags & MIPI_DSI_MODE_VIDEO) ? 0x0B : 0x00;
|
|
ret = mipi_dsi_generic_write(dsi, (u8[]){ 0xC2, dsi_mode }, 2);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to set DSI mode (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
/* Set tear ON */
|
|
ret = mipi_dsi_dcs_set_tear_on(dsi, MIPI_DSI_DCS_TEAR_MODE_VBLANK);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to set tear ON (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
/* Set tear scanline */
|
|
ret = mipi_dsi_dcs_set_tear_scanline(dsi, 0x380);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to set tear scanline (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
/* Set pixel format */
|
|
ret = mipi_dsi_dcs_set_pixel_format(dsi, color_format);
|
|
dev_dbg(dev, "Interface color format set to 0x%x\n", color_format);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to set pixel format (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
/* Exit sleep mode */
|
|
ret = mipi_dsi_dcs_exit_sleep_mode(dsi);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to exit sleep mode (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
|
|
usleep_range(5000, 7000);
|
|
|
|
ret = mipi_dsi_dcs_set_display_on(dsi);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to set display ON (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
|
|
backlight_enable(panel->backlight);
|
|
|
|
panel->enabled = true;
|
|
|
|
return 0;
|
|
|
|
fail:
|
|
gpiod_set_value_cansleep(panel->reset, 1);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int rm67199_enable(struct rad_panel *panel)
|
|
{
|
|
struct mipi_dsi_device *dsi = panel->dsi;
|
|
struct device *dev = &dsi->dev;
|
|
u8 dsi_mode;
|
|
int color_format = color_format_from_dsi_format(dsi->format);
|
|
int ret;
|
|
|
|
if (panel->enabled)
|
|
return 0;
|
|
|
|
dsi->mode_flags |= MIPI_DSI_MODE_LPM;
|
|
|
|
ret = rad_panel_push_cmd_list(dsi,
|
|
&mcs_rm67199[0],
|
|
ARRAY_SIZE(mcs_rm67199));
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to send MCS (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
|
|
/* Select User Command Set table (CMD1) */
|
|
ret = mipi_dsi_generic_write(dsi, (u8[]){ WRMAUCCTR, 0x00 }, 2);
|
|
if (ret < 0)
|
|
goto fail;
|
|
|
|
/* Set DSI mode */
|
|
dsi_mode = (dsi->mode_flags & MIPI_DSI_MODE_VIDEO) ? 0x0B : 0x00;
|
|
ret = mipi_dsi_generic_write(dsi, (u8[]){ 0xC2, dsi_mode }, 2);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to set DSI mode (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
/* Set tear ON */
|
|
ret = mipi_dsi_dcs_set_tear_on(dsi, MIPI_DSI_DCS_TEAR_MODE_VBLANK);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to set tear ON (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
/* Set tear scanline */
|
|
ret = mipi_dsi_dcs_set_tear_scanline(dsi, 0x00);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to set tear scanline (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
/* Set pixel format */
|
|
ret = mipi_dsi_dcs_set_pixel_format(dsi, color_format);
|
|
dev_dbg(dev, "Interface color format set to 0x%x\n",
|
|
color_format);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to set pixel format (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
/* Exit sleep mode */
|
|
ret = mipi_dsi_dcs_exit_sleep_mode(dsi);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to exit sleep mode (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
|
|
/*
|
|
* Although, 120ms seems a lot, this is the amount of delay that the
|
|
* manufacturer suggests it should be used between the sleep-out and
|
|
* display-on commands
|
|
*/
|
|
msleep(120);
|
|
|
|
ret = mipi_dsi_dcs_set_display_on(dsi);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to set display ON (%d)\n", ret);
|
|
goto fail;
|
|
}
|
|
|
|
/*
|
|
* Also, 100ms delay between display-on and backlight enable as per
|
|
* manufacturer initialization sequence.
|
|
*/
|
|
msleep(100);
|
|
|
|
backlight_enable(panel->backlight);
|
|
|
|
panel->enabled = true;
|
|
|
|
return 0;
|
|
|
|
fail:
|
|
gpiod_set_value_cansleep(panel->reset, 1);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int rad_panel_enable(struct drm_panel *panel)
|
|
{
|
|
struct rad_panel *rad = to_rad_panel(panel);
|
|
|
|
return rad->pdata->enable(rad);
|
|
}
|
|
|
|
static int rad_panel_disable(struct drm_panel *panel)
|
|
{
|
|
struct rad_panel *rad = to_rad_panel(panel);
|
|
struct mipi_dsi_device *dsi = rad->dsi;
|
|
struct device *dev = &dsi->dev;
|
|
int ret;
|
|
|
|
if (!rad->enabled)
|
|
return 0;
|
|
|
|
dsi->mode_flags |= MIPI_DSI_MODE_LPM;
|
|
|
|
backlight_disable(rad->backlight);
|
|
|
|
usleep_range(10000, 12000);
|
|
|
|
ret = mipi_dsi_dcs_set_display_off(dsi);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to set display OFF (%d)\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
usleep_range(5000, 10000);
|
|
|
|
ret = mipi_dsi_dcs_enter_sleep_mode(dsi);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to enter sleep mode (%d)\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
rad->enabled = false;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rad_panel_get_desc_modes(struct drm_panel *panel,
|
|
struct drm_connector *connector)
|
|
{
|
|
struct drm_display_mode *mode;
|
|
struct rad_panel *p = to_rad_panel(panel);
|
|
unsigned int i, num = 0;
|
|
|
|
if (!p->desc)
|
|
return 0;
|
|
|
|
for (i = 0; i < p->desc->num_modes; i++) {
|
|
const struct drm_display_mode *m = &p->desc->modes[i];
|
|
|
|
mode = drm_mode_duplicate(connector->dev, m);
|
|
if (!mode) {
|
|
dev_err(panel->dev, "failed to add mode %ux%u@%u\n",
|
|
m->hdisplay, m->vdisplay,
|
|
drm_mode_vrefresh(m));
|
|
continue;
|
|
}
|
|
|
|
mode->type |= DRM_MODE_TYPE_DRIVER;
|
|
|
|
if (p->desc->num_modes == 1)
|
|
mode->type |= DRM_MODE_TYPE_PREFERRED;
|
|
|
|
drm_mode_set_name(mode);
|
|
|
|
drm_mode_probed_add(connector, mode);
|
|
num++;
|
|
}
|
|
|
|
if (num > 0) {
|
|
if (p->desc->size.width)
|
|
connector->display_info.width_mm = p->desc->size.width;
|
|
if (p->desc->size.height)
|
|
connector->display_info.height_mm = p->desc->size.height;
|
|
connector->display_info.bus_flags = rad_bus_flags;
|
|
|
|
drm_display_info_set_bus_formats(&connector->display_info,
|
|
rad_bus_formats,
|
|
ARRAY_SIZE(rad_bus_formats));
|
|
|
|
drm_connector_set_panel_orientation(connector, p->orientation);
|
|
}
|
|
|
|
return num;
|
|
}
|
|
|
|
static int rad_panel_get_modes(struct drm_panel *panel,
|
|
struct drm_connector *connector)
|
|
{
|
|
struct drm_display_mode *mode;
|
|
int num = rad_panel_get_desc_modes(panel, connector);
|
|
|
|
if (num > 0)
|
|
return num;
|
|
|
|
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);
|
|
mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
|
|
drm_mode_probed_add(connector, mode);
|
|
|
|
connector->display_info.width_mm = mode->width_mm;
|
|
connector->display_info.height_mm = mode->height_mm;
|
|
connector->display_info.bus_flags = rad_bus_flags;
|
|
|
|
drm_display_info_set_bus_formats(&connector->display_info,
|
|
rad_bus_formats,
|
|
ARRAY_SIZE(rad_bus_formats));
|
|
return 1;
|
|
}
|
|
|
|
static int rad_bl_update_status(struct backlight_device *bl)
|
|
{
|
|
struct mipi_dsi_device *dsi = bl_get_data(bl);
|
|
struct rad_panel *rad = mipi_dsi_get_drvdata(dsi);
|
|
int ret = 0;
|
|
|
|
if (!rad->prepared)
|
|
return 0;
|
|
|
|
dsi->mode_flags &= ~MIPI_DSI_MODE_LPM;
|
|
|
|
ret = mipi_dsi_dcs_set_display_brightness(dsi, bl->props.brightness);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static enum drm_panel_orientation rad_panel_get_orientation(struct drm_panel *panel)
|
|
{
|
|
struct rad_panel *p = to_rad_panel(panel);
|
|
|
|
return p->orientation;
|
|
}
|
|
|
|
static const struct backlight_ops rad_bl_ops = {
|
|
.update_status = rad_bl_update_status,
|
|
};
|
|
|
|
static const struct drm_panel_funcs rad_panel_funcs = {
|
|
.prepare = rad_panel_prepare,
|
|
.unprepare = rad_panel_unprepare,
|
|
.enable = rad_panel_enable,
|
|
.disable = rad_panel_disable,
|
|
.get_modes = rad_panel_get_modes,
|
|
.get_orientation = rad_panel_get_orientation,
|
|
};
|
|
|
|
static const char * const rad_supply_names[] = {
|
|
"v3p3",
|
|
"v1p8",
|
|
};
|
|
|
|
static int rad_init_regulators(struct rad_panel *rad)
|
|
{
|
|
struct device *dev = &rad->dsi->dev;
|
|
int i;
|
|
|
|
rad->num_supplies = ARRAY_SIZE(rad_supply_names);
|
|
rad->supplies = devm_kcalloc(dev, rad->num_supplies,
|
|
sizeof(*rad->supplies), GFP_KERNEL);
|
|
if (!rad->supplies)
|
|
return -ENOMEM;
|
|
|
|
for (i = 0; i < rad->num_supplies; i++)
|
|
rad->supplies[i].supply = rad_supply_names[i];
|
|
|
|
return devm_regulator_bulk_get(dev, rad->num_supplies, rad->supplies);
|
|
};
|
|
|
|
static const struct rad_platform_data rad_rm67191 = {
|
|
.enable = &rm67191_enable,
|
|
};
|
|
|
|
static const struct rad_platform_data rad_rm67199 = {
|
|
.enable = &rm67199_enable,
|
|
};
|
|
|
|
static const struct of_device_id rad_of_match[] = {
|
|
{ .compatible = "raydium,rm67191", .data = &rad_rm67191 },
|
|
{ .compatible = "raydium,rm67199", .data = &rad_rm67199 },
|
|
{ /* sentinel */ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, rad_of_match);
|
|
|
|
static bool of_child_node_is_present(const struct device_node *node,
|
|
const char *name)
|
|
{
|
|
struct device_node *child;
|
|
|
|
child = of_get_child_by_name(node, name);
|
|
of_node_put(child);
|
|
|
|
return !!child;
|
|
}
|
|
|
|
static int rad_panel_probe(struct mipi_dsi_device *dsi)
|
|
{
|
|
struct device *dev = &dsi->dev;
|
|
const struct of_device_id *of_id = of_match_device(rad_of_match, dev);
|
|
struct device_node *np = dev->of_node;
|
|
struct rad_panel *panel;
|
|
struct backlight_properties bl_props;
|
|
int ret;
|
|
u32 video_mode;
|
|
|
|
if (!of_id || !of_id->data)
|
|
return -ENODEV;
|
|
|
|
panel = devm_kzalloc(&dsi->dev, sizeof(*panel), GFP_KERNEL);
|
|
if (!panel)
|
|
return -ENOMEM;
|
|
|
|
mipi_dsi_set_drvdata(dsi, panel);
|
|
|
|
panel->dsi = dsi;
|
|
panel->pdata = of_id->data;
|
|
|
|
dsi->format = MIPI_DSI_FMT_RGB888;
|
|
dsi->mode_flags = MIPI_DSI_MODE_VIDEO_HSE | MIPI_DSI_MODE_NO_EOT_PACKET;
|
|
|
|
ret = of_property_read_u32(np, "video-mode", &video_mode);
|
|
if (!ret) {
|
|
switch (video_mode) {
|
|
case 0:
|
|
/* burst mode */
|
|
dsi->mode_flags |= MIPI_DSI_MODE_VIDEO_BURST |
|
|
MIPI_DSI_MODE_VIDEO;
|
|
break;
|
|
case 1:
|
|
/* non-burst mode with sync event */
|
|
dsi->mode_flags |= MIPI_DSI_MODE_VIDEO;
|
|
break;
|
|
case 2:
|
|
/* non-burst mode with sync pulse */
|
|
dsi->mode_flags |= MIPI_DSI_MODE_VIDEO_SYNC_PULSE |
|
|
MIPI_DSI_MODE_VIDEO;
|
|
break;
|
|
case 3:
|
|
/* command mode */
|
|
dsi->mode_flags |= MIPI_DSI_CLOCK_NON_CONTINUOUS |
|
|
MIPI_DSI_MODE_VSYNC_FLUSH;
|
|
break;
|
|
default:
|
|
dev_warn(dev, "invalid video mode %d\n", video_mode);
|
|
break;
|
|
}
|
|
}
|
|
|
|
ret = of_property_read_u32(np, "dsi-lanes", &dsi->lanes);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to get dsi-lanes property (%d)\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
panel->reset = devm_gpiod_get_optional(dev, "reset",
|
|
GPIOD_OUT_LOW |
|
|
GPIOD_FLAGS_BIT_NONEXCLUSIVE);
|
|
if (IS_ERR(panel->reset)) {
|
|
ret = PTR_ERR(panel->reset);
|
|
dev_err(dev, "Failed to get reset gpio (%d)\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = of_drm_get_panel_orientation(dev->of_node, &panel->orientation);
|
|
if (ret) {
|
|
dev_err(dev, "%pOF: failed to get orientation %d\n", dev->of_node, ret);
|
|
return ret;
|
|
}
|
|
|
|
if (of_child_node_is_present(np, "display-timings")) {
|
|
struct drm_display_mode *mode;
|
|
struct panel_desc *desc;
|
|
u32 bus_flags;
|
|
|
|
mode = devm_kzalloc(dev, sizeof(*mode), GFP_KERNEL);
|
|
if (!mode)
|
|
return -ENOMEM;
|
|
|
|
desc = devm_kzalloc(dev, sizeof(*desc), GFP_KERNEL);
|
|
if (!desc)
|
|
return -ENOMEM;
|
|
|
|
if (!of_get_drm_display_mode(np, mode, &bus_flags,
|
|
OF_USE_NATIVE_MODE)) {
|
|
desc->modes = mode;
|
|
desc->num_modes = 1;
|
|
of_property_read_u32(np, "width-mm", &desc->size.width);
|
|
of_property_read_u32(np, "height-mm", &desc->size.height);
|
|
}
|
|
|
|
panel->desc = desc;
|
|
}
|
|
|
|
gpiod_set_value_cansleep(panel->reset, 1);
|
|
|
|
memset(&bl_props, 0, sizeof(bl_props));
|
|
bl_props.type = BACKLIGHT_RAW;
|
|
bl_props.brightness = 255;
|
|
bl_props.max_brightness = 255;
|
|
|
|
panel->backlight = devm_backlight_device_register(dev, dev_name(dev),
|
|
dev, dsi, &rad_bl_ops,
|
|
&bl_props);
|
|
if (IS_ERR(panel->backlight)) {
|
|
ret = PTR_ERR(panel->backlight);
|
|
dev_err(dev, "Failed to register backlight (%d)\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = rad_init_regulators(panel);
|
|
if (ret)
|
|
return ret;
|
|
|
|
drm_panel_init(&panel->panel, dev, &rad_panel_funcs,
|
|
DRM_MODE_CONNECTOR_DSI);
|
|
dev_set_drvdata(dev, panel);
|
|
|
|
drm_panel_add(&panel->panel);
|
|
|
|
ret = mipi_dsi_attach(dsi);
|
|
if (ret)
|
|
drm_panel_remove(&panel->panel);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void rad_panel_remove(struct mipi_dsi_device *dsi)
|
|
{
|
|
struct rad_panel *rad = mipi_dsi_get_drvdata(dsi);
|
|
struct device *dev = &dsi->dev;
|
|
int ret;
|
|
|
|
ret = mipi_dsi_detach(dsi);
|
|
if (ret)
|
|
dev_err(dev, "Failed to detach from host (%d)\n", ret);
|
|
|
|
drm_panel_remove(&rad->panel);
|
|
}
|
|
|
|
static void rad_panel_shutdown(struct mipi_dsi_device *dsi)
|
|
{
|
|
struct rad_panel *rad = mipi_dsi_get_drvdata(dsi);
|
|
|
|
rad_panel_disable(&rad->panel);
|
|
rad_panel_unprepare(&rad->panel);
|
|
}
|
|
|
|
static struct mipi_dsi_driver rad_panel_driver = {
|
|
.driver = {
|
|
.name = "panel-raydium-rm67191",
|
|
.of_match_table = rad_of_match,
|
|
},
|
|
.probe = rad_panel_probe,
|
|
.remove = rad_panel_remove,
|
|
.shutdown = rad_panel_shutdown,
|
|
};
|
|
module_mipi_dsi_driver(rad_panel_driver);
|
|
|
|
MODULE_AUTHOR("Robert Chiras <robert.chiras@nxp.com>");
|
|
MODULE_DESCRIPTION("DRM Driver for Raydium RM67191 MIPI DSI panel");
|
|
MODULE_LICENSE("GPL v2");
|