drivers/gpu/drm/panel/panel-innolux-p079zca.c - third_party/dump-capture-kernel - Git at Google

 /*
  * Copyright (c) 2017, Fuzhou Rockchip Electronics Co., Ltd
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
  * the Free Software Foundation; either version 2 of the License, or
  * (at your option) any later version.
  */

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

 #include <drm/drmP.h>
 #include <drm/drm_crtc.h>
 #include <drm/drm_mipi_dsi.h>
 #include <drm/drm_panel.h>

 #include <video/mipi_display.h>

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

 	struct backlight_device *backlight;
 	struct regulator *supply;
 	struct gpio_desc *enable_gpio;

 	bool prepared;
 	bool enabled;
 };

 static inline struct innolux_panel *to_innolux_panel(struct drm_panel *panel)
 {
 	return container_of(panel, struct innolux_panel, base);
 }

 static int innolux_panel_disable(struct drm_panel *panel)
 {
 	struct innolux_panel *innolux = to_innolux_panel(panel);

 	if (!innolux->enabled)
 		return 0;

 	innolux->backlight->props.power = FB_BLANK_POWERDOWN;
 	backlight_update_status(innolux->backlight);

 	innolux->enabled = false;

 	return 0;
 }

 static int innolux_panel_unprepare(struct drm_panel *panel)
 {
 	struct innolux_panel *innolux = to_innolux_panel(panel);
 	int err;

 	if (!innolux->prepared)
 		return 0;

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

 	err = mipi_dsi_dcs_enter_sleep_mode(innolux->link);
 	if (err < 0) {
 		DRM_DEV_ERROR(panel->dev, "failed to enter sleep mode: %d\n",
 			      err);
 		return err;
 	}

 	gpiod_set_value_cansleep(innolux->enable_gpio, 0);

 	/* T8: 80ms - 1000ms */
 	msleep(80);

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

 	innolux->prepared = false;

 	return 0;
 }

 static int innolux_panel_prepare(struct drm_panel *panel)
 {
 	struct innolux_panel *innolux = to_innolux_panel(panel);
 	int err, regulator_err;

 	if (innolux->prepared)
 		return 0;

 	gpiod_set_value_cansleep(innolux->enable_gpio, 0);

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

 	/* T2: 15ms - 1000ms */
 	usleep_range(15000, 16000);

 	gpiod_set_value_cansleep(innolux->enable_gpio, 1);

 	/* T4: 15ms - 1000ms */
 	usleep_range(15000, 16000);

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

 	/* T6: 120ms - 1000ms*/
 	msleep(120);

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

 	/* T7: 5ms */
 	usleep_range(5000, 6000);

 	innolux->prepared = true;

 	return 0;

 poweroff:
 	regulator_err = regulator_disable(innolux->supply);
 	if (regulator_err)
 		DRM_DEV_ERROR(panel->dev, "failed to disable regulator: %d\n",
 			      regulator_err);

 	gpiod_set_value_cansleep(innolux->enable_gpio, 0);
 	return err;
 }

 static int innolux_panel_enable(struct drm_panel *panel)
 {
 	struct innolux_panel *innolux = to_innolux_panel(panel);
 	int ret;

 	if (innolux->enabled)
 		return 0;

 	innolux->backlight->props.power = FB_BLANK_UNBLANK;
 	ret = backlight_update_status(innolux->backlight);
 	if (ret) {
 		DRM_DEV_ERROR(panel->drm->dev,
 			      "Failed to enable backlight %d\n", ret);
 		return ret;
 	}

 	innolux->enabled = true;

 	return 0;
 }

 static const struct drm_display_mode default_mode = {
 	.clock = 56900,
 	.hdisplay = 768,
 	.hsync_start = 768 + 40,
 	.hsync_end = 768 + 40 + 40,
 	.htotal = 768 + 40 + 40 + 40,
 	.vdisplay = 1024,
 	.vsync_start = 1024 + 20,
 	.vsync_end = 1024 + 20 + 4,
 	.vtotal = 1024 + 20 + 4 + 20,
 	.vrefresh = 60,
 };

 static int innolux_panel_get_modes(struct drm_panel *panel)
 {
 	struct drm_display_mode *mode;

 	mode = drm_mode_duplicate(panel->drm, &default_mode);
 	if (!mode) {
 		DRM_DEV_ERROR(panel->drm->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);

 	drm_mode_probed_add(panel->connector, mode);

 	panel->connector->display_info.width_mm = 120;
 	panel->connector->display_info.height_mm = 160;
 	panel->connector->display_info.bpc = 8;

 	return 1;
 }

 static const struct drm_panel_funcs innolux_panel_funcs = {
 	.disable = innolux_panel_disable,
 	.unprepare = innolux_panel_unprepare,
 	.prepare = innolux_panel_prepare,
 	.enable = innolux_panel_enable,
 	.get_modes = innolux_panel_get_modes,
 };

 static const struct of_device_id innolux_of_match[] = {
 	{ .compatible = "innolux,p079zca", },
 	{ }
 };
 MODULE_DEVICE_TABLE(of, innolux_of_match);

 static int innolux_panel_add(struct innolux_panel *innolux)
 {
 	struct device *dev = &innolux->link->dev;
 	struct device_node *np;
 	int err;

 	innolux->supply = devm_regulator_get(dev, "power");
 	if (IS_ERR(innolux->supply))
 		return PTR_ERR(innolux->supply);

 	innolux->enable_gpio = devm_gpiod_get_optional(dev, "enable",
 						       GPIOD_OUT_HIGH);
 	if (IS_ERR(innolux->enable_gpio)) {
 		err = PTR_ERR(innolux->enable_gpio);
 		dev_dbg(dev, "failed to get enable gpio: %d\n", err);
 		innolux->enable_gpio = NULL;
 	}

 	np = of_parse_phandle(dev->of_node, "backlight", 0);
 	if (np) {
 		innolux->backlight = of_find_backlight_by_node(np);
 		of_node_put(np);

 		if (!innolux->backlight)
 			return -EPROBE_DEFER;
 	}

 	drm_panel_init(&innolux->base);
 	innolux->base.funcs = &innolux_panel_funcs;
 	innolux->base.dev = &innolux->link->dev;

 	err = drm_panel_add(&innolux->base);
 	if (err < 0)
 		goto put_backlight;

 	return 0;

 put_backlight:
 	put_device(&innolux->backlight->dev);

 	return err;
 }

 static void innolux_panel_del(struct innolux_panel *innolux)
 {
 	if (innolux->base.dev)
 		drm_panel_remove(&innolux->base);

 	put_device(&innolux->backlight->dev);
 }

 static int innolux_panel_probe(struct mipi_dsi_device *dsi)
 {
 	struct innolux_panel *innolux;
 	int err;

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

 	innolux = devm_kzalloc(&dsi->dev, sizeof(*innolux), GFP_KERNEL);
 	if (!innolux)
 		return -ENOMEM;

 	mipi_dsi_set_drvdata(dsi, innolux);

 	innolux->link = dsi;

 	err = innolux_panel_add(innolux);
 	if (err < 0)
 		return err;

 	err = mipi_dsi_attach(dsi);
 	return err;
 }

 static int innolux_panel_remove(struct mipi_dsi_device *dsi)
 {
 	struct innolux_panel *innolux = mipi_dsi_get_drvdata(dsi);
 	int err;

 	err = innolux_panel_unprepare(&innolux->base);
 	if (err < 0)
 		DRM_DEV_ERROR(&dsi->dev, "failed to unprepare panel: %d\n",
 			      err);

 	err = innolux_panel_disable(&innolux->base);
 	if (err < 0)
 		DRM_DEV_ERROR(&dsi->dev, "failed to disable panel: %d\n", err);

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

 	innolux_panel_del(innolux);

 	return 0;
 }

 static void innolux_panel_shutdown(struct mipi_dsi_device *dsi)
 {
 	struct innolux_panel *innolux = mipi_dsi_get_drvdata(dsi);

 	innolux_panel_unprepare(&innolux->base);
 	innolux_panel_disable(&innolux->base);
 }

 static struct mipi_dsi_driver innolux_panel_driver = {
 	.driver = {
 		.name = "panel-innolux-p079zca",
 		.of_match_table = innolux_of_match,
 	},
 	.probe = innolux_panel_probe,
 	.remove = innolux_panel_remove,
 	.shutdown = innolux_panel_shutdown,
 };
 module_mipi_dsi_driver(innolux_panel_driver);

 MODULE_AUTHOR("Chris Zhong <zyw@rock-chips.com>");
 MODULE_DESCRIPTION("Innolux P079ZCA panel driver");
 MODULE_LICENSE("GPL v2");
	/*
	* Copyright (c) 2017, Fuzhou Rockchip Electronics Co., Ltd
	*
	* This program is free software; you can redistribute it and/or modify
	* it under the terms of the GNU General Public License as published by
	* the Free Software Foundation; either version 2 of the License, or
	* (at your option) any later version.
	*/

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

	#include <drm/drmP.h>
	#include <drm/drm_crtc.h>
	#include <drm/drm_mipi_dsi.h>
	#include <drm/drm_panel.h>

	#include <video/mipi_display.h>

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

	struct backlight_device *backlight;
	struct regulator *supply;
	struct gpio_desc *enable_gpio;

	bool prepared;
	bool enabled;
	};

	static inline struct innolux_panel to_innolux_panel(struct drm_panel panel)
	{
	return container_of(panel, struct innolux_panel, base);
	}

	static int innolux_panel_disable(struct drm_panel *panel)
	{
	struct innolux_panel *innolux = to_innolux_panel(panel);

	if (!innolux->enabled)
	return 0;

	innolux->backlight->props.power = FB_BLANK_POWERDOWN;
	backlight_update_status(innolux->backlight);

	innolux->enabled = false;

	return 0;
	}

	static int innolux_panel_unprepare(struct drm_panel *panel)
	{
	struct innolux_panel *innolux = to_innolux_panel(panel);
	int err;

	if (!innolux->prepared)
	return 0;

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

	err = mipi_dsi_dcs_enter_sleep_mode(innolux->link);
	if (err < 0) {
	DRM_DEV_ERROR(panel->dev, "failed to enter sleep mode: %d\n",
	err);
	return err;
	}

	gpiod_set_value_cansleep(innolux->enable_gpio, 0);

	/* T8: 80ms - 1000ms */
	msleep(80);

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

	innolux->prepared = false;

	return 0;
	}

	static int innolux_panel_prepare(struct drm_panel *panel)
	{
	struct innolux_panel *innolux = to_innolux_panel(panel);
	int err, regulator_err;

	if (innolux->prepared)
	return 0;

	gpiod_set_value_cansleep(innolux->enable_gpio, 0);

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

	/* T2: 15ms - 1000ms */
	usleep_range(15000, 16000);

	gpiod_set_value_cansleep(innolux->enable_gpio, 1);

	/* T4: 15ms - 1000ms */
	usleep_range(15000, 16000);

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

	/* T6: 120ms - 1000ms*/
	msleep(120);

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

	/* T7: 5ms */
	usleep_range(5000, 6000);

	innolux->prepared = true;

	return 0;

	poweroff:
	regulator_err = regulator_disable(innolux->supply);
	if (regulator_err)
	DRM_DEV_ERROR(panel->dev, "failed to disable regulator: %d\n",
	regulator_err);

	gpiod_set_value_cansleep(innolux->enable_gpio, 0);
	return err;
	}

	static int innolux_panel_enable(struct drm_panel *panel)
	{
	struct innolux_panel *innolux = to_innolux_panel(panel);
	int ret;

	if (innolux->enabled)
	return 0;

	innolux->backlight->props.power = FB_BLANK_UNBLANK;
	ret = backlight_update_status(innolux->backlight);
	if (ret) {
	DRM_DEV_ERROR(panel->drm->dev,
	"Failed to enable backlight %d\n", ret);
	return ret;
	}

	innolux->enabled = true;

	return 0;
	}

	static const struct drm_display_mode default_mode = {
	.clock = 56900,
	.hdisplay = 768,
	.hsync_start = 768 + 40,
	.hsync_end = 768 + 40 + 40,
	.htotal = 768 + 40 + 40 + 40,
	.vdisplay = 1024,
	.vsync_start = 1024 + 20,
	.vsync_end = 1024 + 20 + 4,
	.vtotal = 1024 + 20 + 4 + 20,
	.vrefresh = 60,
	};

	static int innolux_panel_get_modes(struct drm_panel *panel)
	{
	struct drm_display_mode *mode;

	mode = drm_mode_duplicate(panel->drm, &default_mode);
	if (!mode) {
	DRM_DEV_ERROR(panel->drm->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);

	drm_mode_probed_add(panel->connector, mode);

	panel->connector->display_info.width_mm = 120;
	panel->connector->display_info.height_mm = 160;
	panel->connector->display_info.bpc = 8;

	return 1;
	}

	static const struct drm_panel_funcs innolux_panel_funcs = {
	.disable = innolux_panel_disable,
	.unprepare = innolux_panel_unprepare,
	.prepare = innolux_panel_prepare,
	.enable = innolux_panel_enable,
	.get_modes = innolux_panel_get_modes,
	};

	static const struct of_device_id innolux_of_match[] = {
	{ .compatible = "innolux,p079zca", },
	{ }
	};
	MODULE_DEVICE_TABLE(of, innolux_of_match);

	static int innolux_panel_add(struct innolux_panel *innolux)
	{
	struct device *dev = &innolux->link->dev;
	struct device_node *np;
	int err;

	innolux->supply = devm_regulator_get(dev, "power");
	if (IS_ERR(innolux->supply))
	return PTR_ERR(innolux->supply);

	innolux->enable_gpio = devm_gpiod_get_optional(dev, "enable",
	GPIOD_OUT_HIGH);
	if (IS_ERR(innolux->enable_gpio)) {
	err = PTR_ERR(innolux->enable_gpio);
	dev_dbg(dev, "failed to get enable gpio: %d\n", err);
	innolux->enable_gpio = NULL;
	}

	np = of_parse_phandle(dev->of_node, "backlight", 0);
	if (np) {
	innolux->backlight = of_find_backlight_by_node(np);
	of_node_put(np);

	if (!innolux->backlight)
	return -EPROBE_DEFER;
	}

	drm_panel_init(&innolux->base);
	innolux->base.funcs = &innolux_panel_funcs;
	innolux->base.dev = &innolux->link->dev;

	err = drm_panel_add(&innolux->base);
	if (err < 0)
	goto put_backlight;

	return 0;

	put_backlight:
	put_device(&innolux->backlight->dev);

	return err;
	}

	static void innolux_panel_del(struct innolux_panel *innolux)
	{
	if (innolux->base.dev)
	drm_panel_remove(&innolux->base);

	put_device(&innolux->backlight->dev);
	}

	static int innolux_panel_probe(struct mipi_dsi_device *dsi)
	{
	struct innolux_panel *innolux;
	int err;

	dsi->lanes = 4;
	dsi->format = MIPI_DSI_FMT_RGB888;
	dsi->mode_flags = MIPI_DSI_MODE_VIDEO \| MIPI_DSI_MODE_VIDEO_SYNC_PULSE \|
	MIPI_DSI_MODE_LPM;

	innolux = devm_kzalloc(&dsi->dev, sizeof(*innolux), GFP_KERNEL);
	if (!innolux)
	return -ENOMEM;

	mipi_dsi_set_drvdata(dsi, innolux);

	innolux->link = dsi;

	err = innolux_panel_add(innolux);
	if (err < 0)
	return err;

	err = mipi_dsi_attach(dsi);
	return err;
	}

	static int innolux_panel_remove(struct mipi_dsi_device *dsi)
	{
	struct innolux_panel *innolux = mipi_dsi_get_drvdata(dsi);
	int err;

	err = innolux_panel_unprepare(&innolux->base);
	if (err < 0)
	DRM_DEV_ERROR(&dsi->dev, "failed to unprepare panel: %d\n",
	err);

	err = innolux_panel_disable(&innolux->base);
	if (err < 0)
	DRM_DEV_ERROR(&dsi->dev, "failed to disable panel: %d\n", err);

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

	innolux_panel_del(innolux);

	return 0;
	}

	static void innolux_panel_shutdown(struct mipi_dsi_device *dsi)
	{
	struct innolux_panel *innolux = mipi_dsi_get_drvdata(dsi);

	innolux_panel_unprepare(&innolux->base);
	innolux_panel_disable(&innolux->base);
	}

	static struct mipi_dsi_driver innolux_panel_driver = {
	.driver = {
	.name = "panel-innolux-p079zca",
	.of_match_table = innolux_of_match,
	},
	.probe = innolux_panel_probe,
	.remove = innolux_panel_remove,
	.shutdown = innolux_panel_shutdown,
	};
	module_mipi_dsi_driver(innolux_panel_driver);

	MODULE_AUTHOR("Chris Zhong <zyw@rock-chips.com>");
	MODULE_DESCRIPTION("Innolux P079ZCA panel driver");
	MODULE_LICENSE("GPL v2");