| /* |
| * drivers/display/lcd/lcd_extern/ext_default.c |
| * |
| * 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 named License, |
| * or 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 <common.h> |
| #include <malloc.h> |
| #include <asm/arch/gpio.h> |
| #ifdef CONFIG_OF_LIBFDT |
| #include <libfdt.h> |
| #endif |
| #include <amlogic/aml_lcd.h> |
| #include <amlogic/aml_lcd_extern.h> |
| #include "lcd_extern.h" |
| #include "../aml_lcd_common.h" |
| #include "../aml_lcd_reg.h" |
| |
| #define LCD_EXTERN_NAME "ext_default" |
| |
| //#define LCD_EXT_I2C_PORT_INIT /* no need init i2c port default */ |
| |
| static struct lcd_extern_config_s *ext_config; |
| static struct aml_lcd_extern_driver_s *ext_driver; |
| |
| static unsigned char check_state[4] = {0, 0, 0, 0}; |
| static unsigned char check_flag; |
| static unsigned char check_offset; |
| static unsigned char check_len; |
| |
| |
| static void set_lcd_csb(unsigned int v) |
| { |
| aml_lcd_extern_gpio_set(ext_config->spi_gpio_cs, v); |
| udelay(ext_config->spi_delay_us); |
| } |
| |
| static void set_lcd_scl(unsigned int v) |
| { |
| aml_lcd_extern_gpio_set(ext_config->spi_gpio_clk, v); |
| udelay(ext_config->spi_delay_us); |
| } |
| |
| static void set_lcd_sda(unsigned int v) |
| { |
| aml_lcd_extern_gpio_set(ext_config->spi_gpio_data, v); |
| udelay(ext_config->spi_delay_us); |
| } |
| |
| static void spi_gpio_init(void) |
| { |
| set_lcd_csb(1); |
| set_lcd_scl(1); |
| set_lcd_sda(1); |
| } |
| |
| static void spi_gpio_off(void) |
| { |
| set_lcd_sda(0); |
| set_lcd_scl(0); |
| set_lcd_csb(0); |
| } |
| |
| static void spi_write_byte(unsigned char data) |
| { |
| int i; |
| |
| for (i = 0; i < 8; i++) { |
| set_lcd_scl(0); |
| if (data & 0x80) |
| set_lcd_sda(1); |
| else |
| set_lcd_sda(0); |
| data <<= 1; |
| set_lcd_scl(1); |
| } |
| } |
| |
| static int lcd_extern_spi_read(unsigned char reg, unsigned char *buf) |
| { |
| EXTERR("%s: %s(%d): extern_type %d is not support\n", |
| __func__, ext_config->name, |
| ext_config->index, ext_config->type); |
| |
| return -1; |
| } |
| |
| static int lcd_extern_spi_write(unsigned char *buf, int len) |
| { |
| int i; |
| |
| if (len < 2) { |
| EXTERR("%s: len %d error\n", __func__, len); |
| return -1; |
| } |
| |
| set_lcd_csb(0); |
| |
| for (i = 0; i < len; i++) |
| spi_write_byte(buf[i]); |
| |
| set_lcd_csb(1); |
| set_lcd_scl(1); |
| set_lcd_sda(1); |
| udelay(ext_config->spi_delay_us); |
| |
| return 0; |
| } |
| |
| static int lcd_extern_reg_read(unsigned char reg, unsigned char *buf) |
| { |
| int ret = 0; |
| |
| if (buf == NULL) { |
| EXTERR("%s: buf is null\n", __func__); |
| return -1; |
| } |
| |
| switch (ext_config->type) { |
| case LCD_EXTERN_I2C: |
| buf[0] = reg; |
| ret = aml_lcd_extern_i2c_read(ext_config->i2c_bus, |
| ext_config->i2c_addr, |
| buf, 1); |
| break; |
| case LCD_EXTERN_SPI: |
| ret = lcd_extern_spi_read(reg, buf); |
| break; |
| default: |
| EXTERR("%s: %s(%d): extern_type %d is not support\n", |
| __func__, ext_config->name, |
| ext_config->index, ext_config->type); |
| ret = -1; |
| break; |
| } |
| if (ret) |
| EXTERR("%s: faild\n", __func__); |
| |
| return ret; |
| } |
| |
| static int lcd_extern_reg_write(unsigned char *buf, unsigned int len) |
| { |
| int ret = 0; |
| |
| if (buf == NULL) { |
| EXTERR("%s: buf is null\n", __func__); |
| return -1; |
| } |
| |
| if (!len) { |
| EXTERR("%s: invalid len\n", __func__); |
| return -1; |
| } |
| |
| switch (ext_config->type) { |
| case LCD_EXTERN_I2C: |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr, |
| buf, len); |
| break; |
| case LCD_EXTERN_SPI: |
| ret = lcd_extern_spi_write(buf, len); |
| break; |
| default: |
| EXTERR("%s: %s(%d): extern_type %d is not support\n", |
| __func__, ext_config->name, |
| ext_config->index, ext_config->type); |
| ret = -1; |
| break; |
| } |
| if (ret) |
| EXTERR("%s: faild\n", __func__); |
| |
| return ret; |
| } |
| |
| static void lcd_extern_init_reg_check(unsigned char i2c_bus, |
| unsigned char i2c_addr, |
| unsigned char type, |
| unsigned char *raw_table, |
| unsigned char data_len) |
| { |
| unsigned char *chk_table, *chk_buf, *raw_buf; |
| unsigned char index; |
| unsigned char temp_flag = check_flag; |
| int ret = 0; |
| |
| /* if not need to check return */ |
| if (check_flag == 0) |
| return; |
| |
| index = type & 0x0f; |
| if ((index >= 4) || (data_len < 1) || (!raw_table)) |
| goto parameter_err0; |
| check_state[index] = 0; |
| check_flag = 0; |
| chk_table = malloc(data_len * sizeof(unsigned char)); |
| if (!chk_table) |
| goto parameter_err0; |
| memset(chk_table, 0, data_len); |
| if (((type & 0xf0) == LCD_EXT_CMD_TYPE_CMD) || |
| ((type & 0xf0) == LCD_EXT_CMD_TYPE_CMD_BIN)) { |
| if (data_len < 2) |
| goto parameter_err1; |
| chk_table[0] = raw_table[0]; |
| data_len--; |
| raw_table++; |
| } |
| ret = aml_lcd_extern_i2c_read(i2c_bus, i2c_addr, chk_table, data_len); |
| if (!check_len || (check_len > data_len)) |
| check_len = data_len; |
| if (check_offset > data_len) |
| check_offset = 0; |
| if ((ret) || (check_offset + check_len) > data_len) |
| goto parameter_err1; |
| chk_buf = chk_table + check_offset; |
| raw_buf = raw_table + check_offset; |
| ret = memcmp(chk_buf, raw_buf, check_len); |
| if (ret == 0) |
| check_state[index] = temp_flag; |
| if (lcd_debug_print_flag) |
| EXTERR("%s: ret : %d\n", __func__, ret); |
| free(chk_table); |
| return; |
| parameter_err1: |
| free(chk_table); |
| parameter_err0: |
| EXTERR("%s: error parameters\n", __func__); |
| } |
| |
| static void lcd_extern_init_reg_check2(unsigned char i2c_bus, |
| unsigned char i2c_addr, |
| unsigned char type, |
| unsigned char *raw_table, |
| unsigned char data_len) |
| { |
| unsigned char *chk_table, *chk_buf, *raw_buf; |
| unsigned char index; |
| unsigned char temp_flag = check_flag; |
| int ret = 0; |
| |
| /* if not need to check return */ |
| if (check_flag == 0) |
| return; |
| |
| index = type & 0x0f; |
| if ((index >= 4) || (data_len < 1) || (!raw_table)) |
| goto parameter_err0; |
| check_state[index] = 0; |
| check_flag = 0; |
| chk_table = malloc(data_len * sizeof(unsigned char)); |
| if (!chk_table) |
| goto parameter_err0; |
| memset(chk_table, 0, data_len); |
| ret = aml_lcd_extern_i2c_read(i2c_bus, i2c_addr, chk_table, |
| check_offset + data_len); |
| if (!check_len || (check_len > data_len)) |
| check_len = data_len; |
| if (ret) |
| goto parameter_err1; |
| chk_buf = chk_table + check_offset; |
| raw_buf = raw_table + 1; |
| ret = memcmp(chk_buf, raw_buf, check_len); |
| if (ret == 0) |
| check_state[index] = temp_flag; |
| if (lcd_debug_print_flag) |
| EXTPR("%s: ret : %d\n", __func__, ret); |
| free(chk_table); |
| return; |
| parameter_err1: |
| free(chk_table); |
| parameter_err0: |
| EXTERR("%s: error parameters\n", __func__); |
| } |
| |
| static int lcd_extern_cmd_multi_id(struct aml_lcd_extern_driver_s *edrv, |
| unsigned char multi_id) |
| { |
| struct aml_lcd_drv_s *pdrv; |
| struct lcd_extern_multi_list_s *temp_list; |
| unsigned int frame_rate, frame_rate_max, frame_rate_min; |
| |
| pdrv = aml_lcd_get_driver(); |
| if (!pdrv) |
| return -1; |
| if (pdrv->lcd_config->cus_ctrl.dlg_flag == 0) |
| return -1; |
| |
| frame_rate = pdrv->lcd_config->lcd_timing.sync_duration_num / |
| pdrv->lcd_config->lcd_timing.sync_duration_den; |
| |
| temp_list = edrv->multi_list_header; |
| while (temp_list) { |
| if (multi_id == temp_list->index) { |
| if (temp_list->type == LCD_EXT_CMD_TYPE_MULTI_FR) { |
| frame_rate_min = temp_list->data_buf[0]; |
| frame_rate_max = temp_list->data_buf[1]; |
| LCDPR("%s id:%d, rate_min=%d, rate_max=%d ,set_rate=%d\n", |
| __func__, temp_list->index, frame_rate_min, |
| frame_rate_max, (int)frame_rate); |
| if (frame_rate < frame_rate_min || |
| frame_rate > frame_rate_max) { |
| return -1; |
| } |
| EXTPR("%s: multi_id=%d, type=0x%x, framerate=%d\n", |
| __func__, temp_list->index, temp_list->type, frame_rate); |
| return 0; |
| } |
| } |
| temp_list = temp_list->next; |
| } |
| return -1; |
| } |
| |
| static int lcd_extern_power_cmd_dynamic_size(unsigned char *table, int flag) |
| { |
| int i = 0, j = 0, max_len = 0, step = 0; |
| unsigned char type, temp, size, i2c_bus, i2c_addr; |
| int delay_ms, ret = 0; |
| i2c_bus = ext_config->i2c_bus; |
| |
| if (flag) |
| max_len = ext_config->table_init_on_cnt; |
| else |
| max_len = ext_config->table_init_off_cnt; |
| |
| switch (ext_config->type) { |
| case LCD_EXTERN_I2C: |
| while ((i + 1) < max_len) { |
| type = table[i]; |
| size = table[i+1]; |
| if (type == LCD_EXT_CMD_TYPE_END) |
| break; |
| if (lcd_debug_print_flag) { |
| EXTPR("%s: step %d: type=0x%02x, size=%d\n", |
| __func__, step, type, size); |
| } |
| if (size == 0) |
| goto power_cmd_dynamic_i2c_next; |
| if ((i + 2 + size) > max_len) |
| break; |
| |
| if (type == LCD_EXT_CMD_TYPE_NONE) { |
| /* do nothing */ |
| } else if (type == LCD_EXT_CMD_TYPE_GPIO) { |
| if (size < 2) { |
| EXTERR("step %d: invalid size %d for GPIO\n", |
| step, size); |
| goto power_cmd_dynamic_i2c_next; |
| } |
| aml_lcd_extern_gpio_set(table[i+2], table[i+3]); |
| if (size > 2) { |
| if (table[i+4] > 0) |
| mdelay(table[i+4]); |
| } |
| } else if (type == LCD_EXT_CMD_TYPE_DELAY) { |
| delay_ms = 0; |
| for (j = 0; j < size; j++) |
| delay_ms += table[i+2+j]; |
| if (delay_ms > 0) |
| mdelay(delay_ms); |
| } else if (type == LCD_EXT_CMD_TYPE_CHECK) { |
| if (size == 1) { |
| check_flag = table[i + 2]; |
| check_offset = 0; |
| check_len = 0; |
| } else if (size == 3) { |
| check_flag = table[i + 2]; |
| check_offset = table[i + 3]; |
| check_len = table[i + 4]; |
| } else { |
| check_flag = 0; |
| } |
| } else if ((type == LCD_EXT_CMD_TYPE_CMD) || |
| (type == LCD_EXT_CMD_TYPE_CMD_BIN) || |
| (type == LCD_EXT_CMD_TYPE_CMD_BIN_DATA)) { |
| i2c_addr = ext_config->i2c_addr; |
| lcd_extern_init_reg_check(i2c_bus, |
| i2c_addr, |
| type, |
| &table[i + 2], |
| size); |
| if (check_state[0] == 1) |
| goto power_cmd_dynamic_i2c_next; |
| ret = aml_lcd_extern_i2c_write(i2c_bus, |
| i2c_addr, |
| &table[i + 2], |
| size); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD_BIN2) { |
| i2c_addr = ext_config->i2c_addr; |
| lcd_extern_init_reg_check2(i2c_bus, |
| i2c_addr, |
| type, |
| &table[i + 2], |
| size); |
| if (check_state[0] == 1) |
| goto power_cmd_dynamic_i2c_next; |
| ret = aml_lcd_extern_i2c_write(i2c_bus, |
| i2c_addr, |
| &table[i + 2], |
| size); |
| } else if ((type == LCD_EXT_CMD_TYPE_CMD2) || |
| (type == LCD_EXT_CMD_TYPE_CMD2_BIN) || |
| (type == LCD_EXT_CMD_TYPE_CMD2_BIN_DATA)) { |
| i2c_addr = ext_config->i2c_addr2; |
| lcd_extern_init_reg_check(i2c_bus, |
| i2c_addr, |
| type, |
| &table[i + 2], |
| size); |
| if (check_state[1] == 1) |
| goto power_cmd_dynamic_i2c_next; |
| ret = aml_lcd_extern_i2c_write(i2c_bus, |
| i2c_addr, |
| &table[i + 2], |
| size); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD2_BIN2) { |
| i2c_addr = ext_config->i2c_addr2; |
| lcd_extern_init_reg_check2(i2c_bus, |
| i2c_addr, |
| type, |
| &table[i + 2], |
| size); |
| if (check_state[1] == 1) |
| goto power_cmd_dynamic_i2c_next; |
| ret = aml_lcd_extern_i2c_write(i2c_bus, |
| i2c_addr, |
| &table[i + 2], |
| size); |
| } else if ((type == LCD_EXT_CMD_TYPE_CMD3) || |
| (type == LCD_EXT_CMD_TYPE_CMD3_BIN) || |
| (type == LCD_EXT_CMD_TYPE_CMD3_BIN_DATA)) { |
| i2c_addr = ext_config->i2c_addr3; |
| lcd_extern_init_reg_check(i2c_bus, |
| i2c_addr, |
| type, |
| &table[i + 2], |
| size); |
| if (check_state[2] == 1) |
| goto power_cmd_dynamic_i2c_next; |
| ret = aml_lcd_extern_i2c_write(i2c_bus, |
| i2c_addr, |
| &table[i + 2], |
| size); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD3_BIN2) { |
| i2c_addr = ext_config->i2c_addr3; |
| lcd_extern_init_reg_check2(i2c_bus, |
| i2c_addr, |
| type, |
| &table[i + 2], |
| size); |
| if (check_state[2] == 1) |
| goto power_cmd_dynamic_i2c_next; |
| ret = aml_lcd_extern_i2c_write(i2c_bus, |
| i2c_addr, |
| &table[i + 2], |
| size); |
| } else if ((type == LCD_EXT_CMD_TYPE_CMD4) || |
| (type == LCD_EXT_CMD_TYPE_CMD4_BIN) || |
| (type == LCD_EXT_CMD_TYPE_CMD4_BIN_DATA)) { |
| i2c_addr = ext_config->i2c_addr4; |
| lcd_extern_init_reg_check(i2c_bus, |
| i2c_addr, |
| type, |
| &table[i + 2], |
| size); |
| if (check_state[3] == 1) |
| goto power_cmd_dynamic_i2c_next; |
| ret = aml_lcd_extern_i2c_write(i2c_bus, |
| i2c_addr, |
| &table[i + 2], |
| size); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD4_BIN2) { |
| i2c_addr = ext_config->i2c_addr4; |
| lcd_extern_init_reg_check2(i2c_bus, |
| i2c_addr, |
| type, |
| &table[i + 2], |
| size); |
| if (check_state[3] == 1) |
| goto power_cmd_dynamic_i2c_next; |
| ret = aml_lcd_extern_i2c_write(i2c_bus, |
| i2c_addr, |
| &table[i + 2], |
| size); |
| } else if (type == LCD_EXT_CMD_TYPE_MULTI_FR) { |
| ; |
| } else if (type == LCD_EXT_CMD_TYPE_CMD_MULTI) { |
| if (!ext_driver) |
| goto power_cmd_dynamic_i2c_next; |
| |
| ret = lcd_extern_cmd_multi_id(ext_driver, table[i + 2]); |
| if (ret) |
| goto power_cmd_dynamic_i2c_next; |
| |
| i2c_addr = ext_config->i2c_addr; |
| temp = table[i + 3] << 4; |
| if (temp == LCD_EXT_CMD_TYPE_CMD_BIN2) |
| lcd_extern_init_reg_check2(i2c_bus, |
| i2c_addr, |
| temp, |
| &table[i + 4], |
| size - 2); |
| else |
| lcd_extern_init_reg_check(i2c_bus, |
| i2c_addr, |
| temp, |
| &table[i + 4], |
| size - 2); |
| |
| if (check_state[0] == 1) |
| goto power_cmd_dynamic_i2c_next; |
| ret = aml_lcd_extern_i2c_write(i2c_bus, |
| i2c_addr, |
| &table[i + 4], |
| size - 2); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD2_MULTI) { |
| if (!ext_driver) |
| goto power_cmd_dynamic_i2c_next; |
| |
| ret = lcd_extern_cmd_multi_id(ext_driver, table[i + 2]); |
| if (ret) |
| goto power_cmd_dynamic_i2c_next; |
| |
| i2c_addr = ext_config->i2c_addr2; |
| temp = (table[i + 3] << 4) | (1 << 0); |
| if (temp == LCD_EXT_CMD_TYPE_CMD2_BIN2) |
| lcd_extern_init_reg_check2(i2c_bus, |
| i2c_addr, |
| temp, |
| &table[i + 4], |
| size - 2); |
| else |
| lcd_extern_init_reg_check(i2c_bus, |
| i2c_addr, |
| temp, |
| &table[i + 4], |
| size - 2); |
| |
| if (check_state[1] == 1) |
| goto power_cmd_dynamic_i2c_next; |
| ret = aml_lcd_extern_i2c_write(i2c_bus, |
| i2c_addr, |
| &table[i + 4], |
| size - 2); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD3_MULTI) { |
| if (!ext_driver) |
| goto power_cmd_dynamic_i2c_next; |
| |
| ret = lcd_extern_cmd_multi_id(ext_driver, table[i + 2]); |
| if (ret) |
| goto power_cmd_dynamic_i2c_next; |
| |
| i2c_addr = ext_config->i2c_addr3; |
| temp = (table[i + 3] << 4) | (2 << 0); |
| if (temp == LCD_EXT_CMD_TYPE_CMD3_BIN2) |
| lcd_extern_init_reg_check2(i2c_bus, |
| i2c_addr, |
| temp, |
| &table[i + 4], |
| size - 2); |
| else |
| lcd_extern_init_reg_check(i2c_bus, |
| i2c_addr, |
| temp, |
| &table[i + 4], |
| size - 2); |
| |
| if (check_state[2] == 1) |
| goto power_cmd_dynamic_i2c_next; |
| ret = aml_lcd_extern_i2c_write(i2c_bus, |
| i2c_addr, |
| &table[i + 4], |
| size - 2); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD4_MULTI) { |
| if (!ext_driver) |
| goto power_cmd_dynamic_i2c_next; |
| |
| ret = lcd_extern_cmd_multi_id(ext_driver, table[i + 2]); |
| if (ret) |
| goto power_cmd_dynamic_i2c_next; |
| |
| i2c_addr = ext_config->i2c_addr4; |
| temp = (table[i + 3] << 4) | (3 << 0); |
| if (temp == LCD_EXT_CMD_TYPE_CMD4_BIN2) |
| lcd_extern_init_reg_check2(i2c_bus, |
| i2c_addr, |
| temp, |
| &table[i + 4], |
| size - 2); |
| else |
| lcd_extern_init_reg_check(i2c_bus, |
| i2c_addr, |
| temp, |
| &table[i + 4], |
| size - 2); |
| |
| if (check_state[3] == 1) |
| goto power_cmd_dynamic_i2c_next; |
| ret = aml_lcd_extern_i2c_write(i2c_bus, |
| i2c_addr, |
| &table[i + 4], |
| size - 2); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD_DELAY) { |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr, |
| &table[i+2], (size-1)); |
| if (table[i+1+size] > 0) |
| mdelay(table[i+1+size]); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD2_DELAY) { |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr2, |
| &table[i+2], (size-1)); |
| if (table[i+1+size] > 0) |
| mdelay(table[i+1+size]); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD3_DELAY) { |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr3, |
| &table[i+2], (size-1)); |
| if (table[i+1+size] > 0) |
| mdelay(table[i+1+size]); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD4_DELAY) { |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr4, |
| &table[i+2], (size - 1)); |
| if (table[i+1+size] > 0) |
| mdelay(table[i+1+size]); |
| } else { |
| EXTERR("%s: %s(%d): type 0x%02x invalid\n", |
| __func__, ext_config->name, |
| ext_config->index, type); |
| } |
| power_cmd_dynamic_i2c_next: |
| i += (size + 2); |
| step++; |
| } |
| break; |
| case LCD_EXTERN_SPI: |
| while ((i + 1) < max_len) { |
| type = table[i]; |
| size = table[i+1]; |
| if (type == LCD_EXT_CMD_TYPE_END) |
| break; |
| if (lcd_debug_print_flag) { |
| EXTPR("%s: step %d: type=0x%02x, size=%d\n", |
| __func__, step, type, size); |
| } |
| if (size == 0) |
| goto power_cmd_dynamic_spi_next; |
| if ((i + 2 + size) > max_len) |
| break; |
| |
| if (type == LCD_EXT_CMD_TYPE_NONE) { |
| /* do nothing */ |
| } else if (type == LCD_EXT_CMD_TYPE_GPIO) { |
| if (size < 2) { |
| EXTERR("step %d: invalid size %d for GPIO\n", |
| step, size); |
| goto power_cmd_dynamic_spi_next; |
| } |
| aml_lcd_extern_gpio_set(table[i+2], table[i+3]); |
| if (size > 2) { |
| if (table[i+4] > 0) |
| mdelay(table[i+4]); |
| } |
| } else if (type == LCD_EXT_CMD_TYPE_DELAY) { |
| delay_ms = 0; |
| for (j = 0; j < size; j++) |
| delay_ms += table[i+2+j]; |
| if (delay_ms > 0) |
| mdelay(delay_ms); |
| } else if ((type == LCD_EXT_CMD_TYPE_CMD) || |
| (type == LCD_EXT_CMD_TYPE_CMD_BIN)) { |
| ret = lcd_extern_spi_write(&table[i+2], size); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD_DELAY) { |
| ret = lcd_extern_spi_write(&table[i+2], (size-1)); |
| if (table[i+1+size] > 0) |
| mdelay(table[i+1+size]); |
| } else { |
| EXTERR("%s: %s(%d): type 0x%02x invalid\n", |
| __func__, ext_config->name, |
| ext_config->index, type); |
| } |
| power_cmd_dynamic_spi_next: |
| i += (size + 2); |
| step++; |
| } |
| break; |
| default: |
| EXTERR("%s: %s(%d): extern_type %d is not support\n", |
| __func__, ext_config->name, |
| ext_config->index, ext_config->type); |
| break; |
| } |
| |
| return ret; |
| } |
| |
| static int lcd_extern_power_cmd_fixed_size(unsigned char *table, int flag) |
| { |
| int i = 0, j, max_len = 0, step = 0; |
| unsigned char type, cmd_size; |
| int delay_ms, ret = 0; |
| |
| cmd_size = ext_config->cmd_size; |
| if (cmd_size < 2) { |
| EXTERR("%s: invalid cmd_size %d\n", __func__, cmd_size); |
| return -1; |
| } |
| |
| if (flag) |
| max_len = ext_config->table_init_on_cnt; |
| else |
| max_len = ext_config->table_init_off_cnt; |
| |
| switch (ext_config->type) { |
| case LCD_EXTERN_I2C: |
| while ((i + cmd_size) <= max_len) { |
| type = table[i]; |
| if (type == LCD_EXT_CMD_TYPE_END) |
| break; |
| if (lcd_debug_print_flag) { |
| EXTPR("%s: step %d: type=0x%02x, cmd_size=%d\n", |
| __func__, step, type, cmd_size); |
| } |
| if (type == LCD_EXT_CMD_TYPE_NONE) { |
| /* do nothing */ |
| } else if (type == LCD_EXT_CMD_TYPE_GPIO) { |
| aml_lcd_extern_gpio_set(table[i+1], table[i+2]); |
| if (cmd_size > 3) { |
| if (table[i+3] > 0) |
| mdelay(table[i+3]); |
| } |
| } else if (type == LCD_EXT_CMD_TYPE_DELAY) { |
| 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 == LCD_EXT_CMD_TYPE_CMD) || |
| (type == LCD_EXT_CMD_TYPE_CMD_BIN) || |
| (type == LCD_EXT_CMD_TYPE_CMD_BIN_DATA)) { |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr, |
| &table[i+1], (cmd_size-1)); |
| } else if ((type == LCD_EXT_CMD_TYPE_CMD2) || |
| (type == LCD_EXT_CMD_TYPE_CMD2_BIN) || |
| (type == LCD_EXT_CMD_TYPE_CMD2_BIN_DATA)) { |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr2, |
| &table[i+1], (cmd_size-1)); |
| } else if ((type == LCD_EXT_CMD_TYPE_CMD3) || |
| (type == LCD_EXT_CMD_TYPE_CMD3_BIN) || |
| (type == LCD_EXT_CMD_TYPE_CMD3_BIN_DATA)) { |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr3, |
| &table[i+1], (cmd_size-1)); |
| } else if ((type == LCD_EXT_CMD_TYPE_CMD4) || |
| (type == LCD_EXT_CMD_TYPE_CMD4_BIN) || |
| (type == LCD_EXT_CMD_TYPE_CMD4_BIN_DATA)) { |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr4, |
| &table[i+1], (cmd_size-1)); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD_DELAY) { |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr, |
| &table[i+1], (cmd_size-2)); |
| if (table[i+cmd_size-1] > 0) |
| mdelay(table[i+cmd_size-1]); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD2_DELAY) { |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr2, |
| &table[i+1], (cmd_size-2)); |
| if (table[i+cmd_size-1] > 0) |
| mdelay(table[i+cmd_size-1]); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD3_DELAY) { |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr3, |
| &table[i+1], (cmd_size-2)); |
| if (table[i+cmd_size-1] > 0) |
| mdelay(table[i+cmd_size-1]); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD4_DELAY) { |
| ret = aml_lcd_extern_i2c_write(ext_config->i2c_bus, |
| ext_config->i2c_addr4, |
| &table[i+1], (cmd_size-2)); |
| if (table[i+cmd_size-1] > 0) |
| mdelay(table[i+cmd_size-1]); |
| } else { |
| EXTERR("%s: %s(%d): type 0x%02x invalid\n", |
| __func__, ext_config->name, |
| ext_config->index, type); |
| } |
| i += cmd_size; |
| step++; |
| } |
| break; |
| case LCD_EXTERN_SPI: |
| while ((i + cmd_size) <= max_len) { |
| type = table[i]; |
| if (type == LCD_EXT_CMD_TYPE_END) |
| break; |
| if (lcd_debug_print_flag) { |
| EXTPR("%s: step %d: type=0x%02x, cmd_size=%d\n", |
| __func__, step, type, cmd_size); |
| } |
| if (type == LCD_EXT_CMD_TYPE_NONE) { |
| /* do nothing */ |
| } else if (type == LCD_EXT_CMD_TYPE_GPIO) { |
| aml_lcd_extern_gpio_set(table[i+1], table[i+2]); |
| if (cmd_size > 3) { |
| if (table[i+3] > 0) |
| mdelay(table[i+3]); |
| } |
| } else if (type == LCD_EXT_CMD_TYPE_DELAY) { |
| 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 == LCD_EXT_CMD_TYPE_CMD) || |
| (type == LCD_EXT_CMD_TYPE_CMD_BIN)) { |
| ret = lcd_extern_spi_write(&table[i+1], (cmd_size-1)); |
| } else if (type == LCD_EXT_CMD_TYPE_CMD_DELAY) { |
| ret = lcd_extern_spi_write(&table[i+1], (cmd_size-2)); |
| if (table[i+cmd_size-1] > 0) |
| mdelay(table[i+cmd_size-1]); |
| } else { |
| EXTERR("%s: %s(%d): type 0x%02x invalid\n", |
| __func__, ext_config->name, |
| ext_config->index, type); |
| } |
| i += cmd_size; |
| step++; |
| } |
| break; |
| default: |
| EXTERR("%s: %s(%d): extern_type %d is not support\n", |
| __func__, ext_config->name, |
| ext_config->index, ext_config->type); |
| break; |
| } |
| |
| return ret; |
| } |
| |
| static int lcd_extern_power_ctrl(int flag) |
| { |
| unsigned char *table; |
| int cmd_size; |
| int ret = 0; |
| |
| /* step 1: power prepare */ |
| #ifdef LCD_EXT_I2C_PORT_INIT |
| if (ext_config->type == LCD_EXTERN_I2C) |
| aml_lcd_extern_i2c_bus_change(ext_config->i2c_bus); |
| #endif |
| if (ext_config->type == LCD_EXTERN_SPI) |
| spi_gpio_init(); |
| |
| /* step 2: power cmd */ |
| cmd_size = ext_config->cmd_size; |
| if (flag) |
| table = ext_config->table_init_on; |
| else |
| table = ext_config->table_init_off; |
| if (cmd_size < 1) { |
| EXTERR("%s: cmd_size %d is invalid\n", __func__, cmd_size); |
| ret = -1; |
| goto power_ctrl_next; |
| } |
| if (table == NULL) { |
| EXTERR("%s: init_table %d is NULL\n", __func__, flag); |
| ret = -1; |
| goto power_ctrl_next; |
| } |
| |
| 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); |
| |
| power_ctrl_next: |
| /* step 3: power finish */ |
| #ifdef LCD_EXT_I2C_PORT_INIT |
| if (ext_config->type == LCD_EXTERN_I2C) |
| aml_lcd_extern_i2c_bus_recovery(); |
| #endif |
| if (ext_config->type == LCD_EXTERN_SPI) |
| spi_gpio_off(); |
| |
| if (ret) { |
| EXTERR("%s: %s(%d): %d\n", __func__, ext_config->name, |
| ext_config->index, flag); |
| } else { |
| EXTPR("%s: %s(%d): %d\n", __func__, ext_config->name, |
| ext_config->index, flag); |
| } |
| return ret; |
| } |
| |
| static int lcd_extern_power_on(void) |
| { |
| int ret; |
| |
| aml_lcd_extern_pinmux_set(ext_config, 1); |
| ret = lcd_extern_power_ctrl(1); |
| return ret; |
| } |
| |
| static int lcd_extern_power_off(void) |
| { |
| int ret; |
| |
| ret = lcd_extern_power_ctrl(0); |
| aml_lcd_extern_pinmux_set(ext_config, 0); |
| |
| return ret; |
| } |
| |
| 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; |
| } |
| |
| if (ext_drv->config->type == LCD_EXTERN_SPI) |
| ext_drv->config->spi_delay_us = 1000 / ext_drv->config->spi_clk_freq; |
| |
| 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_default_probe(struct aml_lcd_extern_driver_s *ext_drv) |
| { |
| int ret = 0; |
| |
| ext_config = ext_drv->config; |
| ret = lcd_extern_driver_update(ext_drv); |
| ext_driver = ext_drv; |
| if (lcd_debug_print_flag) |
| EXTPR("%s: %d\n", __func__, ret); |
| return ret; |
| } |
| |
