mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-05 10:04:12 +08:00
c3ee8c65f6
The function "int drm_panel_add(struct drm_panel *panel)" always returns 0, this return value is meaningless. Also, there is no need to check return value which calls "drm_panel_add and", error branch code will never run. Signed-off-by: Bernard Zhao <bernard@vivo.com> Reviewed-by: Linus Walleij <linus.walleij@linaro.org> Signed-off-by: Sam Ravnborg <sam@ravnborg.org> Link: https://patchwork.freedesktop.org/patch/msgid/20200801120216.8488-1-bernard@vivo.com
443 lines
9.6 KiB
C
443 lines
9.6 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* Copyright (C) 2014 NVIDIA Corporation
|
|
*/
|
|
|
|
#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_panel.h>
|
|
|
|
struct sharp_panel {
|
|
struct drm_panel base;
|
|
/* the datasheet refers to them as DSI-LINK1 and DSI-LINK2 */
|
|
struct mipi_dsi_device *link1;
|
|
struct mipi_dsi_device *link2;
|
|
|
|
struct regulator *supply;
|
|
|
|
bool prepared;
|
|
bool enabled;
|
|
|
|
const struct drm_display_mode *mode;
|
|
};
|
|
|
|
static inline struct sharp_panel *to_sharp_panel(struct drm_panel *panel)
|
|
{
|
|
return container_of(panel, struct sharp_panel, base);
|
|
}
|
|
|
|
static void sharp_wait_frames(struct sharp_panel *sharp, unsigned int frames)
|
|
{
|
|
unsigned int refresh = drm_mode_vrefresh(sharp->mode);
|
|
|
|
if (WARN_ON(frames > refresh))
|
|
return;
|
|
|
|
msleep(1000 / (refresh / frames));
|
|
}
|
|
|
|
static int sharp_panel_write(struct sharp_panel *sharp, u16 offset, u8 value)
|
|
{
|
|
u8 payload[3] = { offset >> 8, offset & 0xff, value };
|
|
struct mipi_dsi_device *dsi = sharp->link1;
|
|
ssize_t err;
|
|
|
|
err = mipi_dsi_generic_write(dsi, payload, sizeof(payload));
|
|
if (err < 0) {
|
|
dev_err(&dsi->dev, "failed to write %02x to %04x: %zd\n",
|
|
value, offset, err);
|
|
return err;
|
|
}
|
|
|
|
err = mipi_dsi_dcs_nop(dsi);
|
|
if (err < 0) {
|
|
dev_err(&dsi->dev, "failed to send DCS nop: %zd\n", err);
|
|
return err;
|
|
}
|
|
|
|
usleep_range(10, 20);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static __maybe_unused int sharp_panel_read(struct sharp_panel *sharp,
|
|
u16 offset, u8 *value)
|
|
{
|
|
ssize_t err;
|
|
|
|
cpu_to_be16s(&offset);
|
|
|
|
err = mipi_dsi_generic_read(sharp->link1, &offset, sizeof(offset),
|
|
value, sizeof(*value));
|
|
if (err < 0)
|
|
dev_err(&sharp->link1->dev, "failed to read from %04x: %zd\n",
|
|
offset, err);
|
|
|
|
return err;
|
|
}
|
|
|
|
static int sharp_panel_disable(struct drm_panel *panel)
|
|
{
|
|
struct sharp_panel *sharp = to_sharp_panel(panel);
|
|
|
|
if (!sharp->enabled)
|
|
return 0;
|
|
|
|
sharp->enabled = false;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sharp_panel_unprepare(struct drm_panel *panel)
|
|
{
|
|
struct sharp_panel *sharp = to_sharp_panel(panel);
|
|
int err;
|
|
|
|
if (!sharp->prepared)
|
|
return 0;
|
|
|
|
sharp_wait_frames(sharp, 4);
|
|
|
|
err = mipi_dsi_dcs_set_display_off(sharp->link1);
|
|
if (err < 0)
|
|
dev_err(panel->dev, "failed to set display off: %d\n", err);
|
|
|
|
err = mipi_dsi_dcs_enter_sleep_mode(sharp->link1);
|
|
if (err < 0)
|
|
dev_err(panel->dev, "failed to enter sleep mode: %d\n", err);
|
|
|
|
msleep(120);
|
|
|
|
regulator_disable(sharp->supply);
|
|
|
|
sharp->prepared = false;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sharp_setup_symmetrical_split(struct mipi_dsi_device *left,
|
|
struct mipi_dsi_device *right,
|
|
const struct drm_display_mode *mode)
|
|
{
|
|
int err;
|
|
|
|
err = mipi_dsi_dcs_set_column_address(left, 0, mode->hdisplay / 2 - 1);
|
|
if (err < 0) {
|
|
dev_err(&left->dev, "failed to set column address: %d\n", err);
|
|
return err;
|
|
}
|
|
|
|
err = mipi_dsi_dcs_set_page_address(left, 0, mode->vdisplay - 1);
|
|
if (err < 0) {
|
|
dev_err(&left->dev, "failed to set page address: %d\n", err);
|
|
return err;
|
|
}
|
|
|
|
err = mipi_dsi_dcs_set_column_address(right, mode->hdisplay / 2,
|
|
mode->hdisplay - 1);
|
|
if (err < 0) {
|
|
dev_err(&right->dev, "failed to set column address: %d\n", err);
|
|
return err;
|
|
}
|
|
|
|
err = mipi_dsi_dcs_set_page_address(right, 0, mode->vdisplay - 1);
|
|
if (err < 0) {
|
|
dev_err(&right->dev, "failed to set page address: %d\n", err);
|
|
return err;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sharp_panel_prepare(struct drm_panel *panel)
|
|
{
|
|
struct sharp_panel *sharp = to_sharp_panel(panel);
|
|
u8 format = MIPI_DCS_PIXEL_FMT_24BIT;
|
|
int err;
|
|
|
|
if (sharp->prepared)
|
|
return 0;
|
|
|
|
err = regulator_enable(sharp->supply);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
/*
|
|
* According to the datasheet, the panel needs around 10 ms to fully
|
|
* power up. At least another 120 ms is required before exiting sleep
|
|
* mode to make sure the panel is ready. Throw in another 20 ms for
|
|
* good measure.
|
|
*/
|
|
msleep(150);
|
|
|
|
err = mipi_dsi_dcs_exit_sleep_mode(sharp->link1);
|
|
if (err < 0) {
|
|
dev_err(panel->dev, "failed to exit sleep mode: %d\n", err);
|
|
goto poweroff;
|
|
}
|
|
|
|
/*
|
|
* The MIPI DCS specification mandates this delay only between the
|
|
* exit_sleep_mode and enter_sleep_mode commands, so it isn't strictly
|
|
* necessary here.
|
|
*/
|
|
/*
|
|
msleep(120);
|
|
*/
|
|
|
|
/* set left-right mode */
|
|
err = sharp_panel_write(sharp, 0x1000, 0x2a);
|
|
if (err < 0) {
|
|
dev_err(panel->dev, "failed to set left-right mode: %d\n", err);
|
|
goto poweroff;
|
|
}
|
|
|
|
/* enable command mode */
|
|
err = sharp_panel_write(sharp, 0x1001, 0x01);
|
|
if (err < 0) {
|
|
dev_err(panel->dev, "failed to enable command mode: %d\n", err);
|
|
goto poweroff;
|
|
}
|
|
|
|
err = mipi_dsi_dcs_set_pixel_format(sharp->link1, format);
|
|
if (err < 0) {
|
|
dev_err(panel->dev, "failed to set pixel format: %d\n", err);
|
|
goto poweroff;
|
|
}
|
|
|
|
/*
|
|
* TODO: The device supports both left-right and even-odd split
|
|
* configurations, but this driver currently supports only the left-
|
|
* right split. To support a different mode a mechanism needs to be
|
|
* put in place to communicate the configuration back to the DSI host
|
|
* controller.
|
|
*/
|
|
err = sharp_setup_symmetrical_split(sharp->link1, sharp->link2,
|
|
sharp->mode);
|
|
if (err < 0) {
|
|
dev_err(panel->dev, "failed to set up symmetrical split: %d\n",
|
|
err);
|
|
goto poweroff;
|
|
}
|
|
|
|
err = mipi_dsi_dcs_set_display_on(sharp->link1);
|
|
if (err < 0) {
|
|
dev_err(panel->dev, "failed to set display on: %d\n", err);
|
|
goto poweroff;
|
|
}
|
|
|
|
sharp->prepared = true;
|
|
|
|
/* wait for 6 frames before continuing */
|
|
sharp_wait_frames(sharp, 6);
|
|
|
|
return 0;
|
|
|
|
poweroff:
|
|
regulator_disable(sharp->supply);
|
|
return err;
|
|
}
|
|
|
|
static int sharp_panel_enable(struct drm_panel *panel)
|
|
{
|
|
struct sharp_panel *sharp = to_sharp_panel(panel);
|
|
|
|
if (sharp->enabled)
|
|
return 0;
|
|
|
|
sharp->enabled = true;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct drm_display_mode default_mode = {
|
|
.clock = 278000,
|
|
.hdisplay = 2560,
|
|
.hsync_start = 2560 + 128,
|
|
.hsync_end = 2560 + 128 + 64,
|
|
.htotal = 2560 + 128 + 64 + 64,
|
|
.vdisplay = 1600,
|
|
.vsync_start = 1600 + 4,
|
|
.vsync_end = 1600 + 4 + 8,
|
|
.vtotal = 1600 + 4 + 8 + 32,
|
|
};
|
|
|
|
static int sharp_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%ux@%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 = 217;
|
|
connector->display_info.height_mm = 136;
|
|
|
|
return 1;
|
|
}
|
|
|
|
static const struct drm_panel_funcs sharp_panel_funcs = {
|
|
.disable = sharp_panel_disable,
|
|
.unprepare = sharp_panel_unprepare,
|
|
.prepare = sharp_panel_prepare,
|
|
.enable = sharp_panel_enable,
|
|
.get_modes = sharp_panel_get_modes,
|
|
};
|
|
|
|
static const struct of_device_id sharp_of_match[] = {
|
|
{ .compatible = "sharp,lq101r1sx01", },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, sharp_of_match);
|
|
|
|
static int sharp_panel_add(struct sharp_panel *sharp)
|
|
{
|
|
int ret;
|
|
|
|
sharp->mode = &default_mode;
|
|
|
|
sharp->supply = devm_regulator_get(&sharp->link1->dev, "power");
|
|
if (IS_ERR(sharp->supply))
|
|
return PTR_ERR(sharp->supply);
|
|
|
|
drm_panel_init(&sharp->base, &sharp->link1->dev, &sharp_panel_funcs,
|
|
DRM_MODE_CONNECTOR_DSI);
|
|
|
|
ret = drm_panel_of_backlight(&sharp->base);
|
|
if (ret)
|
|
return ret;
|
|
|
|
drm_panel_add(&sharp->base);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void sharp_panel_del(struct sharp_panel *sharp)
|
|
{
|
|
if (sharp->base.dev)
|
|
drm_panel_remove(&sharp->base);
|
|
|
|
if (sharp->link2)
|
|
put_device(&sharp->link2->dev);
|
|
}
|
|
|
|
static int sharp_panel_probe(struct mipi_dsi_device *dsi)
|
|
{
|
|
struct mipi_dsi_device *secondary = NULL;
|
|
struct sharp_panel *sharp;
|
|
struct device_node *np;
|
|
int err;
|
|
|
|
dsi->lanes = 4;
|
|
dsi->format = MIPI_DSI_FMT_RGB888;
|
|
dsi->mode_flags = MIPI_DSI_MODE_LPM;
|
|
|
|
/* Find DSI-LINK1 */
|
|
np = of_parse_phandle(dsi->dev.of_node, "link2", 0);
|
|
if (np) {
|
|
secondary = of_find_mipi_dsi_device_by_node(np);
|
|
of_node_put(np);
|
|
|
|
if (!secondary)
|
|
return -EPROBE_DEFER;
|
|
}
|
|
|
|
/* register a panel for only the DSI-LINK1 interface */
|
|
if (secondary) {
|
|
sharp = devm_kzalloc(&dsi->dev, sizeof(*sharp), GFP_KERNEL);
|
|
if (!sharp) {
|
|
put_device(&secondary->dev);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
mipi_dsi_set_drvdata(dsi, sharp);
|
|
|
|
sharp->link2 = secondary;
|
|
sharp->link1 = dsi;
|
|
|
|
err = sharp_panel_add(sharp);
|
|
if (err < 0) {
|
|
put_device(&secondary->dev);
|
|
return err;
|
|
}
|
|
}
|
|
|
|
err = mipi_dsi_attach(dsi);
|
|
if (err < 0) {
|
|
if (secondary)
|
|
sharp_panel_del(sharp);
|
|
|
|
return err;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sharp_panel_remove(struct mipi_dsi_device *dsi)
|
|
{
|
|
struct sharp_panel *sharp = mipi_dsi_get_drvdata(dsi);
|
|
int err;
|
|
|
|
/* only detach from host for the DSI-LINK2 interface */
|
|
if (!sharp) {
|
|
mipi_dsi_detach(dsi);
|
|
return 0;
|
|
}
|
|
|
|
err = drm_panel_disable(&sharp->base);
|
|
if (err < 0)
|
|
dev_err(&dsi->dev, "failed to disable panel: %d\n", err);
|
|
|
|
err = mipi_dsi_detach(dsi);
|
|
if (err < 0)
|
|
dev_err(&dsi->dev, "failed to detach from DSI host: %d\n", err);
|
|
|
|
sharp_panel_del(sharp);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void sharp_panel_shutdown(struct mipi_dsi_device *dsi)
|
|
{
|
|
struct sharp_panel *sharp = mipi_dsi_get_drvdata(dsi);
|
|
|
|
/* nothing to do for DSI-LINK2 */
|
|
if (!sharp)
|
|
return;
|
|
|
|
drm_panel_disable(&sharp->base);
|
|
}
|
|
|
|
static struct mipi_dsi_driver sharp_panel_driver = {
|
|
.driver = {
|
|
.name = "panel-sharp-lq101r1sx01",
|
|
.of_match_table = sharp_of_match,
|
|
},
|
|
.probe = sharp_panel_probe,
|
|
.remove = sharp_panel_remove,
|
|
.shutdown = sharp_panel_shutdown,
|
|
};
|
|
module_mipi_dsi_driver(sharp_panel_driver);
|
|
|
|
MODULE_AUTHOR("Thierry Reding <treding@nvidia.com>");
|
|
MODULE_DESCRIPTION("Sharp LQ101R1SX01 panel driver");
|
|
MODULE_LICENSE("GPL v2");
|