drivers/amlogic/media/vout/lcd/lcd_extern/i2c_ANX6862_7911.c - manifest_repos/kernel - Git at Google

 /*
  * drivers/amlogic/media/vout/lcd/lcd_extern/i2c_ANX6862_7911.c
  *
  * Copyright (C) 2017 Amlogic, Inc. All rights reserved.
  *
  * 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.
  *
  * This program is distributed in the hope that it will be useful, but WITHOUT
  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  * more details.
  *
  */

 #include <linux/kernel.h>
 #include <linux/module.h>
 #include <linux/interrupt.h>
 #include <linux/platform_device.h>
 #include <linux/i2c.h>
 #include <linux/amlogic/i2c-amlogic.h>
 #include <linux/clk.h>
 #include <linux/delay.h>
 #include <linux/slab.h>
 #include <linux/of.h>
 #include <linux/amlogic/media/vout/lcd/lcd_extern.h>
 #include "lcd_extern.h"

 #define LCD_EXTERN_NAME			"i2c_ANX6862_7911"

 #define LCD_EXTERN_I2C_ADDR		(0x20 >> 1) /* ANX6862 7bit address */
 #define LCD_EXTERN_I2C_ADDR2		(0x74 >> 1) /* ANX7911 7bit address */

 static struct lcd_extern_config_s *ext_config;
 static struct aml_lcd_extern_i2c_dev_s *i2c0_dev;
 static struct aml_lcd_extern_i2c_dev_s *i2c1_dev;


 static unsigned char ANX6862_NVM_wr[] = {0xff, 0x80};
 static unsigned char ANX7911_NVM_wr[] = {0x00, 0x0a};

 #define ANX6862_REG_CNT   12
 #define ANX7911_REG_CNT   23
 #if 0
 static unsigned char ANX6862_7911_init[] = {
 	0x00, 3, 0x01, 0x2b, 0,
 	0x00, 3, 0x02, 0x05, 0,
 	0x00, 3, 0x03, 0x00, 0,
 	0x00, 3, 0x04, 0x00, 0,
 	0x00, 3, 0x05, 0x0c, 0,
 	0x00, 3, 0x06, 0x04, 0,
 	0x00, 3, 0x07, 0x21, 0,
 	0x00, 3, 0x08, 0x0e, 0,
 	0x00, 3, 0x09, 0x04, 0,
 	0x00, 3, 0x0a, 0x00, 0,
 	0x00, 3, 0x0b, 0x04, 0,
 	0x00, 3, 0xff, 0x00, 100,

 	0x01, 3, 0x01, 0xca, 0,
 	0x01, 3, 0x02, 0x3b, 0,
 	0x01, 3, 0x03, 0x33, 0,
 	0x01, 3, 0x04, 0x05, 0,
 	0x01, 3, 0x05, 0x2c, 0,
 	0x01, 3, 0x06, 0xf2, 0,
 	0x01, 3, 0x07, 0x9c, 0,
 	0x01, 3, 0x08, 0x1b, 0,
 	0x01, 3, 0x09, 0x82, 0,
 	0x01, 3, 0x0a, 0x3d, 0,
 	0x01, 3, 0x0b, 0x20, 0,
 	0x01, 3, 0x0c, 0x11, 0,
 	0x01, 3, 0x0d, 0xc4, 0,
 	0x01, 3, 0x0e, 0x1a, 0,
 	0x01, 3, 0x0f, 0x31, 0,
 	0x01, 3, 0x10, 0x4c, 0,
 	0x01, 3, 0x11, 0x12, 0,
 	0x01, 3, 0x12, 0x90, 0,
 	0x01, 3, 0x13, 0xf7, 0,
 	0x01, 3, 0x14, 0x0c, 0,
 	0x01, 3, 0x15, 0x20, 0,
 	0x01, 3, 0x16, 0x13, 0,
 	0xff, 0,
 };
 #endif

 static int lcd_extern_reg_read(unsigned char reg, unsigned char *buf)
 {
 	struct aml_lcd_extern_i2c_dev_s *i2c_dev;
 	unsigned char tmp;
 	int ret = 0;

 	tmp = reg;
 	if (ext_config->addr_sel)
 		i2c_dev = i2c1_dev;
 	else
 		i2c_dev = i2c0_dev;
 	if (i2c_dev == NULL) {
 		EXTERR("invalid i2c device\n");
 		return -1;
 	}
 	lcd_extern_i2c_read(i2c_dev->client, &tmp, 1);
 	buf[0] = tmp;

 	return ret;
 }

 static int lcd_extern_reg_write(unsigned char reg, unsigned char value)
 {
 	struct aml_lcd_extern_i2c_dev_s *i2c_dev;
 	unsigned char tmp[2];
 	int ret = 0;

 	tmp[0] = reg;
 	tmp[1] = value;

 	if (ext_config->addr_sel)
 		i2c_dev = i2c1_dev;
 	else
 		i2c_dev = i2c0_dev;
 	if (i2c_dev == NULL) {
 		EXTERR("invalid i2c device\n");
 		return -1;
 	}
 	lcd_extern_i2c_write(i2c_dev->client, tmp, 2);

 	return ret;
 }

 static int lcd_extern_power_cmd_dynamic_size(unsigned char *table,
 		unsigned char flag)
 {
 	int i = 0, j, step = 0, max_len;
 	unsigned char type, cmd_size, type_chk, type_other;
 	struct aml_lcd_extern_i2c_dev_s *i2c_dev;
 	int delay_bypass, delay_ms, ret = 0;

 	if (table == NULL)
 		return -1;

 	max_len = ext_config->table_init_on_cnt;
 	if (flag) {
 		i2c_dev = i2c1_dev;
 		type_chk = LCD_EXT_CMD_TYPE_CMD2;
 		type_other = LCD_EXT_CMD_TYPE_CMD;
 	} else {
 		i2c_dev = i2c0_dev;
 		type_chk = LCD_EXT_CMD_TYPE_CMD;
 		type_other = LCD_EXT_CMD_TYPE_CMD2;
 	}
 	if (i2c_dev == NULL) {
 		EXTERR("invalid i2c%d device\n", flag);
 		return -1;
 	}

 	delay_bypass = 0;
 	while ((i + 1) < max_len) {
 		type = table[i];
 		if (type == LCD_EXT_CMD_TYPE_END)
 			break;
 		cmd_size = table[i+1];
 		if (cmd_size == 0)
 			goto power_cmd_dynamic_next;
 		if ((i + 2 + cmd_size) > max_len)
 			break;

 		if (type == type_chk) {
 			if (lcd_debug_print_flag) {
 				EXTPR("%s: step %d: type=0x%02x, cmd_size=%d\n",
 					__func__, step, type, table[i+1]);
 			}
 			ret = lcd_extern_i2c_write(i2c_dev->client,
 				&table[i+2], cmd_size);
 			delay_bypass = 0;
 		} else if (type == LCD_EXT_CMD_TYPE_DELAY) {
 			if (delay_bypass)
 				goto power_cmd_dynamic_next;
 			if (lcd_debug_print_flag) {
 				EXTPR("%s: step %d: type=0x%02x, cmd_size=%d\n",
 					__func__, step, type, table[i+1]);
 			}
 			delay_ms = 0;
 			for (j = 0; j < cmd_size; j++)
 				delay_ms += table[i+2+j];
 			if (delay_ms > 0)
 				mdelay(delay_ms);
 		} else if (type == type_other) {
 			delay_bypass = 1;
 		} else {
 			delay_bypass = 1;
 			EXTERR("%s(%d: %s): type 0x%02x invalid\n",
 				__func__, ext_config->index,
 				ext_config->name, type);
 		}
 power_cmd_dynamic_next:
 		i += (cmd_size + 2);
 		step++;
 	}

 	return ret;
 }

 static int lcd_extern_power_cmd_fixed_size(unsigned char *table,
 		unsigned char flag)
 {
 	int i = 0, j, step = 0, max_len;
 	unsigned char type, cmd_size, type_chk, type_other;
 	struct aml_lcd_extern_i2c_dev_s *i2c_dev;
 	int delay_bypass, delay_ms, ret = 0;

 	if (table == NULL)
 		return -1;

 	cmd_size = ext_config->cmd_size;
 	max_len = ext_config->table_init_on_cnt;
 	if (flag) {
 		i2c_dev = i2c1_dev;
 		type_chk = LCD_EXT_CMD_TYPE_CMD2;
 		type_other = LCD_EXT_CMD_TYPE_CMD;
 	} else {
 		i2c_dev = i2c0_dev;
 		type_chk = LCD_EXT_CMD_TYPE_CMD;
 		type_other = LCD_EXT_CMD_TYPE_CMD2;
 	}
 	if (i2c_dev == NULL) {
 		EXTERR("invalid i2c%d device\n", flag);
 		return -1;
 	}

 	if (cmd_size < 2) {
 		EXTERR("%s: invalid cmd_size %d\n", __func__, cmd_size);
 		return -1;
 	}

 	delay_bypass = 0;
 	while ((i + cmd_size) <= max_len) {
 		type = table[i];
 		if (type == LCD_EXT_CMD_TYPE_END)
 			break;
 		if (type == type_chk) {
 			if (lcd_debug_print_flag) {
 				EXTPR("%s: step %d: type=0x%02x, cmd_size=%d\n",
 					__func__, step, type, cmd_size);
 			}
 			ret = lcd_extern_i2c_write(i2c_dev->client,
 				&table[i+1], (cmd_size-2));
 			delay_bypass = 0;
 		} else if (type == LCD_EXT_CMD_TYPE_DELAY) {
 			if (delay_bypass)
 				goto power_cmd_fixed_next;
 			if (lcd_debug_print_flag) {
 				EXTPR("%s: step %d: type=0x%02x, cmd_size=%d\n",
 					__func__, step, type, cmd_size);
 			}
 			delay_ms = 0;
 			for (j = 0; j < (cmd_size - 1); j++)
 				delay_ms += table[i+1+j];
 			if (delay_ms > 0)
 				mdelay(delay_ms);
 		} else if (type == type_other) {
 			delay_bypass = 1;
 		} else {
 			delay_bypass = 1;
 			EXTERR("%s: %s(%d): type 0x%02x invalid\n",
 				__func__, ext_config->name,
 				ext_config->index, type);
 		}
 power_cmd_fixed_next:
 		i += cmd_size;
 		step++;
 	}

 	return ret;
 }

 static int lcd_extern_power_cmd(unsigned char flag)
 {
 	unsigned char *table;
 	unsigned char cmd_size;
 	int ret = 0;

 	table = ext_config->table_init_on;
 	cmd_size = ext_config->cmd_size;
 	if (cmd_size < 1) {
 		EXTERR("%s: cmd_size %d is invalid\n", __func__, cmd_size);
 		return -1;
 	}
 	if (table == NULL) {
 		EXTERR("%s: init_on_table is NULL\n", __func__);
 		return -1;
 	}

 	if (cmd_size == LCD_EXT_CMD_SIZE_DYNAMIC)
 		ret = lcd_extern_power_cmd_dynamic_size(table, flag);
 	else
 		ret = lcd_extern_power_cmd_fixed_size(table, flag);

 	EXTPR("%s: %s(%d): %d\n",
 		__func__, ext_config->name, ext_config->index, flag);
 	return ret;
 }

 static int lcd_extern_check_reg_dynamic_size(unsigned char *table,
 		unsigned char *chk_table, int cnt, unsigned char flag)
 {
 	int i = 0, step = 0, max_len;
 	unsigned char type, cmd_size, type_chk, reg;
 	int ret = 0;

 	if (table == NULL)
 		return -1;

 	max_len = ext_config->table_init_on_cnt;
 	type_chk = (flag) ? LCD_EXT_CMD_TYPE_CMD2 : LCD_EXT_CMD_TYPE_CMD;

 	while ((i + 1) < max_len) {
 		type = table[i];
 		if (type == LCD_EXT_CMD_TYPE_END)
 			break;
 		cmd_size = table[i+1];
 		if (cmd_size == 0) {
 			i += 2;
 			continue;
 		}
 		if ((i + 2 + cmd_size) > max_len)
 			break;

 		if (type == type_chk) {
 			reg = table[i+2];
 			if (lcd_debug_print_flag) {
 				EXTPR(
 				"%s: step %d: reg 0x%02x, val 0x%02x,0x%02x\n",
 					__func__, step,
 					reg, table[i+3], chk_table[reg]);
 			}
 			if (chk_table[reg] != table[i+3])
 				return -1;
 		}
 		i += (cmd_size + 2);
 		step++;
 	}

 	return ret;
 }

 static int lcd_extern_check_reg_fixed_size(unsigned char *table,
 		unsigned char *chk_table, int cnt, unsigned char flag)
 {
 	int i = 0, step = 0, max_len;
 	unsigned char type, cmd_size, type_chk, reg;

 	cmd_size = ext_config->cmd_size;
 	max_len = ext_config->table_init_on_cnt;
 	type_chk = (flag) ? LCD_EXT_CMD_TYPE_CMD2 : LCD_EXT_CMD_TYPE_CMD;

 	while ((i + cmd_size) <= max_len) {
 		type = table[i];
 		if (type == LCD_EXT_CMD_TYPE_END)
 			break;
 		if (type == type_chk) {
 			reg = table[i+1];
 			if (lcd_debug_print_flag) {
 				EXTPR(
 				"%s: step %d: reg 0x%02x, val 0x%02x,0x%02x\n",
 					__func__, step,
 					reg, table[i+2], chk_table[reg]);
 			}
 			if (chk_table[reg] != table[i+2])
 				return -1;
 		}
 		i += cmd_size;
 		step++;
 	}

 	return 0;
 }

 static int lcd_extern_init_check(unsigned char flag)
 {
 	unsigned char *table, *chk_table, cmd_size;
 	int cnt, ret = 0;

 	table = ext_config->table_init_on;
 	cmd_size = ext_config->cmd_size;
 	cnt = (flag) ? ANX7911_REG_CNT : ANX6862_REG_CNT;
 	if (cmd_size < 1) {
 		EXTERR("%s: cmd_size %d is invalid\n", __func__, cmd_size);
 		return -1;
 	}
 	if (table == NULL) {
 		EXTERR("%s: init_table %d is NULL\n", __func__, flag);
 		return -1;
 	}

 	chk_table = kcalloc(cnt, sizeof(unsigned char), GFP_KERNEL);
 	if (chk_table == NULL) {
 		EXTERR("%s: failed to alloc chk_table, not enough memory\n",
 			LCD_EXTERN_NAME);
 		return -1;
 	}
 	memset(chk_table, 0, cnt);

 	ret = lcd_extern_i2c_read(i2c0_dev->client, chk_table, cnt);
 	if (ret) {
 		EXTERR("%s: i2c read error\n", __func__);
 		return -1;
 	}

 	if (cmd_size == LCD_EXT_CMD_SIZE_DYNAMIC) {
 		ret = lcd_extern_check_reg_dynamic_size(table, chk_table,
 			cnt, flag);
 	} else {
 		ret = lcd_extern_check_reg_fixed_size(table, chk_table,
 			cnt, flag);
 	}

 	return ret;
 }

 static int lcd_extern_power_on(void)
 {
 	int ret;

 	lcd_extern_pinmux_set(1);

 	/* check voltage is init or not */
 	/* step1: ANX6862 */
 	if (i2c0_dev == NULL) {
 		EXTERR("%s: invalid i2c0_dev\n", __func__);
 		return -1;
 	}
 	ret = lcd_extern_init_check(0);
 	if (ret) {
 		EXTPR("ANX6862: need init voltage and NVM write\n");
 		/* init voltage */
 		lcd_extern_power_cmd(0);
 		/* NVM write */
 		lcd_extern_i2c_write(i2c0_dev->client, ANX6862_NVM_wr, 2);
 	}

 	/* step2: ANX7911 */
 	if (i2c1_dev == NULL) {
 		EXTERR("%s: invalid i2c1_dev\n", __func__);
 		return -1;
 	}
 	ret = lcd_extern_init_check(1);
 	if (ret) {
 		EXTPR("ANX7911: need init voltage and NVM write\n");
 		/* init voltage */
 		lcd_extern_power_cmd(1);
 		/* NVM write */
 		lcd_extern_i2c_write(i2c1_dev->client, ANX7911_NVM_wr, 2);
 	}

 	EXTPR("%s\n", __func__);
 	return ret;
 }

 static int lcd_extern_power_off(void)
 {
 	lcd_extern_pinmux_set(0);
 	return 0;
 }

 static int lcd_extern_driver_update(struct aml_lcd_extern_driver_s *ext_drv)
 {
 	if (ext_drv == NULL) {
 		EXTERR("%s driver is null\n", LCD_EXTERN_NAME);
 		return -1;
 	}
 	if (ext_drv->config->table_init_loaded == 0) {
 		EXTERR("%s: tablet_init is invalid\n", ext_drv->config->name);
 		return -1;
 	}

 	ext_drv->reg_read  = lcd_extern_reg_read;
 	ext_drv->reg_write = lcd_extern_reg_write;
 	ext_drv->power_on  = lcd_extern_power_on;
 	ext_drv->power_off = lcd_extern_power_off;

 	return 0;
 }

 int aml_lcd_extern_i2c_ANX6862_7911_probe(
 		struct aml_lcd_extern_driver_s *ext_drv)
 {
 	int ret = 0;

 	ext_config = ext_drv->config;

 	i2c0_dev = lcd_extern_get_i2c_device(ext_config->i2c_addr);
 	if (i2c0_dev == NULL) {
 		EXTERR("invalid i2c0 device\n");
 		return -1;
 	}
 	EXTPR("get i2c device: %s, addr 0x%02x OK\n",
 		i2c0_dev->name, i2c0_dev->client->addr);

 	i2c1_dev = lcd_extern_get_i2c_device(ext_config->i2c_addr2);
 	if (i2c1_dev == NULL) {
 		EXTERR("invalid i2c1 device\n");
 		i2c0_dev = NULL;
 		return -1;
 	}
 	EXTPR("get i2c1 device: %s, addr 0x%02x OK\n",
 		i2c1_dev->name, i2c1_dev->client->addr);

 	ret = lcd_extern_driver_update(ext_drv);
 	if (lcd_debug_print_flag)
 		EXTPR("%s: %d\n", __func__, ret);

 	return ret;
 }

 int aml_lcd_extern_i2c_ANX6862_7911_remove(void)
 {
 	i2c0_dev = NULL;
 	i2c1_dev = NULL;
 	ext_config = NULL;

 	return 0;
 }
	/*
	* drivers/amlogic/media/vout/lcd/lcd_extern/i2c_ANX6862_7911.c
	*
	* Copyright (C) 2017 Amlogic, Inc. All rights reserved.
	*
	* 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.
	*
	* This program is distributed in the hope that it will be useful, but WITHOUT
	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	* more details.
	*
	*/

	#include <linux/kernel.h>
	#include <linux/module.h>
	#include <linux/interrupt.h>
	#include <linux/platform_device.h>
	#include <linux/i2c.h>
	#include <linux/amlogic/i2c-amlogic.h>
	#include <linux/clk.h>
	#include <linux/delay.h>
	#include <linux/slab.h>
	#include <linux/of.h>
	#include <linux/amlogic/media/vout/lcd/lcd_extern.h>
	#include "lcd_extern.h"

	#define LCD_EXTERN_NAME "i2c_ANX6862_7911"

	#define LCD_EXTERN_I2C_ADDR (0x20 >> 1) /* ANX6862 7bit address */
	#define LCD_EXTERN_I2C_ADDR2 (0x74 >> 1) /* ANX7911 7bit address */

	static struct lcd_extern_config_s *ext_config;
	static struct aml_lcd_extern_i2c_dev_s *i2c0_dev;
	static struct aml_lcd_extern_i2c_dev_s *i2c1_dev;


	static unsigned char ANX6862_NVM_wr[] = {0xff, 0x80};
	static unsigned char ANX7911_NVM_wr[] = {0x00, 0x0a};

	#define ANX6862_REG_CNT 12
	#define ANX7911_REG_CNT 23
	#if 0
	static unsigned char ANX6862_7911_init[] = {
	0x00, 3, 0x01, 0x2b, 0,
	0x00, 3, 0x02, 0x05, 0,
	0x00, 3, 0x03, 0x00, 0,
	0x00, 3, 0x04, 0x00, 0,
	0x00, 3, 0x05, 0x0c, 0,
	0x00, 3, 0x06, 0x04, 0,
	0x00, 3, 0x07, 0x21, 0,
	0x00, 3, 0x08, 0x0e, 0,
	0x00, 3, 0x09, 0x04, 0,
	0x00, 3, 0x0a, 0x00, 0,
	0x00, 3, 0x0b, 0x04, 0,
	0x00, 3, 0xff, 0x00, 100,

	0x01, 3, 0x01, 0xca, 0,
	0x01, 3, 0x02, 0x3b, 0,
	0x01, 3, 0x03, 0x33, 0,
	0x01, 3, 0x04, 0x05, 0,
	0x01, 3, 0x05, 0x2c, 0,
	0x01, 3, 0x06, 0xf2, 0,
	0x01, 3, 0x07, 0x9c, 0,
	0x01, 3, 0x08, 0x1b, 0,
	0x01, 3, 0x09, 0x82, 0,
	0x01, 3, 0x0a, 0x3d, 0,
	0x01, 3, 0x0b, 0x20, 0,
	0x01, 3, 0x0c, 0x11, 0,
	0x01, 3, 0x0d, 0xc4, 0,
	0x01, 3, 0x0e, 0x1a, 0,
	0x01, 3, 0x0f, 0x31, 0,
	0x01, 3, 0x10, 0x4c, 0,
	0x01, 3, 0x11, 0x12, 0,
	0x01, 3, 0x12, 0x90, 0,
	0x01, 3, 0x13, 0xf7, 0,
	0x01, 3, 0x14, 0x0c, 0,
	0x01, 3, 0x15, 0x20, 0,
	0x01, 3, 0x16, 0x13, 0,
	0xff, 0,
	};
	#endif

	static int lcd_extern_reg_read(unsigned char reg, unsigned char *buf)
	{
	struct aml_lcd_extern_i2c_dev_s *i2c_dev;
	unsigned char tmp;
	int ret = 0;

	tmp = reg;
	if (ext_config->addr_sel)
	i2c_dev = i2c1_dev;
	else
	i2c_dev = i2c0_dev;
	if (i2c_dev == NULL) {
	EXTERR("invalid i2c device\n");
	return -1;
	}
	lcd_extern_i2c_read(i2c_dev->client, &tmp, 1);
	buf[0] = tmp;

	return ret;
	}

	static int lcd_extern_reg_write(unsigned char reg, unsigned char value)
	{
	struct aml_lcd_extern_i2c_dev_s *i2c_dev;
	unsigned char tmp[2];
	int ret = 0;

	tmp[0] = reg;
	tmp[1] = value;

	if (ext_config->addr_sel)
	i2c_dev = i2c1_dev;
	else
	i2c_dev = i2c0_dev;
	if (i2c_dev == NULL) {
	EXTERR("invalid i2c device\n");
	return -1;
	}
	lcd_extern_i2c_write(i2c_dev->client, tmp, 2);

	return ret;
	}

	static int lcd_extern_power_cmd_dynamic_size(unsigned char *table,
	unsigned char flag)
	{
	int i = 0, j, step = 0, max_len;
	unsigned char type, cmd_size, type_chk, type_other;
	struct aml_lcd_extern_i2c_dev_s *i2c_dev;
	int delay_bypass, delay_ms, ret = 0;

	if (table == NULL)
	return -1;

	max_len = ext_config->table_init_on_cnt;
	if (flag) {
	i2c_dev = i2c1_dev;
	type_chk = LCD_EXT_CMD_TYPE_CMD2;
	type_other = LCD_EXT_CMD_TYPE_CMD;
	} else {
	i2c_dev = i2c0_dev;
	type_chk = LCD_EXT_CMD_TYPE_CMD;
	type_other = LCD_EXT_CMD_TYPE_CMD2;
	}
	if (i2c_dev == NULL) {
	EXTERR("invalid i2c%d device\n", flag);
	return -1;
	}

	delay_bypass = 0;
	while ((i + 1) < max_len) {
	type = table[i];
	if (type == LCD_EXT_CMD_TYPE_END)
	break;
	cmd_size = table[i+1];
	if (cmd_size == 0)
	goto power_cmd_dynamic_next;
	if ((i + 2 + cmd_size) > max_len)
	break;

	if (type == type_chk) {
	if (lcd_debug_print_flag) {
	EXTPR("%s: step %d: type=0x%02x, cmd_size=%d\n",
	__func__, step, type, table[i+1]);
	}
	ret = lcd_extern_i2c_write(i2c_dev->client,
	&table[i+2], cmd_size);
	delay_bypass = 0;
	} else if (type == LCD_EXT_CMD_TYPE_DELAY) {
	if (delay_bypass)
	goto power_cmd_dynamic_next;
	if (lcd_debug_print_flag) {
	EXTPR("%s: step %d: type=0x%02x, cmd_size=%d\n",
	__func__, step, type, table[i+1]);
	}
	delay_ms = 0;
	for (j = 0; j < cmd_size; j++)
	delay_ms += table[i+2+j];
	if (delay_ms > 0)
	mdelay(delay_ms);
	} else if (type == type_other) {
	delay_bypass = 1;
	} else {
	delay_bypass = 1;
	EXTERR("%s(%d: %s): type 0x%02x invalid\n",
	__func__, ext_config->index,
	ext_config->name, type);
	}
	power_cmd_dynamic_next:
	i += (cmd_size + 2);
	step++;
	}

	return ret;
	}

	static int lcd_extern_power_cmd_fixed_size(unsigned char *table,
	unsigned char flag)
	{
	int i = 0, j, step = 0, max_len;
	unsigned char type, cmd_size, type_chk, type_other;
	struct aml_lcd_extern_i2c_dev_s *i2c_dev;
	int delay_bypass, delay_ms, ret = 0;

	if (table == NULL)
	return -1;

	cmd_size = ext_config->cmd_size;
	max_len = ext_config->table_init_on_cnt;
	if (flag) {
	i2c_dev = i2c1_dev;
	type_chk = LCD_EXT_CMD_TYPE_CMD2;
	type_other = LCD_EXT_CMD_TYPE_CMD;
	} else {
	i2c_dev = i2c0_dev;
	type_chk = LCD_EXT_CMD_TYPE_CMD;
	type_other = LCD_EXT_CMD_TYPE_CMD2;
	}
	if (i2c_dev == NULL) {
	EXTERR("invalid i2c%d device\n", flag);
	return -1;
	}

	if (cmd_size < 2) {
	EXTERR("%s: invalid cmd_size %d\n", __func__, cmd_size);
	return -1;
	}

	delay_bypass = 0;
	while ((i + cmd_size) <= max_len) {
	type = table[i];
	if (type == LCD_EXT_CMD_TYPE_END)
	break;
	if (type == type_chk) {
	if (lcd_debug_print_flag) {
	EXTPR("%s: step %d: type=0x%02x, cmd_size=%d\n",
	__func__, step, type, cmd_size);
	}
	ret = lcd_extern_i2c_write(i2c_dev->client,
	&table[i+1], (cmd_size-2));
	delay_bypass = 0;
	} else if (type == LCD_EXT_CMD_TYPE_DELAY) {
	if (delay_bypass)
	goto power_cmd_fixed_next;
	if (lcd_debug_print_flag) {
	EXTPR("%s: step %d: type=0x%02x, cmd_size=%d\n",
	__func__, step, type, cmd_size);
	}
	delay_ms = 0;
	for (j = 0; j < (cmd_size - 1); j++)
	delay_ms += table[i+1+j];
	if (delay_ms > 0)
	mdelay(delay_ms);
	} else if (type == type_other) {
	delay_bypass = 1;
	} else {
	delay_bypass = 1;
	EXTERR("%s: %s(%d): type 0x%02x invalid\n",
	__func__, ext_config->name,
	ext_config->index, type);
	}
	power_cmd_fixed_next:
	i += cmd_size;
	step++;
	}

	return ret;
	}

	static int lcd_extern_power_cmd(unsigned char flag)
	{
	unsigned char *table;
	unsigned char cmd_size;
	int ret = 0;

	table = ext_config->table_init_on;
	cmd_size = ext_config->cmd_size;
	if (cmd_size < 1) {
	EXTERR("%s: cmd_size %d is invalid\n", __func__, cmd_size);
	return -1;
	}
	if (table == NULL) {
	EXTERR("%s: init_on_table is NULL\n", __func__);
	return -1;
	}

	if (cmd_size == LCD_EXT_CMD_SIZE_DYNAMIC)
	ret = lcd_extern_power_cmd_dynamic_size(table, flag);
	else
	ret = lcd_extern_power_cmd_fixed_size(table, flag);

	EXTPR("%s: %s(%d): %d\n",
	__func__, ext_config->name, ext_config->index, flag);
	return ret;
	}

	static int lcd_extern_check_reg_dynamic_size(unsigned char *table,
	unsigned char *chk_table, int cnt, unsigned char flag)
	{
	int i = 0, step = 0, max_len;
	unsigned char type, cmd_size, type_chk, reg;
	int ret = 0;

	if (table == NULL)
	return -1;

	max_len = ext_config->table_init_on_cnt;
	type_chk = (flag) ? LCD_EXT_CMD_TYPE_CMD2 : LCD_EXT_CMD_TYPE_CMD;

	while ((i + 1) < max_len) {
	type = table[i];
	if (type == LCD_EXT_CMD_TYPE_END)
	break;
	cmd_size = table[i+1];
	if (cmd_size == 0) {
	i += 2;
	continue;
	}
	if ((i + 2 + cmd_size) > max_len)
	break;

	if (type == type_chk) {
	reg = table[i+2];
	if (lcd_debug_print_flag) {
	EXTPR(
	"%s: step %d: reg 0x%02x, val 0x%02x,0x%02x\n",
	__func__, step,
	reg, table[i+3], chk_table[reg]);
	}
	if (chk_table[reg] != table[i+3])
	return -1;
	}
	i += (cmd_size + 2);
	step++;
	}

	return ret;
	}

	static int lcd_extern_check_reg_fixed_size(unsigned char *table,
	unsigned char *chk_table, int cnt, unsigned char flag)
	{
	int i = 0, step = 0, max_len;
	unsigned char type, cmd_size, type_chk, reg;

	cmd_size = ext_config->cmd_size;
	max_len = ext_config->table_init_on_cnt;
	type_chk = (flag) ? LCD_EXT_CMD_TYPE_CMD2 : LCD_EXT_CMD_TYPE_CMD;

	while ((i + cmd_size) <= max_len) {
	type = table[i];
	if (type == LCD_EXT_CMD_TYPE_END)
	break;
	if (type == type_chk) {
	reg = table[i+1];
	if (lcd_debug_print_flag) {
	EXTPR(
	"%s: step %d: reg 0x%02x, val 0x%02x,0x%02x\n",
	__func__, step,
	reg, table[i+2], chk_table[reg]);
	}
	if (chk_table[reg] != table[i+2])
	return -1;
	}
	i += cmd_size;
	step++;
	}

	return 0;
	}

	static int lcd_extern_init_check(unsigned char flag)
	{
	unsigned char table, chk_table, cmd_size;
	int cnt, ret = 0;

	table = ext_config->table_init_on;
	cmd_size = ext_config->cmd_size;
	cnt = (flag) ? ANX7911_REG_CNT : ANX6862_REG_CNT;
	if (cmd_size < 1) {
	EXTERR("%s: cmd_size %d is invalid\n", __func__, cmd_size);
	return -1;
	}
	if (table == NULL) {
	EXTERR("%s: init_table %d is NULL\n", __func__, flag);
	return -1;
	}

	chk_table = kcalloc(cnt, sizeof(unsigned char), GFP_KERNEL);
	if (chk_table == NULL) {
	EXTERR("%s: failed to alloc chk_table, not enough memory\n",
	LCD_EXTERN_NAME);
	return -1;
	}
	memset(chk_table, 0, cnt);

	ret = lcd_extern_i2c_read(i2c0_dev->client, chk_table, cnt);
	if (ret) {
	EXTERR("%s: i2c read error\n", __func__);
	return -1;
	}

	if (cmd_size == LCD_EXT_CMD_SIZE_DYNAMIC) {
	ret = lcd_extern_check_reg_dynamic_size(table, chk_table,
	cnt, flag);
	} else {
	ret = lcd_extern_check_reg_fixed_size(table, chk_table,
	cnt, flag);
	}

	return ret;
	}

	static int lcd_extern_power_on(void)
	{
	int ret;

	lcd_extern_pinmux_set(1);

	/* check voltage is init or not */
	/* step1: ANX6862 */
	if (i2c0_dev == NULL) {
	EXTERR("%s: invalid i2c0_dev\n", __func__);
	return -1;
	}
	ret = lcd_extern_init_check(0);
	if (ret) {
	EXTPR("ANX6862: need init voltage and NVM write\n");
	/* init voltage */
	lcd_extern_power_cmd(0);
	/* NVM write */
	lcd_extern_i2c_write(i2c0_dev->client, ANX6862_NVM_wr, 2);
	}

	/* step2: ANX7911 */
	if (i2c1_dev == NULL) {
	EXTERR("%s: invalid i2c1_dev\n", __func__);
	return -1;
	}
	ret = lcd_extern_init_check(1);
	if (ret) {
	EXTPR("ANX7911: need init voltage and NVM write\n");
	/* init voltage */
	lcd_extern_power_cmd(1);
	/* NVM write */
	lcd_extern_i2c_write(i2c1_dev->client, ANX7911_NVM_wr, 2);
	}

	EXTPR("%s\n", __func__);
	return ret;
	}

	static int lcd_extern_power_off(void)
	{
	lcd_extern_pinmux_set(0);
	return 0;
	}

	static int lcd_extern_driver_update(struct aml_lcd_extern_driver_s *ext_drv)
	{
	if (ext_drv == NULL) {
	EXTERR("%s driver is null\n", LCD_EXTERN_NAME);
	return -1;
	}
	if (ext_drv->config->table_init_loaded == 0) {
	EXTERR("%s: tablet_init is invalid\n", ext_drv->config->name);
	return -1;
	}

	ext_drv->reg_read = lcd_extern_reg_read;
	ext_drv->reg_write = lcd_extern_reg_write;
	ext_drv->power_on = lcd_extern_power_on;
	ext_drv->power_off = lcd_extern_power_off;

	return 0;
	}

	int aml_lcd_extern_i2c_ANX6862_7911_probe(
	struct aml_lcd_extern_driver_s *ext_drv)
	{
	int ret = 0;

	ext_config = ext_drv->config;

	i2c0_dev = lcd_extern_get_i2c_device(ext_config->i2c_addr);
	if (i2c0_dev == NULL) {
	EXTERR("invalid i2c0 device\n");
	return -1;
	}
	EXTPR("get i2c device: %s, addr 0x%02x OK\n",
	i2c0_dev->name, i2c0_dev->client->addr);

	i2c1_dev = lcd_extern_get_i2c_device(ext_config->i2c_addr2);
	if (i2c1_dev == NULL) {
	EXTERR("invalid i2c1 device\n");
	i2c0_dev = NULL;
	return -1;
	}
	EXTPR("get i2c1 device: %s, addr 0x%02x OK\n",
	i2c1_dev->name, i2c1_dev->client->addr);

	ret = lcd_extern_driver_update(ext_drv);
	if (lcd_debug_print_flag)
	EXTPR("%s: %d\n", __func__, ret);

	return ret;
	}

	int aml_lcd_extern_i2c_ANX6862_7911_remove(void)
	{
	i2c0_dev = NULL;
	i2c1_dev = NULL;
	ext_config = NULL;

	return 0;
	}