target/msm8916/target_display.c - kernel/lk - Gitiles

 /* Copyright (c) 2013-2014, The Linux Foundation. All rights reserved.
  *
  * Redistribution and use in source and binary forms, with or without
  * modification, are permitted provided that the following conditions
  * are met:
  *  * Redistributions of source code must retain the above copyright
  *    notice, this list of conditions and the following disclaimer.
  *  * Redistributions in binary form must reproduce the above copyright
  *    notice, this list of conditions and the following disclaimer in
  *    the documentation and/or other materials provided with the
  *    distribution.
  *  * Neither the name of The Linux Foundation nor the names of its
  *    contributors may be used to endorse or promote products derived
  *    from this software without specific prior written permission.
  *
  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  * SUCH DAMAGE.
  */

 #include <debug.h>
 #include <smem.h>
 #include <err.h>
 #include <msm_panel.h>
 #include <mipi_dsi.h>
 #include <pm8x41.h>
 #include <pm8x41_wled.h>
 #include <board.h>
 #include <mdp5.h>
 #include <scm.h>
 #include <platform/gpio.h>
 #include <platform/iomap.h>
 #include <target/display.h>
 #include <i2c_qup.h>
 #include <blsp_qup.h>

 #include "include/panel.h"
 #include "include/display_resource.h"

 #define VCO_DELAY_USEC 1000
 #define GPIO_STATE_LOW 0
 #define GPIO_STATE_HIGH 2
 #define RESET_GPIO_SEQ_LEN 3
 #define PWM_DUTY_US 13
 #define PWM_PERIOD_US 27

 static void mdss_dsi_uniphy_pll_sw_reset_8916(uint32_t pll_base)
 {
 	writel(0x01, pll_base + 0x0068); /* PLL TEST CFG */
 	mdelay(1);
 	writel(0x00, pll_base + 0x0068); /* PLL TEST CFG */
 	mdelay(1);
 }

 static uint32_t dsi_pll_enable_seq_8916(uint32_t pll_base)
 {
 	uint32_t pll_locked = 0;

 	writel(0x01, pll_base + 0x0068); /* PLL TEST CFG */
 	udelay(1);
 	writel(0x00, pll_base + 0x0068); /* PLL TEST CFG */

 	/*
 	 * Add hardware recommended delays between register writes for
 	 * the updates to take effect. These delays are necessary for the
 	 * PLL to successfully lock
 	 */
 	writel(0x34, pll_base + 0x0070); /* CAL CFG1*/
 	udelay(1);
 	writel(0x01, pll_base + 0x0020); /* GLB CFG */
 	udelay(1);
 	writel(0x05, pll_base + 0x0020); /* GLB CFG */
 	udelay(1);
 	writel(0x0f, pll_base + 0x0020); /* GLB CFG */
 	udelay(1);

 	writel(0x04, pll_base + 0x0064); /* LKDetect CFG2 */
 	udelay(1);
 	writel(0x05, pll_base + 0x0064); /* LKDetect CFG2 */
 	udelay(512);
 	pll_locked = readl(pll_base + 0x00c0) & 0x01;

 	return pll_locked;
 }

 int target_backlight_ctrl(struct backlight *bl, uint8_t enable)
 {
 	struct pm8x41_mpp mpp;
 	int rc;

 	if (bl->bl_interface_type == BL_DCS)
 		return 0;

 	mpp.base = PM8x41_MMP4_BASE;
 	mpp.vin = MPP_VIN0;
 	if (enable) {
 		pm_pwm_enable(false);
 		rc = pm_pwm_config(PWM_DUTY_US, PWM_PERIOD_US);
 		if (rc < 0)
 			mpp.mode = MPP_HIGH;
 		else {
 			mpp.mode = MPP_DTEST1;
 			pm_pwm_enable(true);
 		}
 		pm8x41_config_output_mpp(&mpp);
 		pm8x41_enable_mpp(&mpp, MPP_ENABLE);
 	} else {
 		pm_pwm_enable(false);
 		pm8x41_enable_mpp(&mpp, MPP_DISABLE);
 	}
 	mdelay(20);
 	return 0;
 }

 int target_panel_clock(uint8_t enable, struct msm_panel_info *pinfo)
 {
 	int32_t ret = 0;
 	struct mdss_dsi_pll_config *pll_data;
 	dprintf(SPEW, "target_panel_clock\n");

 	pll_data = pinfo->mipi.dsi_pll_config;
 	pll_data->vco_delay = VCO_DELAY_USEC;

 	if (enable) {
 		mdp_gdsc_ctrl(enable);
 		mdss_bus_clocks_enable();
 		mdp_clock_enable();
 		ret = restore_secure_cfg(SECURE_DEVICE_MDSS);
 		if (ret) {
 			dprintf(CRITICAL,
 				"%s: Failed to restore MDP security configs",
 				__func__);
 			mdp_clock_disable();
 			mdss_bus_clocks_disable();
 			mdp_gdsc_ctrl(0);
 			return ret;
 		}
 		mdss_dsi_uniphy_pll_sw_reset_8916(DSI0_PLL_BASE);
 		mdss_dsi_auto_pll_config(DSI0_PLL_BASE,
 						MIPI_DSI0_BASE, pll_data);
 		if (!dsi_pll_enable_seq_8916(DSI0_PLL_BASE))
 			dprintf(CRITICAL, "Not able to enable the pll\n");
 		gcc_dsi_clocks_enable(pinfo->mipi.dual_dsi, pll_data->pclk_m,
 				pll_data->pclk_n,
 				pll_data->pclk_d);
 	} else if(!target_cont_splash_screen()) {
 		gcc_dsi_clocks_disable(pinfo->mipi.dual_dsi);
 		mdp_clock_disable();
 		mdss_bus_clocks_disable();
 		mdp_gdsc_ctrl(enable);
 	}

 	return 0;
 }

 #define QRD_LCD_I2C_ADDRESS		0x3E
 #define QRD_LCD_VPOS_ADDRESS		0x00
 #define QRD_LCD_VNEG_ADDRESS		0x01
 #define QRD_LCD_DIS_ADDRESS		0x03
 #define QRD_LCD_CONTROL_ADDRESS		0xFF

 static struct qup_i2c_dev  *i2c_dev;
 static int qrd_lcd_i2c_read(uint8_t addr)
 {
 	int ret = 0;
 	/* Create a i2c_msg buffer, that is used to put the controller into read
 	   mode and then to read some data. */
 	struct i2c_msg msg_buf[] = {
 		{QRD_LCD_I2C_ADDRESS, I2C_M_WR, 1, &addr},
 		{QRD_LCD_I2C_ADDRESS, I2C_M_RD, 1, &ret}
 	};

 	ret = qup_i2c_xfer(i2c_dev, msg_buf, 2);
 	if(ret < 0) {
 		dprintf(CRITICAL, "qup_i2c_xfer error %d\n", ret);
 		return ret;
 	}
 	return 0;
 }

 static int qrd_lcd_i2c_write(uint8_t addr, uint8_t val)
 {
 	int ret = 0;
 	uint8_t data_buf[] = { addr, val };

 	/* Create a i2c_msg buffer, that is used to put the controller into write
 	   mode and then to write some data. */
 	struct i2c_msg msg_buf[] = { {QRD_LCD_I2C_ADDRESS,
 				      I2C_M_WR, 2, data_buf}
 	};

 	ret = qup_i2c_xfer(i2c_dev, msg_buf, 1);
 	if(ret < 0) {
 		dprintf(CRITICAL, "qup_i2c_xfer error %d\n", ret);
 		return ret;
 	}
 	return 0;
 }

 static int target_panel_reset_skuh(uint8_t enable)
 {
 	int ret = NO_ERROR;
 	if (enable) {
 		/* for tps65132 ENP pin */
 		gpio_tlmm_config(enp_gpio.pin_id, 0,
 			enp_gpio.pin_direction, enp_gpio.pin_pull,
 			enp_gpio.pin_strength,
 			enp_gpio.pin_state);
 		gpio_set_dir(enp_gpio.pin_id, 2);

 		/* for tps65132 ENN pin*/
 		gpio_tlmm_config(enn_gpio.pin_id, 0,
 			enn_gpio.pin_direction, enn_gpio.pin_pull,
 			enn_gpio.pin_strength,
 			enn_gpio.pin_state);
 		gpio_set_dir(enn_gpio.pin_id, 2);

 		i2c_dev = qup_blsp_i2c_init(BLSP_ID_1, QUP_ID_1, 100000, 19200000);
 		if(!i2c_dev) {
 			dprintf(CRITICAL, "qup_blsp_i2c_init failed \n");
 			ASSERT(0);
 		}

 		ret = qrd_lcd_i2c_write(QRD_LCD_VPOS_ADDRESS, 0x0E); /* 5.4V */
 		if (ret) {
 			dprintf(CRITICAL, "VPOS Register: I2C Write failure\n");
 		}

 		ret = qrd_lcd_i2c_write(QRD_LCD_VNEG_ADDRESS, 0x0E); /* -5.4V */
 		if (ret) {
 			dprintf(CRITICAL, "VNEG Register: I2C write failure\n");
 		}

 		ret = qrd_lcd_i2c_write(QRD_LCD_DIS_ADDRESS, 0x0F);
 		if (ret) {
 			dprintf(CRITICAL, "Apps freq DIS Register: I2C write failure\n");
 		}

 		ret = qrd_lcd_i2c_write(QRD_LCD_CONTROL_ADDRESS, 0xF0);
 		if (ret) {
 			dprintf(CRITICAL, "Control Register: I2C write failure\n");
 		}
 	} else {
 		gpio_set_dir(enp_gpio.pin_id, 0); /* ENP */
 		gpio_set_dir(enn_gpio.pin_id, 0); /* ENN */
 	}
 	return 0;
 }

 static int target_panel_reset_skuk(uint8_t enable)
 {
 	if (enable) {
 		/* for tps65132 ENP pin*/
 		gpio_tlmm_config(enp_gpio_skuk.pin_id, 0,
 			enp_gpio_skuk.pin_direction, enp_gpio_skuk.pin_pull,
 			enp_gpio_skuk.pin_strength, enp_gpio_skuk.pin_state);
 		gpio_set_dir(enp_gpio_skuk.pin_id, 2);

 		/* for tps65132 ENN pin*/
 		gpio_tlmm_config(enn_gpio_skuk.pin_id, 0,
 			enn_gpio_skuk.pin_direction, enn_gpio_skuk.pin_pull,
 			enn_gpio_skuk.pin_strength, enn_gpio_skuk.pin_state);
 		gpio_set_dir(enn_gpio_skuk.pin_id, 2);

 		/* configure backlight gpio for SKUK */
 		gpio_tlmm_config(bkl_gpio_skuk.pin_id, 0,
 			bkl_gpio_skuk.pin_direction, bkl_gpio_skuk.pin_pull,
 			bkl_gpio_skuk.pin_strength, bkl_gpio_skuk.pin_state);
 		gpio_set_dir(bkl_gpio_skuk.pin_id, 2);
 	} else {
 		gpio_set_dir(bkl_gpio_skuk.pin_id, 0);
 		gpio_set_dir(enp_gpio_skuk.pin_id, 0); /* ENP */
 		gpio_set_dir(enn_gpio_skuk.pin_id, 0); /* ENN */
 	}
 	return 0;
 }

 int target_panel_reset(uint8_t enable, struct panel_reset_sequence *resetseq,
 						struct msm_panel_info *pinfo)
 {
 	int ret = NO_ERROR;
 	uint32_t hw_id = board_hardware_id();
 	uint32_t hw_subtype = board_hardware_subtype();

 	if (enable) {
 		if (pinfo->mipi.use_enable_gpio) {
 			/* set enable gpio pin for SKUT1 */
 			if ((hw_id == HW_PLATFORM_QRD) &&
 				 (hw_subtype == HW_PLATFORM_SUBTYPE_SKUT1))
 				enable_gpio = enable_gpio_skut1;
 			gpio_tlmm_config(enable_gpio.pin_id, 0,
 				enable_gpio.pin_direction, enable_gpio.pin_pull,
 				enable_gpio.pin_strength,
 				enable_gpio.pin_state);

 			gpio_set_dir(enable_gpio.pin_id, 2);
 		}

 		if (platform_is_msm8939()) {
 			if ((hw_id == HW_PLATFORM_QRD) &&
 				 (hw_subtype == HW_PLATFORM_SUBTYPE_SKUK))
 				target_panel_reset_skuk(enable);
 		} else { /* msm8916 */
 			if ((hw_id == HW_PLATFORM_QRD) &&
 				 (hw_subtype == HW_PLATFORM_SUBTYPE_SKUH))
 				target_panel_reset_skuh(enable);
 		}

 		if (hw_id == HW_PLATFORM_MTP || hw_id == HW_PLATFORM_SURF) {
 			/* configure backlight gpio for MTP & CDP */
 			gpio_tlmm_config(bkl_gpio.pin_id, 0,
 				bkl_gpio.pin_direction, bkl_gpio.pin_pull,
 				bkl_gpio.pin_strength, bkl_gpio.pin_state);
 			gpio_set_dir(bkl_gpio.pin_id, 2);
 		}

 		gpio_tlmm_config(reset_gpio.pin_id, 0,
 				reset_gpio.pin_direction, reset_gpio.pin_pull,
 				reset_gpio.pin_strength, reset_gpio.pin_state);

 		gpio_set_dir(reset_gpio.pin_id, 2);

 		/* reset */
 		for (int i = 0; i < RESET_GPIO_SEQ_LEN; i++) {
 			if (resetseq->pin_state[i] == GPIO_STATE_LOW)
 				gpio_set_dir(reset_gpio.pin_id, GPIO_STATE_LOW);
 			else
 				gpio_set_dir(reset_gpio.pin_id, GPIO_STATE_HIGH);
 			mdelay(resetseq->sleep[i]);
 		}
 	} else if(!target_cont_splash_screen()) {
 		gpio_set_dir(reset_gpio.pin_id, 0);
 		if (pinfo->mipi.use_enable_gpio)
 			gpio_set_dir(enable_gpio.pin_id, 0);

 		if (platform_is_msm8939()) {
 			if ((hw_id == HW_PLATFORM_QRD) &&
 				 (hw_subtype == HW_PLATFORM_SUBTYPE_SKUK))
 				target_panel_reset_skuk(enable);
 		} else { /* msm8916 */
 			if ((hw_id == HW_PLATFORM_QRD) &&
 				 (hw_subtype == HW_PLATFORM_SUBTYPE_SKUH))
 				target_panel_reset_skuh(enable);
 		}
 	}

 	return ret;
 }

 int target_ldo_ctrl(uint8_t enable, struct msm_panel_info *pinfo)
 {
 	/*
 	 * The PMIC regulators needed for display are enabled in SBL.
 	 * There is no access to the regulators is LK.
 	 */
 	return NO_ERROR;
 }

 bool target_display_panel_node(char *panel_name, char *pbuf, uint16_t buf_size)
 {
 	return gcdb_display_cmdline_arg(panel_name, pbuf, buf_size);
 }

 void target_display_init(const char *panel_name)
 {
 	uint32_t panel_loop = 0;
 	uint32_t ret = 0;

 	panel_name += strspn(panel_name, " ");
 	if ((!strcmp(panel_name, NO_PANEL_CONFIG))
 			|| (!strcmp(panel_name, SIM_VIDEO_PANEL))) {
 		dprintf(INFO, "Selected panel: %s\nSkip panel configuration\n",
 								panel_name);
 		return;
 	}

 	do {
 		target_force_cont_splash_disable(false);
 		ret = gcdb_display_init(panel_name, MDP_REV_50, MIPI_FB_ADDR);
 		if (!ret || ret == ERR_NOT_SUPPORTED) {
 			break;
 		} else {
 			target_force_cont_splash_disable(true);
 			msm_display_off();
 		}
 	} while (++panel_loop <= oem_panel_max_auto_detect_panels());
 }

 void target_display_shutdown(void)
 {
 	gcdb_display_shutdown();
 }
	/* Copyright (c) 2013-2014, The Linux Foundation. All rights reserved.
	*
	* Redistribution and use in source and binary forms, with or without
	* modification, are permitted provided that the following conditions
	* are met:
	* * Redistributions of source code must retain the above copyright
	* notice, this list of conditions and the following disclaimer.
	* * Redistributions in binary form must reproduce the above copyright
	* notice, this list of conditions and the following disclaimer in
	* the documentation and/or other materials provided with the
	* distribution.
	* * Neither the name of The Linux Foundation nor the names of its
	* contributors may be used to endorse or promote products derived
	* from this software without specific prior written permission.
	*
	* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
	* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
	* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
	* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
	* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
	* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
	* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
	* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
	* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
	* OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
	* SUCH DAMAGE.
	*/

	#include <debug.h>
	#include <smem.h>
	#include <err.h>
	#include <msm_panel.h>
	#include <mipi_dsi.h>
	#include <pm8x41.h>
	#include <pm8x41_wled.h>
	#include <board.h>
	#include <mdp5.h>
	#include <scm.h>
	#include <platform/gpio.h>
	#include <platform/iomap.h>
	#include <target/display.h>
	#include <i2c_qup.h>
	#include <blsp_qup.h>

	#include "include/panel.h"
	#include "include/display_resource.h"

	#define VCO_DELAY_USEC 1000
	#define GPIO_STATE_LOW 0
	#define GPIO_STATE_HIGH 2
	#define RESET_GPIO_SEQ_LEN 3
	#define PWM_DUTY_US 13
	#define PWM_PERIOD_US 27

	static void mdss_dsi_uniphy_pll_sw_reset_8916(uint32_t pll_base)
	{
	writel(0x01, pll_base + 0x0068); /* PLL TEST CFG */
	mdelay(1);
	writel(0x00, pll_base + 0x0068); /* PLL TEST CFG */
	mdelay(1);
	}

	static uint32_t dsi_pll_enable_seq_8916(uint32_t pll_base)
	{
	uint32_t pll_locked = 0;

	writel(0x01, pll_base + 0x0068); /* PLL TEST CFG */
	udelay(1);
	writel(0x00, pll_base + 0x0068); /* PLL TEST CFG */

	/*
	* Add hardware recommended delays between register writes for
	* the updates to take effect. These delays are necessary for the
	* PLL to successfully lock
	*/
	writel(0x34, pll_base + 0x0070); /* CAL CFG1*/
	udelay(1);
	writel(0x01, pll_base + 0x0020); /* GLB CFG */
	udelay(1);
	writel(0x05, pll_base + 0x0020); /* GLB CFG */
	udelay(1);
	writel(0x0f, pll_base + 0x0020); /* GLB CFG */
	udelay(1);

	writel(0x04, pll_base + 0x0064); /* LKDetect CFG2 */
	udelay(1);
	writel(0x05, pll_base + 0x0064); /* LKDetect CFG2 */
	udelay(512);
	pll_locked = readl(pll_base + 0x00c0) & 0x01;

	return pll_locked;
	}

	int target_backlight_ctrl(struct backlight *bl, uint8_t enable)
	{
	struct pm8x41_mpp mpp;
	int rc;

	if (bl->bl_interface_type == BL_DCS)
	return 0;

	mpp.base = PM8x41_MMP4_BASE;
	mpp.vin = MPP_VIN0;
	if (enable) {
	pm_pwm_enable(false);
	rc = pm_pwm_config(PWM_DUTY_US, PWM_PERIOD_US);
	if (rc < 0)
	mpp.mode = MPP_HIGH;
	else {
	mpp.mode = MPP_DTEST1;
	pm_pwm_enable(true);
	}
	pm8x41_config_output_mpp(&mpp);
	pm8x41_enable_mpp(&mpp, MPP_ENABLE);
	} else {
	pm_pwm_enable(false);
	pm8x41_enable_mpp(&mpp, MPP_DISABLE);
	}
	mdelay(20);
	return 0;
	}

	int target_panel_clock(uint8_t enable, struct msm_panel_info *pinfo)
	{
	int32_t ret = 0;
	struct mdss_dsi_pll_config *pll_data;
	dprintf(SPEW, "target_panel_clock\n");

	pll_data = pinfo->mipi.dsi_pll_config;
	pll_data->vco_delay = VCO_DELAY_USEC;

	if (enable) {
	mdp_gdsc_ctrl(enable);
	mdss_bus_clocks_enable();
	mdp_clock_enable();
	ret = restore_secure_cfg(SECURE_DEVICE_MDSS);
	if (ret) {
	dprintf(CRITICAL,
	"%s: Failed to restore MDP security configs",
	__func__);
	mdp_clock_disable();
	mdss_bus_clocks_disable();
	mdp_gdsc_ctrl(0);
	return ret;
	}
	mdss_dsi_uniphy_pll_sw_reset_8916(DSI0_PLL_BASE);
	mdss_dsi_auto_pll_config(DSI0_PLL_BASE,
	MIPI_DSI0_BASE, pll_data);
	if (!dsi_pll_enable_seq_8916(DSI0_PLL_BASE))
	dprintf(CRITICAL, "Not able to enable the pll\n");
	gcc_dsi_clocks_enable(pinfo->mipi.dual_dsi, pll_data->pclk_m,
	pll_data->pclk_n,
	pll_data->pclk_d);
	} else if(!target_cont_splash_screen()) {
	gcc_dsi_clocks_disable(pinfo->mipi.dual_dsi);
	mdp_clock_disable();
	mdss_bus_clocks_disable();
	mdp_gdsc_ctrl(enable);
	}

	return 0;
	}

	#define QRD_LCD_I2C_ADDRESS 0x3E
	#define QRD_LCD_VPOS_ADDRESS 0x00
	#define QRD_LCD_VNEG_ADDRESS 0x01
	#define QRD_LCD_DIS_ADDRESS 0x03
	#define QRD_LCD_CONTROL_ADDRESS 0xFF

	static struct qup_i2c_dev *i2c_dev;
	static int qrd_lcd_i2c_read(uint8_t addr)
	{
	int ret = 0;
	/* Create a i2c_msg buffer, that is used to put the controller into read
	mode and then to read some data. */
	struct i2c_msg msg_buf[] = {
	{QRD_LCD_I2C_ADDRESS, I2C_M_WR, 1, &addr},
	{QRD_LCD_I2C_ADDRESS, I2C_M_RD, 1, &ret}
	};

	ret = qup_i2c_xfer(i2c_dev, msg_buf, 2);
	if(ret < 0) {
	dprintf(CRITICAL, "qup_i2c_xfer error %d\n", ret);
	return ret;
	}
	return 0;
	}

	static int qrd_lcd_i2c_write(uint8_t addr, uint8_t val)
	{
	int ret = 0;
	uint8_t data_buf[] = { addr, val };

	/* Create a i2c_msg buffer, that is used to put the controller into write
	mode and then to write some data. */
	struct i2c_msg msg_buf[] = { {QRD_LCD_I2C_ADDRESS,
	I2C_M_WR, 2, data_buf}
	};

	ret = qup_i2c_xfer(i2c_dev, msg_buf, 1);
	if(ret < 0) {
	dprintf(CRITICAL, "qup_i2c_xfer error %d\n", ret);
	return ret;
	}
	return 0;
	}

	static int target_panel_reset_skuh(uint8_t enable)
	{
	int ret = NO_ERROR;
	if (enable) {
	/* for tps65132 ENP pin */
	gpio_tlmm_config(enp_gpio.pin_id, 0,
	enp_gpio.pin_direction, enp_gpio.pin_pull,
	enp_gpio.pin_strength,
	enp_gpio.pin_state);
	gpio_set_dir(enp_gpio.pin_id, 2);

	/* for tps65132 ENN pin*/
	gpio_tlmm_config(enn_gpio.pin_id, 0,
	enn_gpio.pin_direction, enn_gpio.pin_pull,
	enn_gpio.pin_strength,
	enn_gpio.pin_state);
	gpio_set_dir(enn_gpio.pin_id, 2);

	i2c_dev = qup_blsp_i2c_init(BLSP_ID_1, QUP_ID_1, 100000, 19200000);
	if(!i2c_dev) {
	dprintf(CRITICAL, "qup_blsp_i2c_init failed \n");
	ASSERT(0);
	}

	ret = qrd_lcd_i2c_write(QRD_LCD_VPOS_ADDRESS, 0x0E); /* 5.4V */
	if (ret) {
	dprintf(CRITICAL, "VPOS Register: I2C Write failure\n");
	}

	ret = qrd_lcd_i2c_write(QRD_LCD_VNEG_ADDRESS, 0x0E); /* -5.4V */
	if (ret) {
	dprintf(CRITICAL, "VNEG Register: I2C write failure\n");
	}

	ret = qrd_lcd_i2c_write(QRD_LCD_DIS_ADDRESS, 0x0F);
	if (ret) {
	dprintf(CRITICAL, "Apps freq DIS Register: I2C write failure\n");
	}

	ret = qrd_lcd_i2c_write(QRD_LCD_CONTROL_ADDRESS, 0xF0);
	if (ret) {
	dprintf(CRITICAL, "Control Register: I2C write failure\n");
	}
	} else {
	gpio_set_dir(enp_gpio.pin_id, 0); /* ENP */
	gpio_set_dir(enn_gpio.pin_id, 0); /* ENN */
	}
	return 0;
	}

	static int target_panel_reset_skuk(uint8_t enable)
	{
	if (enable) {
	/* for tps65132 ENP pin*/
	gpio_tlmm_config(enp_gpio_skuk.pin_id, 0,
	enp_gpio_skuk.pin_direction, enp_gpio_skuk.pin_pull,
	enp_gpio_skuk.pin_strength, enp_gpio_skuk.pin_state);
	gpio_set_dir(enp_gpio_skuk.pin_id, 2);

	/* for tps65132 ENN pin*/
	gpio_tlmm_config(enn_gpio_skuk.pin_id, 0,
	enn_gpio_skuk.pin_direction, enn_gpio_skuk.pin_pull,
	enn_gpio_skuk.pin_strength, enn_gpio_skuk.pin_state);
	gpio_set_dir(enn_gpio_skuk.pin_id, 2);

	/* configure backlight gpio for SKUK */
	gpio_tlmm_config(bkl_gpio_skuk.pin_id, 0,
	bkl_gpio_skuk.pin_direction, bkl_gpio_skuk.pin_pull,
	bkl_gpio_skuk.pin_strength, bkl_gpio_skuk.pin_state);
	gpio_set_dir(bkl_gpio_skuk.pin_id, 2);
	} else {
	gpio_set_dir(bkl_gpio_skuk.pin_id, 0);
	gpio_set_dir(enp_gpio_skuk.pin_id, 0); /* ENP */
	gpio_set_dir(enn_gpio_skuk.pin_id, 0); /* ENN */
	}
	return 0;
	}

	int target_panel_reset(uint8_t enable, struct panel_reset_sequence *resetseq,
	struct msm_panel_info *pinfo)
	{
	int ret = NO_ERROR;
	uint32_t hw_id = board_hardware_id();
	uint32_t hw_subtype = board_hardware_subtype();

	if (enable) {
	if (pinfo->mipi.use_enable_gpio) {
	/* set enable gpio pin for SKUT1 */
	if ((hw_id == HW_PLATFORM_QRD) &&
	(hw_subtype == HW_PLATFORM_SUBTYPE_SKUT1))
	enable_gpio = enable_gpio_skut1;
	gpio_tlmm_config(enable_gpio.pin_id, 0,
	enable_gpio.pin_direction, enable_gpio.pin_pull,
	enable_gpio.pin_strength,
	enable_gpio.pin_state);

	gpio_set_dir(enable_gpio.pin_id, 2);
	}

	if (platform_is_msm8939()) {
	if ((hw_id == HW_PLATFORM_QRD) &&
	(hw_subtype == HW_PLATFORM_SUBTYPE_SKUK))
	target_panel_reset_skuk(enable);
	} else { /* msm8916 */
	if ((hw_id == HW_PLATFORM_QRD) &&
	(hw_subtype == HW_PLATFORM_SUBTYPE_SKUH))
	target_panel_reset_skuh(enable);
	}

	if (hw_id == HW_PLATFORM_MTP \|\| hw_id == HW_PLATFORM_SURF) {
	/* configure backlight gpio for MTP & CDP */
	gpio_tlmm_config(bkl_gpio.pin_id, 0,
	bkl_gpio.pin_direction, bkl_gpio.pin_pull,
	bkl_gpio.pin_strength, bkl_gpio.pin_state);
	gpio_set_dir(bkl_gpio.pin_id, 2);
	}

	gpio_tlmm_config(reset_gpio.pin_id, 0,
	reset_gpio.pin_direction, reset_gpio.pin_pull,
	reset_gpio.pin_strength, reset_gpio.pin_state);

	gpio_set_dir(reset_gpio.pin_id, 2);

	/* reset */
	for (int i = 0; i < RESET_GPIO_SEQ_LEN; i++) {
	if (resetseq->pin_state[i] == GPIO_STATE_LOW)
	gpio_set_dir(reset_gpio.pin_id, GPIO_STATE_LOW);
	else
	gpio_set_dir(reset_gpio.pin_id, GPIO_STATE_HIGH);
	mdelay(resetseq->sleep[i]);
	}
	} else if(!target_cont_splash_screen()) {
	gpio_set_dir(reset_gpio.pin_id, 0);
	if (pinfo->mipi.use_enable_gpio)
	gpio_set_dir(enable_gpio.pin_id, 0);

	if (platform_is_msm8939()) {
	if ((hw_id == HW_PLATFORM_QRD) &&
	(hw_subtype == HW_PLATFORM_SUBTYPE_SKUK))
	target_panel_reset_skuk(enable);
	} else { /* msm8916 */
	if ((hw_id == HW_PLATFORM_QRD) &&
	(hw_subtype == HW_PLATFORM_SUBTYPE_SKUH))
	target_panel_reset_skuh(enable);
	}
	}

	return ret;
	}

	int target_ldo_ctrl(uint8_t enable, struct msm_panel_info *pinfo)
	{
	/*
	* The PMIC regulators needed for display are enabled in SBL.
	* There is no access to the regulators is LK.
	*/
	return NO_ERROR;
	}

	bool target_display_panel_node(char panel_name, char pbuf, uint16_t buf_size)
	{
	return gcdb_display_cmdline_arg(panel_name, pbuf, buf_size);
	}

	void target_display_init(const char *panel_name)
	{
	uint32_t panel_loop = 0;
	uint32_t ret = 0;

	panel_name += strspn(panel_name, " ");
	if ((!strcmp(panel_name, NO_PANEL_CONFIG))
	\|\| (!strcmp(panel_name, SIM_VIDEO_PANEL))) {
	dprintf(INFO, "Selected panel: %s\nSkip panel configuration\n",
	panel_name);
	return;
	}

	do {
	target_force_cont_splash_disable(false);
	ret = gcdb_display_init(panel_name, MDP_REV_50, MIPI_FB_ADDR);
	if (!ret \|\| ret == ERR_NOT_SUPPORTED) {
	break;
	} else {
	target_force_cont_splash_disable(true);
	msm_display_off();
	}
	} while (++panel_loop <= oem_panel_max_auto_detect_panels());
	}

	void target_display_shutdown(void)
	{
	gcdb_display_shutdown();
	}