From cfa88551106b5cc6440289d69a36039aa7dbbeaa Mon Sep 17 00:00:00 2001 From: huaqin87 Date: Mon, 13 Dec 2021 12:05:28 +0800 Subject: [PATCH] wt6670: wake up wt6670 when get version num pull up and pull down intb pin when read version num and update new firmware Change-Id: I3e2cd65e96993e26206ea46301c133a8febc3771 Signed-off-by: huaqin87 Reviewed-on: https://gerrit.mot.com/2138669 SME-Granted: SME Approvals Granted SLTApproved: Slta Waiver Tested-by: Jira Key Reviewed-by: Wei Xu Reviewed-by: Xiangpo Zhao Submit-Approved: Jira Key --- drivers/power/mmi_qc3p_wt6670f/Android.mk | 4 + drivers/power/mmi_qc3p_wt6670f/Kbuild | 4 +- drivers/power/mmi_qc3p_wt6670f/wt6670f.h | 1 + drivers/power/mmi_qc3p_wt6670f/wt6670f_qc3p.c | 78 +++--- .../power/mmi_qc3p_wt6670f/wt6670f_upgrade.c | 236 ++++++++++++++++-- 5 files changed, 254 insertions(+), 69 deletions(-) diff --git a/drivers/power/mmi_qc3p_wt6670f/Android.mk b/drivers/power/mmi_qc3p_wt6670f/Android.mk index 6db027ebe22f..616a776bf853 100644 --- a/drivers/power/mmi_qc3p_wt6670f/Android.mk +++ b/drivers/power/mmi_qc3p_wt6670f/Android.mk @@ -1,6 +1,10 @@ DLKM_DIR := motorola/kernel/modules LOCAL_PATH := $(call my-dir) +ifeq ($(MMI_QC3P_TURBO_CHARGER),true) + KERNEL_CFLAGS += CONFIG_MMI_QC3P_TURBO_CHARGER_ISP_5G=y +endif + include $(CLEAR_VARS) LOCAL_MODULE := mmi_qc3p_wt6670f.ko LOCAL_MODULE_TAGS := optional diff --git a/drivers/power/mmi_qc3p_wt6670f/Kbuild b/drivers/power/mmi_qc3p_wt6670f/Kbuild index 2111a0c2c19f..3aa60e03232d 100644 --- a/drivers/power/mmi_qc3p_wt6670f/Kbuild +++ b/drivers/power/mmi_qc3p_wt6670f/Kbuild @@ -2,6 +2,8 @@ EXTRA_CFLAGS += -Wall EXTRA_CFLAGS += -I$(ANDROID_BUILD_TOP)/motorola/kernel/modules/include EXTRA_CFLAGS += -I$(ANDROID_BUILD_TOP)/motorola/kernel/drivers/power/mmi_qc3p_wt6670f - +ifneq ($(filter m y,$(CONFIG_MMI_QC3P_TURBO_CHARGER_ISP_5G)),) + EXTRA_CFLAGS += -DCONFIG_MMI_QC3P_TURBO_CHARGER_ISP_5G +endif mmi_qc3p_wt6670f-objs += wt6670f_qc3p.o wt6670f_upgrade.o obj-m += mmi_qc3p_wt6670f.o diff --git a/drivers/power/mmi_qc3p_wt6670f/wt6670f.h b/drivers/power/mmi_qc3p_wt6670f/wt6670f.h index 54dca8c0b052..0e594c37fc6b 100644 --- a/drivers/power/mmi_qc3p_wt6670f/wt6670f.h +++ b/drivers/power/mmi_qc3p_wt6670f/wt6670f.h @@ -13,6 +13,7 @@ struct wt6670f { int i2c_scl_pin; int i2c_sda_pin; int reset_pin; + int intb_pin; int count; int chg_type; diff --git a/drivers/power/mmi_qc3p_wt6670f/wt6670f_qc3p.c b/drivers/power/mmi_qc3p_wt6670f/wt6670f_qc3p.c index 2f2c51be3349..947ce6650184 100644 --- a/drivers/power/mmi_qc3p_wt6670f/wt6670f_qc3p.c +++ b/drivers/power/mmi_qc3p_wt6670f/wt6670f_qc3p.c @@ -23,16 +23,7 @@ static DEFINE_MUTEX(wt6670f_i2c_access); //static DEFINE_MUTEX(wt6670f_access_lock); //static struct i2c_client *new_client; //static int wt6670f_reset_pin = -1; -//static int wt6670f_int_pin = -1; - -#if 0 -struct pinctrl *i2c6_pinctrl; -struct pinctrl_state *i2c6_i2c; -struct pinctrl_state *i2c6_scl_low; -struct pinctrl_state *i2c6_scl_high; -struct pinctrl_state *i2c6_sda_low; -struct pinctrl_state *i2c6_sda_high; -#endif +static int wt6670f_int_pin = -1; struct wt6670f *_wt = NULL; static int __wt6670f_write_word(struct wt6670f *wt, u8 reg, u16 data) @@ -215,7 +206,7 @@ EXPORT_SYMBOL_GPL(wt6670f_is_charger_ready); int wt6670f_get_firmware_version(void) { int ret; - u16 data; + u16 data = 0; ret = wt6670f_read_word(_wt, 0xBF, &data); if (ret < 0) @@ -404,15 +395,15 @@ int moto_tcmd_wt6670f_get_firmware_version(void) } EXPORT_SYMBOL_GPL(moto_tcmd_wt6670f_get_firmware_version); -/*static irqreturn_t wt6670f_intr_handler(int irq, void *data) +static irqreturn_t wt6670f_intr_handler(int irq, void *data) { pr_info("%s: read charger type!\n", __func__); _wt->chg_ready = true; return IRQ_HANDLED; -}*/ +} -/*static int wt6670f_parse_dt(struct device *dev) +static int wt6670f_parse_dt(struct device *dev) { struct device_node *np = dev->of_node; int ret = 0; @@ -422,33 +413,34 @@ EXPORT_SYMBOL_GPL(moto_tcmd_wt6670f_get_firmware_version); pr_info("%s: no of node\n", __func__); return -ENODEV; } -#if 0 - wt6670f_reset_pin = of_get_named_gpio(np,"wt6670f-reset-gpio",0); - if(wt6670f_reset_pin < 0){ - pr_info("%s: no reset\n", __func__); - return -ENODATA; + + _wt->reset_pin = of_get_named_gpio(np, "wt6670f-reset-gpio", 0); + if (_wt->reset_pin < 0) + pr_info("[%s] of get wt6670 gpio failed, reset_pin:%d\n",__func__, _wt->reset_pin); + + if (gpio_request(_wt->reset_pin, "wt6670_reset_pin")) { + pr_info("[%s]reset gpio_request failed", __func__); } - else - pr_info("%s: wt6670f-reset-gpio = %d\n", __func__,wt6670f_reset_pin); - gpio_request(wt6670f_reset_pin,"wt6670f_reset"); - gpio_direction_output(wt6670f_reset_pin,0); -#endif + if (gpio_direction_output(_wt->reset_pin, 0)) + pr_info("[%s] gpio_direction_output reset_pin failed", __func__); wt6670f_int_pin = of_get_named_gpio(np,"wt6670f-int-gpio",0); if(wt6670f_int_pin < 0){ - pr_info("%s: no int\n", __func__); - return -ENODATA; + pr_info("%s: get wt6670f-int-gpio failed\n", __func__); } - else - pr_info("%s: wt6670f-int-gpio = %d\n", __func__,wt6670f_int_pin); - gpio_request(wt6670f_int_pin,"wt6670f_int"); - gpio_direction_input(wt6670f_int_pin); //configure to input mode + + if (gpio_request(wt6670f_int_pin,"wt6670f_int")) { + pr_info("[%s]wt6670f_int gpio_request failed", __func__); + } + if (gpio_direction_input(wt6670f_int_pin)) + pr_info("[%s] gpio_direction_input wt6670f_int_pin failed", __func__); + _wt->intb_pin = wt6670f_int_pin; ret = request_irq(gpio_to_irq(wt6670f_int_pin), wt6670f_intr_handler, IRQF_TRIGGER_FALLING | IRQF_ONESHOT, "wt6670f int", dev); enable_irq_wake(gpio_to_irq(wt6670f_int_pin)); return 0; -}*/ +} static int wt6670_iio_write_raw(struct iio_dev *indio_dev, struct iio_chan_spec const *chan, int val1, @@ -619,29 +611,20 @@ static int wt6670f_i2c_probe(struct i2c_client *client, i2c_set_clientdata(client, wt); mutex_init(&wt->i2c_rw_lock); - wt->reset_pin = of_get_named_gpio(wt->dev->of_node, "wt6670f-reset-gpio", 0); - if (wt->reset_pin < 0) - pr_info("[%s] of get wt6670 gpio failed, reset_pin:%d\n", - __func__, wt->reset_pin); - - if (gpio_request(wt->reset_pin, "wt6670_reset_pin")) { - pr_info("[%s] gpio_request reset failed", __func__); - return 0; - } - - if (gpio_direction_output(wt->reset_pin, 0)) - pr_info("[%s] gpio_direction_output failed", __func__); - _wt = wt; -/* ret = wt6670f_parse_dt(&client->dev); + ret = wt6670f_parse_dt(&client->dev); if (ret < 0) - pr_info("%s: parse dt error\n", __func__);*/ + pr_info("%s: parse dt error\n", __func__); wt6670f_create_device_node(&(client->dev)); //wt6670f_do_reset(); wt6670f_reset_chg_type(); + gpio_direction_output(_wt->intb_pin,0); + usleep_range(5000,6000); + gpio_direction_output(_wt->intb_pin,1); + usleep_range(5000,6000); firmware_version = wt6670f_get_firmware_version(); pr_info("[%s] firmware_version = %d, chg_type = 0x%x\n", __func__,firmware_version, _wt->chg_type); @@ -658,7 +641,8 @@ static int wt6670f_i2c_probe(struct i2c_client *client, ret = wt6670_init_iio_psy(wt); if (ret < 0) pr_info("%s: init iio sys error\n", __func__); - + if (gpio_direction_input(wt6670f_int_pin)) + pr_info("[%s] gpio_direction_input wt6670f_int_pin failed", __func__); return 0; } diff --git a/drivers/power/mmi_qc3p_wt6670f/wt6670f_upgrade.c b/drivers/power/mmi_qc3p_wt6670f/wt6670f_upgrade.c index 4d5e64545521..db479adb77b7 100644 --- a/drivers/power/mmi_qc3p_wt6670f/wt6670f_upgrade.c +++ b/drivers/power/mmi_qc3p_wt6670f/wt6670f_upgrade.c @@ -27,8 +27,201 @@ extern int wt6670f_isp_do_reset(void); //extern void set_i2c_speed(int id, unsigned int speed_hz); #define WT6670_ISP_I2C_ADDR 0x34 - +#ifdef CONFIG_MMI_QC3P_TURBO_CHARGER_ISP_5G +#define WT6670_WRITE_BYTE 0x01 +#else +#define WT6670_WRITE_BYTE 0x40 +#endif #if 1 +unsigned char WT70F_QC3p_V02_210326_FBA1_bin[] = { +0x02, 0x0A, 0x54, 0x02, 0x07, 0xB8, 0xC2, 0x8D, 0x05, 0x0E, 0x32, 0x02, 0x00, 0x06, 0x75, 0x4D, +0x01, 0x22, 0x32, 0x02, 0x00, 0x12, 0xE5, 0x24, 0x30, 0xE7, 0x05, 0x75, 0x54, 0x18, 0x80, 0x03, +0x75, 0x54, 0x19, 0xE5, 0x24, 0x54, 0x7F, 0xFE, 0x7C, 0x00, 0xE4, 0x25, 0x25, 0xFF, 0xEC, 0x3E, +0xAD, 0x07, 0xFC, 0xE4, 0xFB, 0xAF, 0x54, 0x02, 0x0A, 0x77, 0x32, 0x02, 0x00, 0x3A, 0x03, 0x00, +0x32, 0xFF, 0xFF, 0x02, 0x00, 0x40, 0x30, 0x06, 0x14, 0xC3, 0xE5, 0x1C, 0x94, 0xF4, 0xE5, 0x1B, +0x94, 0x01, 0x40, 0x09, 0xC2, 0x06, 0x90, 0x00, 0x11, 0xE0, 0x44, 0x08, 0xF0, 0xC3, 0xE5, 0x0D, +0x94, 0x64, 0xE5, 0x0C, 0x94, 0x00, 0x40, 0x12, 0xE4, 0xF5, 0x0C, 0xF5, 0x0D, 0x7F, 0x02, 0x12, +0x08, 0x00, 0xAD, 0x07, 0xAC, 0x06, 0x8C, 0x50, 0x8D, 0x51, 0x22, 0x02, 0x02, 0x00, 0x20, 0x01, +0x02, 0x21, 0x3E, 0xAF, 0x23, 0xEF, 0xD3, 0x94, 0xB5, 0x50, 0x06, 0x74, 0x2B, 0x2F, 0xF8, 0xA6, +0x24, 0xEF, 0x24, 0x50, 0xB4, 0x0C, 0x00, 0x40, 0x02, 0x21, 0x39, 0x90, 0x00, 0xA5, 0x25, 0xE0, +0x50, 0x02, 0x05, 0x83, 0x73, 0x01, 0xBD, 0x01, 0xCB, 0x21, 0x39, 0x01, 0xD2, 0x01, 0xEB, 0x21, +0x04, 0x21, 0x13, 0x21, 0x39, 0x21, 0x39, 0x21, 0x39, 0x21, 0x28, 0x21, 0x30, 0x75, 0x2C, 0x01, +0xE4, 0xF5, 0x30, 0x90, 0x00, 0x81, 0xF0, 0x7D, 0x04, 0x80, 0x54, 0xAF, 0x24, 0x12, 0x0A, 0x2C, +0x80, 0x67, 0xE4, 0x90, 0x00, 0x81, 0xF0, 0x90, 0x00, 0x80, 0xF0, 0x12, 0x0B, 0x02, 0x75, 0x2F, +0x01, 0x75, 0x4D, 0x01, 0xE4, 0xF5, 0x11, 0xF5, 0x12, 0x80, 0x4E, 0xE5, 0x24, 0x64, 0x01, 0x70, +0x48, 0x90, 0x00, 0x81, 0xF0, 0x75, 0x43, 0x11, 0xF5, 0x44, 0xF5, 0x47, 0xF5, 0x4D, 0xF5, 0x19, +0xF5, 0x1A, 0x80, 0x35, 0xE5, 0x24, 0x64, 0x01, 0x70, 0x2F, 0xF5, 0x11, 0xF5, 0x12, 0x12, 0x0A, +0x98, 0x80, 0x26, 0xE5, 0x24, 0xB4, 0x01, 0x21, 0xE5, 0x4D, 0xB4, 0x02, 0x1C, 0x7D, 0x1A, 0x7F, +0xF4, 0x7E, 0x01, 0x12, 0x0B, 0x4D, 0x80, 0x11, 0x85, 0x24, 0x33, 0x85, 0x25, 0x34, 0x80, 0x06, +0x85, 0x24, 0x35, 0x85, 0x25, 0x36, 0x12, 0x00, 0x16, 0xE4, 0xF5, 0x23, 0xC2, 0x01, 0x30, 0x02, +0x17, 0xE5, 0x23, 0x24, 0x4D, 0x60, 0x09, 0x24, 0x03, 0x70, 0x08, 0xE4, 0xF5, 0x2C, 0x80, 0x03, +0xE4, 0xF5, 0x2F, 0xE4, 0xF5, 0x23, 0xC2, 0x02, 0x22, 0x90, 0x00, 0xA1, 0xE0, 0x20, 0xE2, 0x77, +0x30, 0xE3, 0x06, 0x12, 0x0B, 0x75, 0xC2, 0x00, 0x22, 0x20, 0x00, 0x49, 0x90, 0x00, 0xA3, 0xE0, +0xF5, 0x23, 0xE5, 0x23, 0x24, 0x42, 0x60, 0x12, 0x14, 0x60, 0x1A, 0x24, 0x02, 0x70, 0x1F, 0x75, +0x3C, 0x00, 0x75, 0x3D, 0x00, 0x75, 0x3E, 0x43, 0x80, 0x14, 0x75, 0x3C, 0x00, 0x75, 0x3D, 0x00, +0x75, 0x3E, 0x50, 0x80, 0x09, 0x75, 0x3C, 0xFF, 0x75, 0x3D, 0x00, 0x75, 0x3E, 0x3E, 0xAB, 0x3C, +0xAA, 0x3D, 0xA9, 0x3E, 0x12, 0x07, 0x1D, 0x90, 0x00, 0xA3, 0xF0, 0xD2, 0x00, 0x75, 0x22, 0x01, +0x75, 0x3B, 0x01, 0x80, 0x0E, 0x90, 0x00, 0xA3, 0xE0, 0xFF, 0x74, 0x23, 0x25, 0x22, 0xF8, 0xA6, +0x07, 0x05, 0x22, 0x12, 0x0B, 0x75, 0x90, 0x00, 0xA1, 0xE0, 0x30, 0xE5, 0x32, 0x90, 0x00, 0xA0, +0xE0, 0x44, 0x03, 0xF0, 0xD2, 0x01, 0x22, 0xAB, 0x3C, 0xAA, 0x3D, 0xA9, 0x3E, 0x85, 0x3B, 0x82, +0x75, 0x83, 0x00, 0x12, 0x07, 0x36, 0x90, 0x00, 0xA3, 0xF0, 0x05, 0x3B, 0x12, 0x0B, 0x75, 0x90, +0x00, 0xA1, 0xE0, 0x30, 0xE5, 0x09, 0x90, 0x00, 0xA0, 0xE0, 0x44, 0x01, 0xF0, 0xD2, 0x02, 0x22, +0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0xC0, 0x00, 0x75, 0xD0, 0x00, 0xC3, +0xE5, 0x81, 0x94, 0x07, 0xF8, 0xA6, 0xFD, 0x08, 0xA6, 0xF5, 0x90, 0x00, 0x78, 0x74, 0xA0, 0xF0, +0xD2, 0xFB, 0x74, 0xA0, 0x55, 0xF8, 0xB4, 0xA0, 0xF9, 0xE5, 0xF9, 0xB4, 0x00, 0x02, 0x41, 0xF7, +0xB4, 0x01, 0x02, 0x80, 0x60, 0xB4, 0x02, 0x02, 0x80, 0x6E, 0xB4, 0x03, 0x02, 0x80, 0x72, 0xB4, +0x04, 0x02, 0x80, 0x79, 0xB4, 0x05, 0x02, 0x80, 0x7D, 0xB4, 0x06, 0x02, 0x41, 0xD2, 0xB4, 0x07, +0x02, 0x41, 0xE3, 0xB4, 0x16, 0x02, 0x80, 0x07, 0xB4, 0x17, 0x02, 0x80, 0x1C, 0x80, 0xC3, 0x30, +0xFD, 0xFD, 0x85, 0xF9, 0x83, 0x30, 0xFD, 0xFD, 0x85, 0xF9, 0x82, 0xE0, 0xF5, 0xF9, 0xA3, 0x20, +0xFE, 0x02, 0x80, 0xF7, 0x20, 0xFC, 0x1C, 0x80, 0xF6, 0x30, 0xFD, 0xFD, 0x85, 0xF9, 0x83, 0x30, +0xFD, 0xFD, 0x85, 0xF9, 0x82, 0x30, 0xFD, 0x06, 0xE5, 0xF9, 0xF0, 0xA3, 0x80, 0xF7, 0x20, 0xFC, +0x02, 0x80, 0xF2, 0x80, 0x8D, 0x30, 0xFD, 0xFD, 0x85, 0xF9, 0x83, 0x30, 0xFD, 0xFD, 0x85, 0xF9, +0x82, 0x74, 0x00, 0x93, 0xF5, 0xF9, 0x41, 0x22, 0x30, 0xFD, 0xFD, 0xA8, 0xF9, 0x86, 0xF9, 0x41, +0x22, 0x30, 0xFD, 0xFD, 0xA8, 0xF9, 0x30, 0xFD, 0xFD, 0xA6, 0xF9, 0x41, 0x22, 0x30, 0xFD, 0xFD, +0xE5, 0xF9, 0xF5, 0xF9, 0x41, 0x22, 0x30, 0xFD, 0xFD, 0xE5, 0xF9, 0x30, 0xFD, 0xFD, 0xF5, 0xF9, +0x41, 0x22, 0x30, 0xFD, 0xFD, 0x85, 0xF9, 0x83, 0x30, 0xFD, 0xFD, 0x85, 0xF9, 0x82, 0xE0, 0xF5, +0xF9, 0x41, 0x22, 0x30, 0xFD, 0xFD, 0x85, 0xF9, 0x83, 0x30, 0xFD, 0xFD, 0x85, 0xF9, 0x82, 0x30, +0xFD, 0xFD, 0xE5, 0xF9, 0xF0, 0x41, 0x22, 0x53, 0x88, 0x5F, 0x90, 0x00, 0x7C, 0xE0, 0x44, 0x20, +0xF0, 0x90, 0x00, 0xB2, 0xE0, 0x44, 0x10, 0xF0, 0xC2, 0xFB, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, +0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE5, 0x47, 0x14, 0xB4, +0x1A, 0x00, 0x40, 0x02, 0xC1, 0x32, 0x90, 0x03, 0x30, 0x25, 0xE0, 0x50, 0x02, 0x05, 0x83, 0x73, +0x61, 0x64, 0x61, 0x72, 0x61, 0x80, 0x61, 0x9B, 0x61, 0xA8, 0x61, 0xCA, 0x61, 0xE8, 0x61, 0xF6, +0x81, 0x28, 0x81, 0x36, 0x81, 0x56, 0x81, 0x61, 0x81, 0xA4, 0x81, 0xBD, 0x81, 0xC5, 0x81, 0xFB, +0xA1, 0x03, 0xA1, 0x32, 0xA1, 0x3A, 0xA1, 0x7C, 0xA1, 0x7E, 0xA1, 0xE0, 0xA1, 0xEF, 0xC1, 0x15, +0xC1, 0x23, 0x61, 0x6E, 0xD2, 0x05, 0xE4, 0xF5, 0x0C, 0xF5, 0x0D, 0xF5, 0x47, 0x22, 0x7D, 0x02, +0x80, 0x52, 0x90, 0x00, 0x81, 0x74, 0x01, 0xF0, 0x7D, 0x05, 0x7F, 0x88, 0x7E, 0x13, 0xA1, 0xEC, +0xC3, 0xE5, 0x14, 0x95, 0x41, 0xE5, 0x13, 0x95, 0x40, 0x50, 0x02, 0xC1, 0x32, 0x85, 0x49, 0x47, +0xE4, 0xF5, 0x15, 0xF5, 0x16, 0xF5, 0x17, 0xF5, 0x18, 0x81, 0x9F, 0x90, 0x00, 0x81, 0x74, 0x01, +0xF0, 0x7D, 0x05, 0x7F, 0xF4, 0xFE, 0xA1, 0xEC, 0x12, 0x06, 0x33, 0x50, 0x02, 0xC1, 0x32, 0x12, +0x08, 0xA2, 0x40, 0x08, 0x75, 0x43, 0x07, 0xE4, 0xF5, 0x44, 0x81, 0x51, 0x90, 0x00, 0x81, 0x74, +0x42, 0xF0, 0x7D, 0x06, 0x7F, 0xF4, 0x7E, 0x01, 0xA1, 0xEC, 0x12, 0x06, 0x33, 0x50, 0x02, 0xC1, +0x32, 0x12, 0x08, 0xA2, 0xE4, 0x90, 0x00, 0x81, 0x40, 0x05, 0xF0, 0x7D, 0x07, 0x80, 0x03, 0xF0, +0x7D, 0x09, 0x7F, 0xF4, 0x7E, 0x01, 0xA1, 0xEC, 0x90, 0x00, 0x81, 0x74, 0x14, 0xF0, 0x7D, 0x08, +0x7F, 0xF4, 0x7E, 0x01, 0xA1, 0xEC, 0x12, 0x06, 0x51, 0x12, 0x08, 0xBE, 0x50, 0x02, 0xC1, 0x32, +0x12, 0x08, 0xA2, 0x40, 0x11, 0x75, 0x43, 0x04, 0xE4, 0xF5, 0x44, 0x7D, 0x0B, 0x7F, 0xF4, 0x7E, +0x01, 0x12, 0x0B, 0x4D, 0x80, 0x0C, 0x75, 0x43, 0x03, 0xE4, 0xF5, 0x44, 0x75, 0x47, 0x01, 0x12, +0x0B, 0x3E, 0xE4, 0x90, 0x00, 0x81, 0xF0, 0x22, 0x90, 0x00, 0x81, 0x74, 0x21, 0xF0, 0x7D, 0x0A, +0x7F, 0xF4, 0x7E, 0x01, 0xA1, 0xEC, 0x12, 0x06, 0x51, 0x12, 0x08, 0xBE, 0x50, 0x02, 0xC1, 0x32, +0x12, 0x08, 0xA2, 0x40, 0x05, 0x75, 0x43, 0x01, 0x80, 0x03, 0x75, 0x43, 0x02, 0xE4, 0xF5, 0x44, +0xE4, 0x90, 0x00, 0x81, 0xC1, 0x0E, 0x12, 0x08, 0xF1, 0x7D, 0x0C, 0x7F, 0xF4, 0x7E, 0x01, 0xA1, +0xEC, 0xC3, 0xE5, 0x16, 0x94, 0x98, 0xE5, 0x15, 0x94, 0x3A, 0x40, 0x02, 0xA1, 0x7C, 0x7F, 0x01, +0x12, 0x08, 0x00, 0x8E, 0x55, 0x8F, 0x56, 0xC3, 0x12, 0x08, 0xA2, 0x50, 0x21, 0xC3, 0x12, 0x08, +0xBE, 0x50, 0x02, 0xC1, 0x32, 0xE5, 0x16, 0x94, 0x40, 0xE5, 0x15, 0x94, 0x1F, 0x40, 0x0B, 0xE4, +0xF5, 0x44, 0x7D, 0x0D, 0x7F, 0xD0, 0x7E, 0x07, 0xA1, 0xEC, 0x75, 0x47, 0x01, 0x22, 0xE4, 0xF5, +0x0A, 0xF5, 0x0B, 0x22, 0x90, 0x00, 0x81, 0x74, 0x48, 0xF0, 0x7B, 0x0E, 0x7D, 0x10, 0x7C, 0x00, +0x7F, 0x18, 0x12, 0x0A, 0x77, 0x7D, 0x18, 0x7F, 0xB0, 0x7E, 0x04, 0xA1, 0xEC, 0x7D, 0x0F, 0x7F, +0xF4, 0x7E, 0x01, 0xA1, 0xEC, 0x12, 0x06, 0x46, 0xE5, 0x56, 0x94, 0x9B, 0xE5, 0x55, 0x94, 0x01, +0x40, 0x1B, 0x7B, 0x10, 0x7D, 0x10, 0x7C, 0x00, 0x7F, 0x19, 0x12, 0x0A, 0x77, 0x7D, 0x19, 0x7F, +0xF4, 0x7E, 0x01, 0x12, 0x0B, 0x4D, 0x75, 0x43, 0x06, 0xE4, 0xF5, 0x44, 0x22, 0x75, 0x44, 0x03, +0x12, 0x08, 0xF1, 0x7D, 0x16, 0x7F, 0xE8, 0x7E, 0x03, 0xA1, 0xEC, 0x7D, 0x11, 0x7F, 0xB0, 0x7E, +0x04, 0xA1, 0xEC, 0x12, 0x08, 0xF8, 0x40, 0x02, 0x80, 0x35, 0x12, 0x06, 0x46, 0xE5, 0x56, 0x94, +0x17, 0xE5, 0x55, 0x94, 0x01, 0x40, 0x15, 0xE5, 0x18, 0x94, 0x64, 0xE5, 0x17, 0x94, 0x00, 0x50, +0x02, 0xC1, 0x32, 0x7B, 0x12, 0x7D, 0x06, 0x7F, 0xA8, 0x02, 0x0B, 0x18, 0xE4, 0xF5, 0x17, 0xF5, +0x18, 0x22, 0x7D, 0x13, 0x7F, 0xC8, 0x7E, 0x00, 0xA1, 0xEC, 0x12, 0x08, 0xF8, 0x40, 0x05, 0x75, +0x44, 0x03, 0xC1, 0x0F, 0x12, 0x06, 0x5C, 0xE5, 0x18, 0x94, 0x64, 0xE5, 0x17, 0x94, 0x00, 0x50, +0x02, 0xC1, 0x32, 0xE5, 0x56, 0x94, 0x81, 0xE5, 0x55, 0x94, 0x01, 0x40, 0x08, 0x12, 0x06, 0x67, +0x75, 0x43, 0x09, 0x80, 0x13, 0xC3, 0xE5, 0x56, 0x94, 0x4C, 0xE5, 0x55, 0x94, 0x01, 0x50, 0x02, +0xC1, 0x32, 0x12, 0x06, 0x67, 0x75, 0x43, 0x08, 0x75, 0x44, 0x04, 0x22, 0xC1, 0x0F, 0x12, 0x08, +0x98, 0x40, 0x02, 0xC1, 0x2F, 0xC3, 0xE5, 0x09, 0x95, 0x42, 0xE5, 0x08, 0x94, 0x00, 0x50, 0x02, +0xC1, 0x32, 0x90, 0x00, 0x81, 0xE0, 0xF5, 0x54, 0xE5, 0x4C, 0x30, 0xE7, 0x1B, 0x53, 0x54, 0x0F, +0x20, 0x04, 0x07, 0xD2, 0x04, 0x43, 0x54, 0x80, 0x80, 0x19, 0xC2, 0x04, 0x43, 0x54, 0x40, 0x12, +0x08, 0xB6, 0x70, 0x20, 0x05, 0x45, 0x80, 0x1C, 0x53, 0x54, 0xF0, 0x30, 0x03, 0x0A, 0xC2, 0x03, +0x43, 0x54, 0x04, 0x75, 0x42, 0x16, 0x80, 0x12, 0xD2, 0x03, 0x43, 0x54, 0x08, 0x12, 0x08, 0xB6, +0x70, 0x02, 0x05, 0x45, 0xE5, 0x4C, 0x25, 0xE0, 0xF5, 0x4C, 0xE5, 0x54, 0x12, 0x08, 0xAC, 0x22, +0x90, 0x00, 0x81, 0x74, 0x84, 0xF0, 0x7D, 0x17, 0x7F, 0xE8, 0x7E, 0x03, 0x02, 0x0B, 0x4D, 0x12, +0x06, 0x5C, 0xE5, 0x18, 0x94, 0x32, 0xE5, 0x17, 0x94, 0x00, 0x40, 0x36, 0xE5, 0x56, 0x94, 0xC0, +0xE5, 0x55, 0x94, 0x01, 0x40, 0x03, 0x75, 0x43, 0x05, 0x90, 0x00, 0x81, 0x74, 0x40, 0xF0, 0x75, +0x47, 0x01, 0x02, 0x0B, 0x3E, 0x12, 0x09, 0x97, 0x8F, 0x54, 0xE5, 0x54, 0xD3, 0x94, 0x00, 0x40, +0x11, 0x80, 0x0C, 0x12, 0x09, 0xCD, 0x8F, 0x54, 0xE5, 0x54, 0xD3, 0x94, 0x00, 0x40, 0x03, 0x85, +0x3F, 0x47, 0x22, 0x7F, 0x01, 0x12, 0x08, 0x00, 0x8E, 0x55, 0x8F, 0x56, 0xC3, 0xE5, 0x0B, 0x94, +0x32, 0xE5, 0x0A, 0x94, 0x00, 0x22, 0x7F, 0x02, 0x12, 0x08, 0x00, 0x8E, 0x55, 0x8F, 0x56, 0xC3, +0x22, 0xE4, 0xFF, 0x12, 0x08, 0x00, 0x8E, 0x55, 0x8F, 0x56, 0xC3, 0x22, 0x7F, 0x02, 0x12, 0x08, +0x00, 0x8E, 0x55, 0x8F, 0x56, 0xC3, 0x22, 0x7B, 0x14, 0x7D, 0x04, 0x7F, 0xC0, 0x12, 0x0B, 0x18, +0x22, 0x7F, 0x02, 0x12, 0x08, 0x00, 0x8E, 0x54, 0x8F, 0x55, 0xE5, 0x4D, 0x14, 0x60, 0x17, 0x14, +0x60, 0x6D, 0x24, 0x02, 0x60, 0x02, 0xE1, 0x1C, 0x12, 0x08, 0xD3, 0x50, 0x02, 0xE1, 0x1C, 0xE4, +0xF5, 0x19, 0xF5, 0x1A, 0x80, 0x4E, 0xC3, 0xE5, 0x55, 0x94, 0xB8, 0xE5, 0x54, 0x94, 0x00, 0x40, +0x24, 0xD3, 0xE5, 0x55, 0x94, 0x3C, 0xE5, 0x54, 0x94, 0x01, 0x50, 0x19, 0x12, 0x08, 0xDD, 0x40, +0x19, 0xE4, 0xF5, 0x11, 0xF5, 0x12, 0x75, 0x4D, 0x02, 0x90, 0x00, 0x81, 0xF0, 0x90, 0x00, 0x80, +0x74, 0xC0, 0xF0, 0x80, 0x05, 0xE4, 0xF5, 0x11, 0xF5, 0x12, 0x12, 0x08, 0xE7, 0x50, 0x18, 0x12, +0x08, 0xD3, 0x40, 0x48, 0xE4, 0xF5, 0x19, 0xF5, 0x1A, 0x05, 0x48, 0xE5, 0x48, 0x94, 0x0A, 0x40, +0x3B, 0xE4, 0xF5, 0x48, 0x02, 0x0A, 0x98, 0xE4, 0xF5, 0x48, 0xF5, 0x19, 0xF5, 0x1A, 0x22, 0x12, +0x08, 0xE7, 0x50, 0x23, 0x12, 0x08, 0xDD, 0x40, 0x23, 0x75, 0x43, 0x11, 0xE4, 0xF5, 0x44, 0xF5, +0x11, 0xF5, 0x12, 0xF5, 0x19, 0xF5, 0x1A, 0xF5, 0x48, 0x75, 0x4D, 0x01, 0xF5, 0x47, 0xC2, 0x05, +0x90, 0x00, 0x81, 0xF0, 0x02, 0x0B, 0x02, 0xE4, 0xF5, 0x11, 0xF5, 0x12, 0x22, 0xBB, 0x01, 0x06, +0x89, 0x82, 0x8A, 0x83, 0xE0, 0x22, 0x50, 0x02, 0xE7, 0x22, 0xBB, 0xFE, 0x02, 0xE3, 0x22, 0x89, +0x82, 0x8A, 0x83, 0xE4, 0x93, 0x22, 0xBB, 0x01, 0x0C, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, +0x3A, 0xF5, 0x83, 0xE0, 0x22, 0x50, 0x06, 0xE9, 0x25, 0x82, 0xF8, 0xE6, 0x22, 0xBB, 0xFE, 0x06, +0xE9, 0x25, 0x82, 0xF8, 0xE2, 0x22, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, +0xE4, 0x93, 0x22, 0xBC, 0x00, 0x0B, 0xBE, 0x00, 0x29, 0xEF, 0x8D, 0xF0, 0x84, 0xFF, 0xAD, 0xF0, +0x22, 0xE4, 0xCC, 0xF8, 0x75, 0xF0, 0x08, 0xEF, 0x2F, 0xFF, 0xEE, 0x33, 0xFE, 0xEC, 0x33, 0xFC, +0xEE, 0x9D, 0xEC, 0x98, 0x40, 0x05, 0xFC, 0xEE, 0x9D, 0xFE, 0x0F, 0xD5, 0xF0, 0xE9, 0xE4, 0xCE, +0xFD, 0x22, 0xED, 0xF8, 0xF5, 0xF0, 0xEE, 0x84, 0x20, 0xD2, 0x1C, 0xFE, 0xAD, 0xF0, 0x75, 0xF0, +0x08, 0xEF, 0x2F, 0xFF, 0xED, 0x33, 0xFD, 0x40, 0x07, 0x98, 0x50, 0x06, 0xD5, 0xF0, 0xF2, 0x22, +0xC3, 0x98, 0xFD, 0x0F, 0xD5, 0xF0, 0xEA, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, +0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, +0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x00, 0x35, 0xE0, 0x30, 0xE1, 0x03, 0x12, 0x01, 0x59, 0xD0, +0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, +0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x12, 0x0A, 0xB8, 0x02, 0x0B, 0x5C, +0xA9, 0x07, 0x90, 0x08, 0x10, 0x12, 0x0A, 0xE4, 0x90, 0x08, 0x11, 0xE0, 0x7C, 0x00, 0x2F, 0xFF, +0xEC, 0x35, 0xF0, 0xAD, 0x07, 0xFC, 0x90, 0x08, 0x12, 0x12, 0x0A, 0xE4, 0xAE, 0xF0, 0x90, 0x08, +0x13, 0xE0, 0x7A, 0x00, 0x2F, 0xF5, 0x58, 0xEA, 0x3E, 0xF5, 0x57, 0x90, 0x00, 0xD3, 0xE9, 0xF0, +0x00, 0x00, 0x90, 0x00, 0xD0, 0xE0, 0x44, 0x40, 0xF0, 0x00, 0x90, 0x00, 0xD2, 0xE0, 0x30, 0xE2, +0xF8, 0x90, 0x00, 0xD6, 0x12, 0x0A, 0xE4, 0x90, 0x00, 0xD7, 0xE0, 0x54, 0x03, 0x7A, 0x00, 0x2F, +0xFF, 0xEA, 0x35, 0xF0, 0xFE, 0xE9, 0x64, 0x02, 0x70, 0x3B, 0xD3, 0xEF, 0x94, 0x0A, 0xEE, 0x94, +0x00, 0x40, 0x32, 0xE4, 0x2D, 0xFB, 0xEC, 0x34, 0x01, 0xFA, 0xC3, 0xEF, 0x9B, 0xEE, 0x9A, 0x50, +0x24, 0xC3, 0xEF, 0x9D, 0xEE, 0x9C, 0x40, 0x0E, 0xEF, 0x9D, 0x12, 0x0A, 0xD3, 0xEF, 0x24, 0x07, +0xFF, 0xEE, 0x34, 0x01, 0xFE, 0x22, 0xC3, 0xED, 0x9F, 0x12, 0x0A, 0xD3, 0xC3, 0x74, 0x07, 0x9F, +0xFF, 0x74, 0x01, 0x9E, 0xFE, 0x22, 0xE4, 0xFF, 0xC3, 0xE5, 0x46, 0x95, 0x4B, 0xE5, 0x45, 0x95, +0x4A, 0x22, 0xE5, 0x56, 0x94, 0xAA, 0xE5, 0x55, 0x94, 0x00, 0x22, 0xEE, 0x90, 0x00, 0x81, 0xF0, +0xE4, 0xF5, 0x08, 0xF5, 0x09, 0x22, 0x75, 0x42, 0x16, 0x05, 0x46, 0xE5, 0x46, 0x22, 0xE5, 0x0B, +0x94, 0x32, 0xE5, 0x0A, 0x94, 0x00, 0x22, 0xE5, 0x42, 0xFD, 0xC3, 0xE5, 0x09, 0x9D, 0xE5, 0x08, +0x94, 0x00, 0x22, 0xC3, 0xE5, 0x1A, 0x94, 0x10, 0xE5, 0x19, 0x94, 0x27, 0x22, 0xC3, 0xE5, 0x12, +0x94, 0xC8, 0xE5, 0x11, 0x94, 0x00, 0x22, 0xD3, 0xE5, 0x55, 0x94, 0x9E, 0xE5, 0x54, 0x94, 0x00, +0x22, 0x90, 0x00, 0x81, 0x74, 0x40, 0xF0, 0x22, 0xC3, 0xE5, 0x16, 0x94, 0xD0, 0xE5, 0x15, 0x94, +0x07, 0x22, 0x75, 0x08, 0x00, 0x75, 0x09, 0x16, 0x75, 0x42, 0x16, 0x22, 0xC0, 0xD0, 0x75, 0xD0, +0x00, 0x90, 0x00, 0x73, 0x74, 0x80, 0xF0, 0x90, 0x00, 0x78, 0xE0, 0x44, 0xA0, 0xF0, 0x12, 0x0A, +0xEB, 0x12, 0x0B, 0x2E, 0x12, 0x07, 0xFA, 0x12, 0x00, 0x0E, 0x12, 0x0B, 0x02, 0x90, 0x08, 0x10, +0xE0, 0xF5, 0x52, 0x90, 0x08, 0x11, 0xE0, 0xF5, 0x53, 0x90, 0x08, 0x12, 0xE0, 0xF5, 0x4E, 0x90, +0x08, 0x13, 0xE0, 0xF5, 0x4F, 0xD2, 0xB8, 0xD2, 0xA8, 0xD2, 0xAF, 0x12, 0x0A, 0x03, 0x12, 0x00, +0x46, 0x12, 0x06, 0x71, 0x12, 0x03, 0x1C, 0x12, 0x00, 0x7E, 0x80, 0xEF, 0x90, 0x00, 0x01, 0x74, +0xB8, 0xF0, 0x90, 0x00, 0x07, 0x74, 0xA4, 0xF0, 0xE4, 0x90, 0x00, 0x20, 0xF0, 0x90, 0x00, 0x10, +0xF0, 0x90, 0x00, 0x12, 0xF0, 0x90, 0x00, 0x80, 0xF0, 0x90, 0x00, 0x81, 0xF0, 0x90, 0x00, 0xD0, +0x74, 0x80, 0xF0, 0x90, 0x00, 0x60, 0x74, 0x20, 0xF0, 0x90, 0x00, 0x61, 0x74, 0x08, 0xF0, 0x90, +0x00, 0x6A, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x12, 0x08, 0x96, 0x50, 0x29, 0x12, 0x08, 0xC7, 0x40, +0x24, 0x90, 0x00, 0x81, 0xE0, 0xFE, 0x53, 0x06, 0x0F, 0x20, 0x04, 0x0A, 0xD2, 0x04, 0x43, 0x06, +0x80, 0x75, 0x42, 0x16, 0x80, 0x0C, 0xC2, 0x04, 0x43, 0x06, 0x40, 0x12, 0x08, 0xB6, 0x70, 0x02, +0x05, 0x45, 0x12, 0x08, 0xAB, 0x12, 0x08, 0x98, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x12, 0x08, 0x96, +0x50, 0x29, 0x12, 0x08, 0xC7, 0x40, 0x24, 0x90, 0x00, 0x81, 0xE0, 0xFE, 0x53, 0x06, 0xF0, 0x30, +0x03, 0x0A, 0xC2, 0x03, 0x43, 0x06, 0x04, 0x75, 0x42, 0x16, 0x80, 0x0C, 0xD2, 0x03, 0x43, 0x06, +0x08, 0x12, 0x08, 0xB6, 0x70, 0x02, 0x05, 0x45, 0x12, 0x08, 0xAB, 0x12, 0x08, 0x98, 0x40, 0x02, +0x7F, 0x01, 0x22, 0xAF, 0x0E, 0xEF, 0xC3, 0x94, 0x01, 0x40, 0x20, 0xE4, 0xF5, 0x0E, 0xFE, 0xEF, +0xFD, 0xEE, 0x25, 0xE0, 0x24, 0x0F, 0x12, 0x0B, 0x6A, 0xBE, 0x07, 0xF3, 0xE4, 0xFE, 0xEF, 0xFD, +0xEE, 0x25, 0xE0, 0x24, 0x08, 0x12, 0x0B, 0x6A, 0xBE, 0x03, 0xF3, 0x22, 0xEF, 0x24, 0xFE, 0x60, +0x0E, 0x14, 0x60, 0x12, 0x14, 0x60, 0x16, 0x24, 0x03, 0x70, 0x18, 0x12, 0x08, 0xF1, 0x22, 0x90, +0x00, 0x81, 0x74, 0x84, 0xF0, 0x22, 0x90, 0x00, 0x81, 0x74, 0x44, 0xF0, 0x22, 0x90, 0x00, 0x81, +0x74, 0x48, 0xF0, 0x22, 0x75, 0xA0, 0x00, 0x75, 0x81, 0x58, 0x78, 0x7F, 0xE4, 0xF6, 0xD8, 0xFD, +0x90, 0x01, 0x00, 0x7F, 0x00, 0x7E, 0x01, 0xE4, 0xF0, 0xA3, 0xDF, 0xFC, 0xDE, 0xFA, 0x43, 0xB8, +0x00, 0x75, 0xA8, 0x00, 0x02, 0x09, 0x0C, 0xE4, 0xF5, 0x45, 0xF5, 0x46, 0x8C, 0x4A, 0x8D, 0x4B, +0xBF, 0x18, 0x07, 0xC2, 0x04, 0x75, 0x47, 0x18, 0x80, 0x08, 0xBF, 0x19, 0x05, 0xD2, 0x03, 0x75, +0x47, 0x19, 0x12, 0x09, 0x02, 0x8B, 0x3F, 0x22, 0x12, 0x09, 0x5C, 0x00, 0x00, 0x00, 0x90, 0x00, +0x06, 0x74, 0x52, 0xF0, 0x00, 0x00, 0x00, 0x90, 0x00, 0x7C, 0xE0, 0x44, 0x80, 0xF0, 0x12, 0x0A, +0xEB, 0x12, 0x07, 0xFA, 0x75, 0x4D, 0x01, 0x22, 0x90, 0x00, 0xA4, 0x74, 0x6A, 0xF0, 0x90, 0x00, +0xA1, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x00, 0xA0, 0x74, 0x83, 0xF0, 0x90, 0x00, 0x30, 0xE0, 0x44, +0x02, 0xF0, 0x22, 0xFF, 0xEF, 0x7F, 0x00, 0xFE, 0xC3, 0xE5, 0x58, 0x9D, 0xFD, 0xE5, 0x57, 0x9C, +0xFC, 0x02, 0x07, 0x63, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xFF, 0x22, 0x90, 0x00, 0x11, 0x74, 0x08, +0xF0, 0x90, 0x00, 0x10, 0xF0, 0x90, 0x00, 0x12, 0x74, 0x03, 0xF0, 0x90, 0x00, 0x20, 0x74, 0x34, +0xF0, 0x22, 0x7F, 0x10, 0x78, 0x2B, 0xE4, 0xF6, 0x08, 0xDF, 0xFC, 0x75, 0x2E, 0x01, 0x75, 0x31, +0x01, 0x75, 0x43, 0x11, 0xE4, 0xF5, 0x44, 0x22, 0xE4, 0xF5, 0x45, 0xF5, 0x46, 0xED, 0x75, 0x4A, +0x00, 0xF5, 0x4B, 0x8F, 0x4C, 0x75, 0x47, 0x15, 0x8B, 0x3F, 0x12, 0x09, 0x02, 0x22, 0xC2, 0x8C, +0x43, 0x89, 0x02, 0x75, 0x8A, 0x9C, 0x75, 0x8C, 0x9C, 0xD2, 0x8C, 0xD2, 0xA9, 0x22, 0x90, 0x00, +0x11, 0xE0, 0x54, 0xF7, 0xF0, 0xD2, 0x06, 0xE4, 0xF5, 0x1B, 0xF5, 0x1C, 0x22, 0xE4, 0xF5, 0x13, +0xF5, 0x14, 0x8E, 0x40, 0x8F, 0x41, 0x75, 0x47, 0x03, 0x8D, 0x49, 0x22, 0x90, 0x00, 0xD1, 0x74, +0x81, 0xF0, 0x90, 0x00, 0xD0, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0xF8, 0x08, 0xED, 0x26, 0xF6, 0x18, +0xE4, 0x36, 0xF6, 0x0E, 0x22, 0x90, 0x00, 0xA0, 0xE0, 0x44, 0x02, 0xF0, 0x22 +}; +unsigned int WT70F_QC3p_V02_210326_FBA1_bin_len = 2941; +#endif +#if 0 unsigned char WT70F_QC3p_V02_210326_FBA1_bin[] = {//with id EB84 0x02, 0x07, 0xca, 0x02, 0x0a, 0x38, 0xc2, 0x8d, 0x05, 0x0e, 0x32, 0x02, 0x00, 0x06, 0x75, 0x4e, 0x01, 0x22, 0x32, 0x02, 0x00, 0x12, 0xe5, 0x25, @@ -564,7 +757,8 @@ unsigned char WT70F_QC3p_V02_210326_FBA1_bin[] = { }; unsigned int WT70F_QC3p_V02_210326_FBA1_bin_len = 3143; -#else +#endif +#if 0 unsigned char WT70F_QC3p_V02_210326_FBA1_bin[] = { 0x02, 0x07, 0xc5, 0x02, 0x0a, 0x0e, 0xc2, 0x8d, 0x05, 0x0e, 0x32, 0x02, 0x00, 0x06, 0x75, 0x4e, 0x01, 0x22, 0x32, 0x02, 0x00, 0x12, 0xe5, 0x25, @@ -1195,7 +1389,6 @@ int wt_restart_chip(struct wt6670f *chip) return ret; } - int wt6670f_isp_flow(struct wt6670f *chip) { u8 chip_id = 0; @@ -1207,9 +1400,9 @@ int wt6670f_isp_flow(struct wt6670f *chip) int len = 0; int read_flash_cnt = 0x0; u16 fw_ver = 0; - int ret = 0; + int ret = -1; - code = kzalloc(0x40, GFP_KERNEL); + code = kzalloc(WT6670_WRITE_BYTE, GFP_KERNEL); if (code == NULL) return -1; wt6670f_isp_do_reset(); @@ -1225,7 +1418,6 @@ int wt6670f_isp_flow(struct wt6670f *chip) if (chip_id != 0x70) { pr_info("[%s]wt6670 err, chip_id:%d, skip isp\n", __func__, chip_id); - ret = -1; goto isp_err; } pr_info("[%s]wt6670 chip_id=%d \n", __func__, chip_id); @@ -1242,17 +1434,17 @@ int wt6670f_isp_flow(struct wt6670f *chip) addr_bit_15_8 = (programed_cnt >> 8) & 0x0f; addr_bit_7_0 = programed_cnt % 0x100; - memset(code, 0, 0x40); + memset(code, 0, WT6670_WRITE_BYTE); wt_set_address_high_byte(chip, addr_bit_15_8); - if ((programed_cnt + 0x40) > WT70F_QC3p_V02_210326_FBA1_bin_len) + if ((programed_cnt + WT6670_WRITE_BYTE) > WT70F_QC3p_V02_210326_FBA1_bin_len) { - len = WT70F_QC3p_V02_210326_FBA1_bin_len % 0x40; + len = WT70F_QC3p_V02_210326_FBA1_bin_len % WT6670_WRITE_BYTE; } else { - len = 0x40; + len = WT6670_WRITE_BYTE; } for (i = 0; i < len; i++) @@ -1260,18 +1452,18 @@ int wt6670f_isp_flow(struct wt6670f *chip) code[i] = WT70F_QC3p_V02_210326_FBA1_bin[programed_cnt + i]; } - if (len != 0x40) + if (len != WT6670_WRITE_BYTE) { - for (i = len; i < 0x40; i++) + for (i = len; i < WT6670_WRITE_BYTE; i++) { code[i] = 0xff; } } - wt_program_flash_64byte(chip, addr_bit_7_0, code, 0x40); + wt_program_flash_64byte(chip, addr_bit_7_0, code, WT6670_WRITE_BYTE); wt_finish_erase_or_program(chip); - programed_cnt += 0x40; + programed_cnt += WT6670_WRITE_BYTE; } pr_info("[%s] finish program flash, start verify...\n", __func__); @@ -1283,18 +1475,18 @@ int wt6670f_isp_flow(struct wt6670f *chip) addr_bit_15_8 = (read_flash_cnt >> 8) & 0x0f; addr_bit_7_0 = read_flash_cnt % 0x100; - memset(code, 0, 0x40); + memset(code, 0, WT6670_WRITE_BYTE); wt_set_address_high_byte(chip, addr_bit_15_8); - wt_read_flash_64byte(chip, addr_bit_7_0, code, 0x40); + wt_read_flash_64byte(chip, addr_bit_7_0, code, WT6670_WRITE_BYTE); if (read_flash_cnt > WT70F_QC3p_V02_210326_FBA1_bin_len) { } - else if (read_flash_cnt + 0x40 > WT70F_QC3p_V02_210326_FBA1_bin_len) + else if (read_flash_cnt + WT6670_WRITE_BYTE > WT70F_QC3p_V02_210326_FBA1_bin_len) { - for (i = 0; i < WT70F_QC3p_V02_210326_FBA1_bin_len % 0x40; i++) + for (i = 0; i < WT70F_QC3p_V02_210326_FBA1_bin_len % WT6670_WRITE_BYTE; i++) { if (code[i] != WT70F_QC3p_V02_210326_FBA1_bin[read_flash_cnt + i]) { @@ -1308,7 +1500,7 @@ int wt6670f_isp_flow(struct wt6670f *chip) } else { - for (i = 0; i < 0x40; i++) + for (i = 0; i < WT6670_WRITE_BYTE; i++) { if (code[i] != WT70F_QC3p_V02_210326_FBA1_bin[read_flash_cnt + i]) { @@ -1319,14 +1511,16 @@ int wt6670f_isp_flow(struct wt6670f *chip) } } - read_flash_cnt += 0x40; + read_flash_cnt += WT6670_WRITE_BYTE; } pr_info("[%s] firmware update success!!!\n", __func__); - msleep(30); + ret = 0; + isp_err: wt_restart_chip(chip); kfree(code); //do not comment this line + msleep(10); fw_ver = wt6670f_get_firmware_version(); pr_info("%s: wt6670f firmware:%d!\n", __func__,fw_ver); return ret;