Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * This file based on panel-ilitek-ili9881c.c
- */
- #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/media-bus-format.h>
- #include <linux/module.h>
- #include <linux/gpio/consumer.h>
- #include <linux/regulator/consumer.h>
- #include <drm/drm_connector.h>
- #include <drm/drm_mipi_dsi.h>
- #include <drm/drm_modes.h>
- #include <drm/drm_panel.h>
- #include <drm/drm_print.h>
- 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 const struct ili9881c_instr ili9881c_init[] = {
- ILI9881C_COMMAND_INSTR(0xB2, 0x50),
- ILI9881C_COMMAND_INSTR(0x80, 0x8B),
- ILI9881C_COMMAND_INSTR(0x81, 0x78),
- ILI9881C_COMMAND_INSTR(0x82, 0x84),
- ILI9881C_COMMAND_INSTR(0x83, 0x88),
- ILI9881C_COMMAND_INSTR(0x84, 0xA8),
- ILI9881C_COMMAND_INSTR(0x85, 0xE3),
- ILI9881C_COMMAND_INSTR(0x86, 0x88)
- };
- /*
- * The panel seems to accept some private DCS commands that map
- * directly to registers.
- *
- * It is organised by page, with each page having its own set of
- * registers, and the first page looks like it's holding the standard
- * DCS commands.
- *
- * So before any attempt at sending a command or data, we have to be
- * sure if we're in the right page or not.
- */
- 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;
- }
- struct rb070d30_panel {
- struct drm_panel panel;
- struct mipi_dsi_device *dsi;
- //struct backlight_device *backlight;
- //struct regulator *supply;
- struct {
- //struct gpio_desc *power;
- struct gpio_desc *reset;
- //struct gpio_desc *updn;
- //struct gpio_desc *shlr;
- } gpios;
- };
- static inline struct rb070d30_panel *panel_to_rb070d30_panel(struct drm_panel *panel)
- {
- return container_of(panel, struct rb070d30_panel, panel);
- }
- static int rb070d30_panel_prepare(struct drm_panel *panel)
- {
- struct rb070d30_panel *ctx = panel_to_rb070d30_panel(panel);
- int ret;
- /*
- ret = regulator_enable(ctx->supply);
- if (ret < 0) {
- DRM_DEV_ERROR(&ctx->dsi->dev, "Failed to enable supply: %d\n", ret);
- return ret;
- }
- */
- //msleep(20);
- //gpiod_set_value(ctx->gpios.power, 1);
- msleep(20);
- gpiod_set_value(ctx->gpios.reset, 0);
- msleep(20);
- gpiod_set_value(ctx->gpios.reset, 1);
- msleep(20);
- for (i = 0; i < ARRAY_SIZE(ili9881c_init); i++) {
- const 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;
- }
- return 0;
- }
- static int rb070d30_panel_unprepare(struct drm_panel *panel)
- {
- struct rb070d30_panel *ctx = panel_to_rb070d30_panel(panel);
- gpiod_set_value(ctx->gpios.reset, 0);
- //gpiod_set_value(ctx->gpios.power, 0);
- //regulator_disable(ctx->supply);
- return 0;
- }
- static int rb070d30_panel_enable(struct drm_panel *panel)
- {
- struct rb070d30_panel *ctx = panel_to_rb070d30_panel(panel);
- int ret;
- ret = mipi_dsi_dcs_exit_sleep_mode(ctx->dsi);
- if (ret)
- return ret;
- /*
- ret = backlight_enable(ctx->backlight);
- if (ret)
- goto out;
- */
- return 0;
- //out:
- //mipi_dsi_dcs_enter_sleep_mode(ctx->dsi);
- //return ret;
- }
- static int rb070d30_panel_disable(struct drm_panel *panel)
- {
- struct rb070d30_panel *ctx = panel_to_rb070d30_panel(panel);
- //backlight_disable(ctx->backlight);
- return mipi_dsi_dcs_enter_sleep_mode(ctx->dsi);
- }
- /* Default timings */
- static const struct drm_display_mode default_mode = {
- .clock = 51206,
- .hdisplay = 1024,
- .hsync_start = 1024 + 160,
- .hsync_end = 1024 + 160 + 80,
- .htotal = 1024 + 160 + 80 + 80,
- .vdisplay = 600,
- .vsync_start = 600 + 12,
- .vsync_end = 600 + 12 + 10,
- .vtotal = 600 + 12 + 10 + 13,
- .vrefresh = 60,
- .width_mm = 154,
- .height_mm = 85,
- };
- static int rb070d30_panel_get_modes(struct drm_panel *panel)
- {
- struct drm_connector *connector = panel->connector;
- struct rb070d30_panel *ctx = panel_to_rb070d30_panel(panel);
- struct drm_display_mode *mode;
- static const u32 bus_format = MEDIA_BUS_FMT_RGB888_1X24;
- mode = drm_mode_duplicate(panel->drm, &default_mode);
- if (!mode) {
- DRM_DEV_ERROR(&ctx->dsi->dev,
- "Failed to add mode " DRM_MODE_FMT "\n",
- DRM_MODE_ARG(&default_mode));
- return -EINVAL;
- }
- 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.bpc = 8;
- panel->connector->display_info.width_mm = mode->width_mm;
- panel->connector->display_info.height_mm = mode->height_mm;
- drm_display_info_set_bus_formats(&connector->display_info,
- &bus_format, 1);
- return 1;
- }
- static const struct drm_panel_funcs rb070d30_panel_funcs = {
- .get_modes = rb070d30_panel_get_modes,
- .prepare = rb070d30_panel_prepare,
- .enable = rb070d30_panel_enable,
- .disable = rb070d30_panel_disable,
- .unprepare = rb070d30_panel_unprepare,
- };
- static int rb070d30_panel_dsi_probe(struct mipi_dsi_device *dsi)
- {
- struct rb070d30_panel *ctx;
- int ret;
- ctx = devm_kzalloc(&dsi->dev, sizeof(*ctx), GFP_KERNEL);
- if (!ctx)
- return -ENOMEM;
- /*
- ctx->supply = devm_regulator_get(&dsi->dev, "vcc-lcd");
- if (IS_ERR(ctx->supply))
- return PTR_ERR(ctx->supply);
- */
- mipi_dsi_set_drvdata(dsi, ctx);
- ctx->dsi = dsi;
- drm_panel_init(&ctx->panel, &dsi->dev, &rb070d30_panel_funcs,
- DRM_MODE_CONNECTOR_DSI);
- ctx->gpios.reset = devm_gpiod_get(&dsi->dev, "reset", GPIOD_OUT_LOW);
- if (IS_ERR(ctx->gpios.reset)) {
- DRM_DEV_ERROR(&dsi->dev, "Couldn't get our reset GPIO\n");
- return PTR_ERR(ctx->gpios.reset);
- }
- /*
- ctx->gpios.power = devm_gpiod_get(&dsi->dev, "power", GPIOD_OUT_LOW);
- if (IS_ERR(ctx->gpios.power)) {
- DRM_DEV_ERROR(&dsi->dev, "Couldn't get our power GPIO\n");
- return PTR_ERR(ctx->gpios.power);
- }
- */
- /*
- * We don't change the state of that GPIO later on but we need
- * to force it into a low state.
- */
- /*
- ctx->gpios.updn = devm_gpiod_get(&dsi->dev, "updn", GPIOD_OUT_LOW);
- if (IS_ERR(ctx->gpios.updn)) {
- DRM_DEV_ERROR(&dsi->dev, "Couldn't get our updn GPIO\n");
- return PTR_ERR(ctx->gpios.updn);
- }*/
- /*
- * We don't change the state of that GPIO later on but we need
- * to force it into a low state.
- */
- /*
- ctx->gpios.shlr = devm_gpiod_get(&dsi->dev, "shlr", GPIOD_OUT_LOW);
- if (IS_ERR(ctx->gpios.shlr)) {
- DRM_DEV_ERROR(&dsi->dev, "Couldn't get our shlr GPIO\n");
- return PTR_ERR(ctx->gpios.shlr);
- }
- ctx->backlight = devm_of_find_backlight(&dsi->dev);
- if (IS_ERR(ctx->backlight)) {
- DRM_DEV_ERROR(&dsi->dev, "Couldn't get our backlight\n");
- return PTR_ERR(ctx->backlight);
- }*/
- ret = drm_panel_add(&ctx->panel);
- if (ret < 0)
- return ret;
- dsi->mode_flags = MIPI_DSI_MODE_VIDEO | MIPI_DSI_MODE_VIDEO_BURST | MIPI_DSI_MODE_LPM;
- dsi->format = MIPI_DSI_FMT_RGB888;
- dsi->lanes = 2;
- return mipi_dsi_attach(dsi);
- }
- static int rb070d30_panel_dsi_remove(struct mipi_dsi_device *dsi)
- {
- struct rb070d30_panel *ctx = mipi_dsi_get_drvdata(dsi);
- mipi_dsi_detach(dsi);
- drm_panel_remove(&ctx->panel);
- return 0;
- }
- static const struct of_device_id rb070d30_panel_of_match[] = {
- { .compatible = "dmb,rb070d30" },
- { /* sentinel */ },
- };
- MODULE_DEVICE_TABLE(of, rb070d30_panel_of_match);
- static struct mipi_dsi_driver rb070d30_panel_driver = {
- .probe = rb070d30_panel_dsi_probe,
- .remove = rb070d30_panel_dsi_remove,
- .driver = {
- .name = "panel-dmb-rb070d30",
- .of_match_table = rb070d30_panel_of_match,
- },
- };
- module_mipi_dsi_driver(rb070d30_panel_driver);
- MODULE_LICENSE("GPL");
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement