// SPDX-License-Identifier: GPL-2.0-or-later #define LOG_TAG "Firmware" #include "cts_config.h" #include "cts_platform.h" #include "cts_core.h" #include "cts_sfctrl.h" #include "cts_spi_flash.h" #include "cts_firmware.h" #include "cts_strerror.h" #include "cts_tcs.h" #include #include #include #ifdef CFG_CTS_DRIVER_BUILTIN_FIRMWARE #include "cts_builtin_firmware.h" #define NUM_DRIVER_BUILTIN_FIRMWARE ARRAY_SIZE(cts_driver_builtin_firmwares) #endif /* CFG_CTS_DRIVER_BUILTIN_FIRMWARE */ #define CTS_FIRMWARE_MULTI_SECTION_FILE_SIZE (0x20000) #define CTS_SECTION_ENABLE_FLAG (0x0000C35A) enum cts_firmware_section_offset { CTS_FIRMWARE_SECTION_OFFSET = 0x00000000, CTS_FIRMWARE_CRC_SECTION_OFFSET = 0x30000, CTS_DDIPARAM_SECTION_OFFSET = 0x00031000, CTS_DDIPARAM_CRC_SECTION_OFFSET = 0x33000, }; struct cts_firmware_sect_info { const u8 *firmware_sect; size_t firmware_sect_size; const u8 *firmware_crc_sect; size_t firmware_crc_sect_size; u32 firmware_sect_crc; const u8 *ddiparam_sect; size_t ddiparam_sect_size; const u8 *ddiparam_crc_sect; size_t ddiparam_crc_sect_size; u32 ddiparam_sect_crc; }; #define FIRMWARE_SECTION(firmware) \ ((firmware)->data) #define FIRMWARE_CRC_SECTION(firmware) \ ((firmware)->data + CTS_FIRMWARE_CRC_SECTION_OFFSET) #define DDIPARAM_SECTION(firmware) \ ((firmware)->data + CTS_DDIPARAM_SECTION_OFFSET) #define DDIPARAM_CRC_SECTION(firmware) \ ((firmware)->data + CTS_DDIPARAM_CRC_SECTION_OFFSET) #define FIRMWARE_SECTION_CRC(firmware) \ (get_unaligned_le32(FIRMWARE_CRC_SECTION(firmware))) #define FIRMWARE_SECTION_SIZE(firmware) \ (get_unaligned_le32(FIRMWARE_CRC_SECTION(firmware) + 4)) #define FIRMWARE_SECTION_CRC_ENABLE(firmware) \ (get_unaligned_le32(FIRMWARE_CRC_SECTION(firmware) + 8)) #define FIRMWARE_CRC_SECTION_SIZE (20) #define DDIPARAM_SECTION_ENABLE(firmware) \ (get_unaligned_le32(DDIPARAM_CRC_SECTION(firmware))) #define DDIPARAM_SECTION_CRC_ENABLE(firmware) \ (get_unaligned_le32(DDIPARAM_CRC_SECTION(firmware) + 4)) #define DDIPARAM_SECTION_CRC(firmware) \ (get_unaligned_le32(DDIPARAM_CRC_SECTION(firmware) + 8)) #define DDIPARAM_SECTION_SIZE(firmware) \ (get_unaligned_le32(DDIPARAM_CRC_SECTION(firmware) + 12)) #define DDIPARAM_CRC_SECTION_SIZE (17) u16 cts_crc16(const u8 *data, size_t len) { u16 crc = 0; const static u16 crc16_table[] = { 0x0000, 0x8005, 0x800F, 0x000A, 0x801B, 0x001E, 0x0014, 0x8011, 0x8033, 0x0036, 0x003C, 0x8039, 0x0028, 0x802D, 0x8027, 0x0022, 0x8063, 0x0066, 0x006C, 0x8069, 0x0078, 0x807D, 0x8077, 0x0072, 0x0050, 0x8055, 0x805F, 0x005A, 0x804B, 0x004E, 0x0044, 0x8041, 0x80C3, 0x00C6, 0x00CC, 0x80C9, 0x00D8, 0x80DD, 0x80D7, 0x00D2, 0x00F0, 0x80F5, 0x80FF, 0x00FA, 0x80EB, 0x00EE, 0x00E4, 0x80E1, 0x00A0, 0x80A5, 0x80AF, 0x00AA, 0x80BB, 0x00BE, 0x00B4, 0x80B1, 0x8093, 0x0096, 0x009C, 0x8099, 0x0088, 0x808D, 0x8087, 0x0082, 0x8183, 0x0186, 0x018C, 0x8189, 0x0198, 0x819D, 0x8197, 0x0192, 0x01B0, 0x81B5, 0x81BF, 0x01BA, 0x81AB, 0x01AE, 0x01A4, 0x81A1, 0x01E0, 0x81E5, 0x81EF, 0x01EA, 0x81FB, 0x01FE, 0x01F4, 0x81F1, 0x81D3, 0x01D6, 0x01DC, 0x81D9, 0x01C8, 0x81CD, 0x81C7, 0x01C2, 0x0140, 0x8145, 0x814F, 0x014A, 0x815B, 0x015E, 0x0154, 0x8151, 0x8173, 0x0176, 0x017C, 0x8179, 0x0168, 0x816D, 0x8167, 0x0162, 0x8123, 0x0126, 0x012C, 0x8129, 0x0138, 0x813D, 0x8137, 0x0132, 0x0110, 0x8115, 0x811F, 0x011A, 0x810B, 0x010E, 0x0104, 0x8101, 0x8303, 0x0306, 0x030C, 0x8309, 0x0318, 0x831D, 0x8317, 0x0312, 0x0330, 0x8335, 0x833F, 0x033A, 0x832B, 0x032E, 0x0324, 0x8321, 0x0360, 0x8365, 0x836F, 0x036A, 0x837B, 0x037E, 0x0374, 0x8371, 0x8353, 0x0356, 0x035C, 0x8359, 0x0348, 0x834D, 0x8347, 0x0342, 0x03C0, 0x83C5, 0x83CF, 0x03CA, 0x83DB, 0x03DE, 0x03D4, 0x83D1, 0x83F3, 0x03F6, 0x03FC, 0x83F9, 0x03E8, 0x83ED, 0x83E7, 0x03E2, 0x83A3, 0x03A6, 0x03AC, 0x83A9, 0x03B8, 0x83BD, 0x83B7, 0x03B2, 0x0390, 0x8395, 0x839F, 0x039A, 0x838B, 0x038E, 0x0384, 0x8381, 0x0280, 0x8285, 0x828F, 0x028A, 0x829B, 0x029E, 0x0294, 0x8291, 0x82B3, 0x02B6, 0x02BC, 0x82B9, 0x02A8, 0x82AD, 0x82A7, 0x02A2, 0x82E3, 0x02E6, 0x02EC, 0x82E9, 0x02F8, 0x82FD, 0x82F7, 0x02F2, 0x02D0, 0x82D5, 0x82DF, 0x02DA, 0x82CB, 0x02CE, 0x02C4, 0x82C1, 0x8243, 0x0246, 0x024C, 0x8249, 0x0258, 0x825D, 0x8257, 0x0252, 0x0270, 0x8275, 0x827F, 0x027A, 0x826B, 0x026E, 0x0264, 0x8261, 0x0220, 0x8225, 0x822F, 0x022A, 0x823B, 0x023E, 0x0234, 0x8231, 0x8213, 0x0216, 0x021C, 0x8219, 0x0208, 0x820D, 0x8207, 0x0202, }; while (len) { crc = (crc << 8) ^ crc16_table[((crc >> 8) ^ *data) & 0xFF]; data++; len--; } return crc; } u32 cts_crc32(const u8 *data, size_t len) { const static u32 crc32_table[] = { 0x00000000, 0x04C11DB7, 0x09823B6E, 0x0D4326D9, 0x130476DC, 0x17C56B6B, 0x1A864DB2, 0x1E475005, 0x2608EDB8, 0x22C9F00F, 0x2F8AD6D6, 0x2B4BCB61, 0x350C9B64, 0x31CD86D3, 0x3C8EA00A, 0x384FBDBD, 0x4C11DB70, 0x48D0C6C7, 0x4593E01E, 0x4152FDA9, 0x5F15ADAC, 0x5BD4B01B, 0x569796C2, 0x52568B75, 0x6A1936C8, 0x6ED82B7F, 0x639B0DA6, 0x675A1011, 0x791D4014, 0x7DDC5DA3, 0x709F7B7A, 0x745E66CD, 0x9823B6E0, 0x9CE2AB57, 0x91A18D8E, 0x95609039, 0x8B27C03C, 0x8FE6DD8B, 0x82A5FB52, 0x8664E6E5, 0xBE2B5B58, 0xBAEA46EF, 0xB7A96036, 0xB3687D81, 0xAD2F2D84, 0xA9EE3033, 0xA4AD16EA, 0xA06C0B5D, 0xD4326D90, 0xD0F37027, 0xDDB056FE, 0xD9714B49, 0xC7361B4C, 0xC3F706FB, 0xCEB42022, 0xCA753D95, 0xF23A8028, 0xF6FB9D9F, 0xFBB8BB46, 0xFF79A6F1, 0xE13EF6F4, 0xE5FFEB43, 0xE8BCCD9A, 0xEC7DD02D, 0x34867077, 0x30476DC0, 0x3D044B19, 0x39C556AE, 0x278206AB, 0x23431B1C, 0x2E003DC5, 0x2AC12072, 0x128E9DCF, 0x164F8078, 0x1B0CA6A1, 0x1FCDBB16, 0x018AEB13, 0x054BF6A4, 0x0808D07D, 0x0CC9CDCA, 0x7897AB07, 0x7C56B6B0, 0x71159069, 0x75D48DDE, 0x6B93DDDB, 0x6F52C06C, 0x6211E6B5, 0x66D0FB02, 0x5E9F46BF, 0x5A5E5B08, 0x571D7DD1, 0x53DC6066, 0x4D9B3063, 0x495A2DD4, 0x44190B0D, 0x40D816BA, 0xACA5C697, 0xA864DB20, 0xA527FDF9, 0xA1E6E04E, 0xBFA1B04B, 0xBB60ADFC, 0xB6238B25, 0xB2E29692, 0x8AAD2B2F, 0x8E6C3698, 0x832F1041, 0x87EE0DF6, 0x99A95DF3, 0x9D684044, 0x902B669D, 0x94EA7B2A, 0xE0B41DE7, 0xE4750050, 0xE9362689, 0xEDF73B3E, 0xF3B06B3B, 0xF771768C, 0xFA325055, 0xFEF34DE2, 0xC6BCF05F, 0xC27DEDE8, 0xCF3ECB31, 0xCBFFD686, 0xD5B88683, 0xD1799B34, 0xDC3ABDED, 0xD8FBA05A, 0x690CE0EE, 0x6DCDFD59, 0x608EDB80, 0x644FC637, 0x7A089632, 0x7EC98B85, 0x738AAD5C, 0x774BB0EB, 0x4F040D56, 0x4BC510E1, 0x46863638, 0x42472B8F, 0x5C007B8A, 0x58C1663D, 0x558240E4, 0x51435D53, 0x251D3B9E, 0x21DC2629, 0x2C9F00F0, 0x285E1D47, 0x36194D42, 0x32D850F5, 0x3F9B762C, 0x3B5A6B9B, 0x0315D626, 0x07D4CB91, 0x0A97ED48, 0x0E56F0FF, 0x1011A0FA, 0x14D0BD4D, 0x19939B94, 0x1D528623, 0xF12F560E, 0xF5EE4BB9, 0xF8AD6D60, 0xFC6C70D7, 0xE22B20D2, 0xE6EA3D65, 0xEBA91BBC, 0xEF68060B, 0xD727BBB6, 0xD3E6A601, 0xDEA580D8, 0xDA649D6F, 0xC423CD6A, 0xC0E2D0DD, 0xCDA1F604, 0xC960EBB3, 0xBD3E8D7E, 0xB9FF90C9, 0xB4BCB610, 0xB07DABA7, 0xAE3AFBA2, 0xAAFBE615, 0xA7B8C0CC, 0xA379DD7B, 0x9B3660C6, 0x9FF77D71, 0x92B45BA8, 0x9675461F, 0x8832161A, 0x8CF30BAD, 0x81B02D74, 0x857130C3, 0x5D8A9099, 0x594B8D2E, 0x5408ABF7, 0x50C9B640, 0x4E8EE645, 0x4A4FFBF2, 0x470CDD2B, 0x43CDC09C, 0x7B827D21, 0x7F436096, 0x7200464F, 0x76C15BF8, 0x68860BFD, 0x6C47164A, 0x61043093, 0x65C52D24, 0x119B4BE9, 0x155A565E, 0x18197087, 0x1CD86D30, 0x029F3D35, 0x065E2082, 0x0B1D065B, 0x0FDC1BEC, 0x3793A651, 0x3352BBE6, 0x3E119D3F, 0x3AD08088, 0x2497D08D, 0x2056CD3A, 0x2D15EBE3, 0x29D4F654, 0xC5A92679, 0xC1683BCE, 0xCC2B1D17, 0xC8EA00A0, 0xD6AD50A5, 0xD26C4D12, 0xDF2F6BCB, 0xDBEE767C, 0xE3A1CBC1, 0xE760D676, 0xEA23F0AF, 0xEEE2ED18, 0xF0A5BD1D, 0xF464A0AA, 0xF9278673, 0xFDE69BC4, 0x89B8FD09, 0x8D79E0BE, 0x803AC667, 0x84FBDBD0, 0x9ABC8BD5, 0x9E7D9662, 0x933EB0BB, 0x97FFAD0C, 0xAFB010B1, 0xAB710D06, 0xA6322BDF, 0xA2F33668, 0xBCB4666D, 0xB8757BDA, 0xB5365D03, 0xB1F740B4 }; u32 crc = 0; while (len) { crc = (crc << 8) ^ crc32_table[((crc >> 24) ^ *data) & 0xFF]; data++; len--; } return crc; } static bool is_multi_section_firmware(const struct cts_firmware *firmware) { return (firmware->size == CTS_FIRMWARE_MULTI_SECTION_FILE_SIZE); } static bool is_single_section_firmware(const struct cts_firmware *firmware) { return !(is_multi_section_firmware(firmware)); } static bool is_firmware_size_valid(const struct cts_firmware *firmware) { return (firmware->size > 0x102 && firmware->size <= CTS_FIRMWARE_MULTI_SECTION_FILE_SIZE); } static bool is_multi_section_firmware_valid(const struct cts_firmware *firmware) { u32 crc; crc = cts_crc32(FIRMWARE_SECTION(firmware), FIRMWARE_SECTION_SIZE(firmware)); if (crc != FIRMWARE_SECTION_CRC(firmware)) { cts_err("Firmware-section crc mismatch crc-section %08x != %08x" ", File maybe broken!!!", crc, FIRMWARE_SECTION_CRC(firmware)); return false; } if (DDIPARAM_SECTION_ENABLE(firmware) == CTS_SECTION_ENABLE_FLAG) { crc = cts_crc32(DDIPARAM_SECTION(firmware), DDIPARAM_SECTION_SIZE(firmware)); if (crc != DDIPARAM_SECTION_CRC(firmware)) { cts_err("DDIParam-section crc mismatch crc-section %08x != %08x" ", File maybe broken!!!", crc, DDIPARAM_SECTION_CRC(firmware)); return false; } } else cts_info("DDIParam-section is NOT enabled"); return true; } static bool is_firmware_valid(const struct cts_firmware *firmware) { if (firmware && firmware->data && is_firmware_size_valid(firmware)) { if (is_single_section_firmware(firmware) || is_multi_section_firmware_valid(firmware)) return true; } return false; } static void parse_single_section_firmware(const struct cts_firmware *firmware, struct cts_firmware_sect_info *info) { static u8 crc_sect[20] = {0xff}; info->firmware_sect = firmware->data; info->firmware_sect_size = firmware->size; info->firmware_sect_crc = cts_crc32(firmware->data, firmware->size); put_unaligned_le32(info->firmware_sect_crc, crc_sect); put_unaligned_le32(info->firmware_sect_size, crc_sect + 4); put_unaligned_le32(~0x0000C35A, crc_sect + 8); /* Enable CRC check */ put_unaligned_le32(0x7473756E, crc_sect + 16); info->firmware_crc_sect = crc_sect; info->firmware_crc_sect_size = sizeof(crc_sect); } static void parse_multi_section_firmware(const struct cts_firmware *firmware, struct cts_firmware_sect_info *info) { info->firmware_sect = FIRMWARE_SECTION(firmware); info->firmware_sect_size = FIRMWARE_SECTION_SIZE(firmware); info->firmware_crc_sect = FIRMWARE_CRC_SECTION(firmware); info->firmware_crc_sect_size = FIRMWARE_CRC_SECTION_SIZE; info->firmware_sect_crc = FIRMWARE_SECTION_CRC(firmware); if (DDIPARAM_SECTION_ENABLE(firmware) == CTS_SECTION_ENABLE_FLAG) { info->ddiparam_sect = DDIPARAM_SECTION(firmware); info->ddiparam_sect_size = DDIPARAM_SECTION_SIZE(firmware); info->ddiparam_crc_sect = DDIPARAM_CRC_SECTION(firmware); info->ddiparam_crc_sect_size = DDIPARAM_CRC_SECTION_SIZE; info->ddiparam_sect_crc = DDIPARAM_SECTION_CRC(firmware); } } static int parse_firmware(const struct cts_firmware *firmware, struct cts_firmware_sect_info *info) { memset(info, 0, sizeof(*info)); if (is_multi_section_firmware(firmware)) parse_multi_section_firmware(firmware, info); else parse_single_section_firmware(firmware, info); cts_info(" Firmware section size: %zu", info->firmware_sect_size); if (info->ddiparam_crc_sect) cts_info(" DDIParam section size: %zu", info->ddiparam_sect_size); return 0; } #ifdef CFG_CTS_DRIVER_BUILTIN_FIRMWARE static int cts_request_newer_driver_builtin_firmware(struct cts_device *cts_dev, u32 hwid, u16 fwid, u16 device_fw_ver) { #define MATCH_HWID(firmware, hwid) \ ((hwid) == CTS_DEV_HWID_ANY || (firmware)->hwid == (hwid)) #define MATCH_FWID(firmware, fwid) \ ((fwid) == CTS_DEV_FWID_ANY || (firmware)->fwid == (fwid)) struct cts_firmware *firmware = NULL; int i; cts_info("Request driver builtin if match hwid: %06x fwid: %04x && ver > %04x", hwid, fwid, device_fw_ver); firmware = cts_driver_builtin_firmwares; for (i = 0; i < ARRAY_SIZE(cts_driver_builtin_firmwares); i++, firmware++) { if (MATCH_HWID(firmware, hwid) && MATCH_FWID(firmware, fwid)) { if (!is_firmware_valid(firmware)) { cts_err("Found driver builtin '%s' " "hwid: %06x fwid: %04x data: %p size: %zu INVALID", firmware->name, firmware->hwid, firmware->fwid, firmware->data, firmware->size); continue; } if (FIRMWARE_VERSION(firmware) > device_fw_ver) { cts_info("Found newer driver builtin '%s' " "hwid: %06x fwid: %04x size: %zu ver: %04x > %04x", firmware->name, firmware->hwid, firmware->fwid, firmware->size, FIRMWARE_VERSION(firmware), device_fw_ver); memcpy(cts_dev->firmware->data, firmware->data, firmware->size); cts_dev->firmware->size = firmware->size; return 0; } } } cts_info("No newer driver builtin found"); return -EINVAL; #undef MATCH_HWID #undef MATCH_FWID } #endif /* CFG_CTS_DRIVER_BUILTIN_FIRMWARE */ // #ifdef CFG_CTS_FIRMWARE_IN_FS // bool is_filesystem_mounted(const char *filepath) // { // #ifdef CFG_CTS_FOR_GKI // cts_info("%s(): some functions are forbiddon with GKI Version!", __func__); // return false; // #else // struct path root_path; // struct path path; // int ret; // ret = kern_path("/", LOOKUP_FOLLOW, &root_path); // if (ret) // return false; // ret = kern_path(filepath, LOOKUP_FOLLOW, &path); // if (ret) // goto err_put_root_path; // if (path.mnt->mnt_sb == root_path.mnt->mnt_sb) // /* not mounted */ // ret = false; // else // ret = true; // path_put(&path); // err_put_root_path: // path_put(&root_path); // return !!ret; // #endif // } #ifndef CFG_CTS_FOR_GKI static int cts_request_firmware_full_filepath(struct cts_firmware *firmware, const char *filepath, int curr_version) { struct file *file; u16 version; u8 buff[2]; loff_t pos = 0; int read_size; int ret = 0; file = filp_open(filepath, O_RDONLY, 0); if (IS_ERR(file)) { cts_err("Open file '%s' failed %ld", filepath, PTR_ERR(file)); return PTR_ERR(file); } firmware->size = file_inode(file)->i_size; if (!is_firmware_size_valid(firmware)) { cts_info("File '%s' size: %zu invalid", filepath, firmware->size); ret = -EINVAL; goto err_close_file; } pos = FIRMWARE_VERSION_OFFSET; #if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0) read_size = kernel_read(file, buff, 2, &pos); #else read_size = kernel_read(file, pos, buff, 2); #endif if (read_size < 0) { cts_err("Read version from offset 0x100 failed"); ret = -EIO; goto err_close_file; } version = get_unaligned_le16(buff); if (version <= curr_version) { cts_info("File '%s' size: %zu version: %04x <= %04x", filepath, firmware->size, version, curr_version); cts_info("Do not update"); ret = -EINVAL; goto err_close_file; } cts_info("File '%s' size: %zu version: %04x", filepath, firmware->size, version); pos = 0; #if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0) read_size = kernel_read(file, firmware->data, firmware->size, &pos); #else read_size = kernel_read(file, pos, firmware->data, firmware->size); #endif if (read_size < 0 || read_size != firmware->size) { cts_err("Request from fs read whole file failed %d", read_size); ret = -EIO; firmware = NULL; goto err_close_file; } filp_close(file, NULL); return 0; err_close_file: filp_close(file, NULL); return ret; } #endif #ifdef CFG_CTS_FIRMWARE_IN_FS static int cts_wrap_request_firmware(struct cts_firmware *firmware, const char *name, struct device *device, int curr_version) { struct cts_firmware *local = NULL; int ret; local = kzalloc(sizeof(struct cts_firmware), GFP_KERNEL); if (local == NULL) { cts_err("Alloc local buffer failed"); return -ENOMEM; } ret = request_firmware(&local->fw, name, device); if (ret) { cts_err("Could not load firmware from %s: %d", name, ret); return ret; } local->data = (u8 *) local->fw->data; local->size = local->fw->size; if (!is_firmware_valid(local)) { cts_err("Request firmware file INVALID, size %zu", local->size); ret = -EINVAL; goto err_release_firmware; } if (curr_version > 0 && curr_version >= FIRMWARE_VERSION(local)) { cts_info("Request firmware file version 0x%04x <= 0x%04x curr", FIRMWARE_VERSION(local), curr_version); ret = -EINVAL; goto err_release_firmware; } if (firmware == NULL) { cts_err("firmware was null"); ret = -EINVAL; } else { memcpy(firmware->data, (u8 *) local->fw->data, local->size); firmware->size = local->size; cts_info("Update firmware buffer successfully"); } err_release_firmware: release_firmware(local->fw); local->data = NULL; kfree(local); return ret; } int cts_request_newer_firmware_from_fs(struct cts_device *cts_dev, const char *filepath, u16 curr_version) { int ret = 0; cts_info("Request from file '%s' if version > %04x", filepath, curr_version); if (filepath == NULL || filepath[0] == '\0') { cts_err("Request from file path INVALID %p", filepath); return -EINVAL; } if (strchr(filepath, '/') != NULL) { cts_info("Filepath is fullpath, direct read it out"); #ifdef CFG_CTS_FOR_GKI cts_err("Google GKI unsupport kernel_read, please use request_firmware"); ret = -EPERM; #else /* Sometimes vendor/firmware path was not have permission, then use sdcard */ ret = cts_request_firmware_full_filepath(cts_dev->firmware, filepath, curr_version); #endif } else { ret = cts_wrap_request_firmware(cts_dev->firmware, filepath, &cts_dev->pdata->ts_input_dev->dev, curr_version); } return ret; } int cts_update_firmware_from_file(struct cts_device *cts_dev, const char *filepath) { int ret; cts_info("Update from file '%s'", filepath); cts_reset_device(cts_dev); ret = cts_request_newer_firmware_from_fs(cts_dev, filepath, 0); if (ret) { cts_err("Request from file '%s' failed", filepath); return -EFAULT; } ret = cts_update_firmware(cts_dev); if (ret) { cts_err("Update from file failed %d", ret); return ret; } cts_info("Update from file success"); return ret; } #endif /*CFG_CTS_FIRMWARE_IN_FS */ int cts_request_firmware(struct cts_device *cts_dev, u32 hwid, u16 fwid, u16 curr_firmware_ver) { int builtin = -1, bin = -1; if (hwid == CTS_DEV_HWID_INVALID) hwid = CTS_DEV_HWID_ANY; if (fwid == CTS_DEV_FWID_INVALID) fwid = CTS_DEV_FWID_ANY; cts_info("Request newer if match hwid: %06x fwid: %04x && ver > %04x", hwid, fwid, curr_firmware_ver); #ifdef CFG_CTS_DRIVER_BUILTIN_FIRMWARE builtin = cts_request_newer_driver_builtin_firmware(cts_dev, hwid, fwid, curr_firmware_ver); if (builtin == 0) { curr_firmware_ver = FIRMWARE_VERSION(cts_dev->firmware); } #endif #ifdef CFG_CTS_FIRMWARE_IN_FS bin = cts_request_newer_firmware_from_fs(cts_dev, CFG_CTS_FIRMWARE_FILENAME, curr_firmware_ver); if (bin) { cts_err("Request firmware from file failed"); } #endif if (bin == 0 || builtin == 0) return 0; else return -1; } #ifdef CONFIG_CTS_I2C_HOST static int calc_crc_in_flash(struct cts_device *cts_dev, u32 flash_addr, size_t size, u32 *crc) { return cts_dev->hwdata->sfctrl->ops->calc_flash_crc(cts_dev, flash_addr, size, crc); } static int validate_flash_data(struct cts_device *cts_dev, u32 flash_addr, const u8 *data, size_t size, u8 *buf, bool calc_crc, u32 crc) { int ret, i; bool free_data = false; u32 crc_flash; cts_info("Validate flash data from 0x%06x size %zu by %s", flash_addr, size, calc_crc ? "check-crc" : "direct-readback"); if (calc_crc) { ret = calc_crc_in_flash(cts_dev, flash_addr, size, &crc_flash); if (ret) { cts_err("Calc data in flash from 0x%06x size %zu crc failed %d, " "try to validate by direct readback", flash_addr, size, ret); /* FALL through by direct compare data read back */ } else { if (crc_flash != crc) { cts_err("Crc in flash from 0x%06x size %zu mismatch 0x%08x != 0x%08x", flash_addr, size, crc_flash, crc); /* FALL through by direct compare data read back */ } else { cts_info("Flash data crc correct"); return 0; } } } if (buf == NULL) { buf = (u8 *) kmalloc(size, GFP_KERNEL); if (buf == NULL) { cts_err("Validate flash data allocate mem failed"); return -ENOMEM; } free_data = true; } ret = cts_read_flash(cts_dev, flash_addr, buf, size); if (ret) { cts_err("Read flash from 0x%06x size %zu failed %d", flash_addr, size, ret); goto err_free_buf; } for (i = 0; i < size; i++) { if (buf[i] != data[i]) { if (ret == 0) { cts_err("Flash data from 0x%06x size %zu first bytes diff:", flash_addr, size); } if (ret < 100) { cts_err(" 0x%06x: %02x %02x", i, buf[i], data[i]); } else if (ret == 100) { cts_err(" ..."); } ret++; } } err_free_buf: if (free_data) kfree(buf); return ret; } static int cts_program_firmware_from_sram_to_flash(struct cts_device *cts_dev, const struct cts_firmware_sect_info *firmware_info) { int ret; u8 crc_sect_buf[FIRMWARE_CRC_SECTION_SIZE]; cts_info("Program firmware size %zu", firmware_info->firmware_sect_size); ret = cts_program_flash_from_sram(cts_dev, 4, 4, firmware_info->firmware_sect_size - 4); if (ret) { cts_err("Program firmware section from sram failed %d", ret); return ret; } ret = cts_program_flash(cts_dev, CTS_FIRMWARE_CRC_SECTION_OFFSET, firmware_info->firmware_crc_sect, firmware_info->firmware_crc_sect_size); if (ret) { cts_err("Program firmware crc section failed %d", ret); return ret; } ret = validate_flash_data(cts_dev, CTS_FIRMWARE_CRC_SECTION_OFFSET, firmware_info->firmware_crc_sect, firmware_info->firmware_crc_sect_size, crc_sect_buf, false, 0); if (ret) { cts_err("Validate Firmware-CRC section failed %d", ret); return ret; } ret = cts_program_flash(cts_dev, 0, firmware_info->firmware_sect, 4); if (ret) { cts_err("Program firmware section fist 4bytes failed %d", ret); return ret; } ret = validate_flash_data(cts_dev, CTS_FIRMWARE_SECTION_OFFSET, firmware_info->firmware_sect, firmware_info->firmware_sect_size, NULL, true, firmware_info->firmware_sect_crc); if (ret) { cts_err("Validate firmware section failed %d", ret); return ret; } return 0; } static int cts_program_ddiparam(struct cts_device *cts_dev, const struct cts_firmware_sect_info *firmware_info) { int ret; u8 crc_sect_buf[DDIPARAM_CRC_SECTION_SIZE]; cts_info("Program DDIParam size: %zu", firmware_info->ddiparam_sect_size); ret = cts_program_flash(cts_dev, CTS_DDIPARAM_SECTION_OFFSET, firmware_info->ddiparam_sect, firmware_info->ddiparam_sect_size); if (ret) { cts_err("Program DDIParam section failed %d", ret); return ret; } ret = validate_flash_data(cts_dev, CTS_DDIPARAM_SECTION_OFFSET, firmware_info->ddiparam_sect, firmware_info->ddiparam_sect_size, NULL, true, firmware_info->ddiparam_sect_crc); if (ret) { cts_err("Validate DDIParam section failed %d", ret); return ret; } ret = cts_program_flash(cts_dev, CTS_DDIPARAM_CRC_SECTION_OFFSET, firmware_info->ddiparam_crc_sect, firmware_info->ddiparam_crc_sect_size); if (ret) { cts_err("Program DDIParam-CRC section failed %d", ret); return ret; } ret = validate_flash_data(cts_dev, CTS_DDIPARAM_CRC_SECTION_OFFSET, firmware_info->ddiparam_crc_sect, firmware_info->ddiparam_crc_sect_size, crc_sect_buf, false, 0); if (ret) { cts_err("Validate DDIParam-CRC section failed %d", ret); return ret; } return 0; } static int cts_update_firmware_to_flash(struct cts_device *cts_dev, struct cts_firmware_sect_info firmware_info) { int retries; int ret; ret = cts_prepare_flash_operation(cts_dev); if (ret) { cts_warn("Prepare flash operation failed %d", ret); /* Go through and try */ } if (!cts_dev->rtdata.has_flash) { cts_err("Update firmware to flash is UNKNOWN/NON-EXIST"); ret = -ENODEV; goto post_flash_operation; } retries = 0; do { retries++; ret = cts_erase_flash(cts_dev, CTS_FIRMWARE_CRC_SECTION_OFFSET, firmware_info.firmware_crc_sect_size); if (ret) { cts_err("Erase firmware crc section failed %d retries %d", ret, retries); continue; } ret = cts_erase_flash(cts_dev, 0, firmware_info.firmware_sect_size); if (ret) { cts_err("Erase firmware section failed %d retries %d", ret, retries); continue; } ret = cts_program_firmware_from_sram_to_flash(cts_dev, &firmware_info); if (ret) { cts_err("Program firmware & crc section failed %d retries %d", ret, retries); } } while (ret && retries < 3); if (ret == 0 && firmware_info.ddiparam_sect_size != 0) { retries = 0; do { retries++; ret = cts_erase_flash(cts_dev, CTS_DDIPARAM_CRC_SECTION_OFFSET, firmware_info.ddiparam_crc_sect_size); if (ret) { cts_err("Erase DDIParam crc secction failed %d, retries %d", ret, retries); continue; } ret = cts_erase_flash(cts_dev, CTS_DDIPARAM_SECTION_OFFSET, firmware_info.ddiparam_sect_size); if (ret) { cts_err("Erase DDIParam section failed %d, retries %d", ret, retries); continue; } ret = cts_program_ddiparam(cts_dev, &firmware_info); if (ret) { cts_err("Program DDIParam & crc section failed %d retries %d", ret, retries); } } while (ret && retries < 3); } post_flash_operation: cts_post_flash_operation(cts_dev); return ret; } #else /* CONFIG_CTS_I2C_HOST */ #ifdef CFG_CTS_CASCADE_SUPPORTED static int cts_switch_to_ic(struct cts_device *cts_dev, uint8_t type) { uint8_t dat = 0x83; int count = 0; int retries = 10; int rc; if (type == 1) { dat = 0x81; } else if (type == 2) { dat = 0x82; } else if (type == 3) { dat = 0x83; } while (retries--) { rc = cts_spi_send_recv(cts_dev->pdata, sizeof(dat), &dat, NULL); if (rc) cts_err("Send %d to ic failed: rc=%d", dat, rc); else { count++; if (count == 2) return 0; } } return -EIO; } int cts_switch_to_master(struct cts_device *cts_dev) { return cts_switch_to_ic(cts_dev, 1); } int cts_switch_to_slave(struct cts_device *cts_dev) { return cts_switch_to_ic(cts_dev, 2); } int cts_switch_to_all(struct cts_device *cts_dev) { return cts_switch_to_ic(cts_dev, 3); } #endif /* CFG_CTS_CASCADE_SUPPORTED */ #endif /* CONFIG_CTS_I2C_HOST */ #if defined(CFG_CTS_CASCADE_SUPPORTED) && !defined(CONFIG_CTS_I2C_HOST) static int cts_slave_enter_prog_mode(struct cts_device *cts_dev) { u8 magic_num[] = { 0xCC, 0x33, 0x55, 0x5A }; int ret; #ifdef CONFIG_CTS_I2C_HOST ret = cts_plat_i2c_write(cts_dev->pdata, CTS_DEV_PROGRAM_MODE_I2CADDR, (const u8 *)magic_num, 4, 5, 10); if (ret) { cts_err("Write slave magic number to i2c_dev: 0x%02x failed %d", CTS_DEV_PROGRAM_MODE_I2CADDR, ret); } #else ret = cts_spi_send_recv(cts_dev->pdata, sizeof(magic_num), magic_num, NULL); if (ret) { cts_err("Write slave magic number to spi_dev: 0x%02x failed %d", CTS_DEV_PROGRAM_MODE_SPIADDR, ret); } #endif return ret; } #endif static int cts_prepare_update_firmware(struct cts_device *cts_dev, struct cts_firmware_sect_info firmware_info) { int ret; #if defined(CFG_CTS_CASCADE_SUPPORTED) && !defined(CONFIG_CTS_I2C_HOST) ret = cts_switch_to_master(cts_dev); if (ret) { cts_err("Switch to master faild %d", ret); return ret; } ret = cts_enter_program_mode(cts_dev); if (ret) { cts_err("Device enter program mode failed %d", ret); return ret; } ret = cts_switch_to_slave(cts_dev); if (ret) { cts_err("Switch to slave field %d", ret); return ret; } ret = cts_hw_reg_writeb_retry(cts_dev, CTS_DEV_HW_REG_SPI_CFG, 0x12, 5, 0); if (ret) { cts_err("Disable Slave Spi Tx forward failed %d", ret); return ret; } ret = cts_slave_enter_prog_mode(cts_dev); if (ret) { cts_err("Slave device enter program mode failed %d", ret); return ret; } ret = cts_switch_to_all(cts_dev); if (ret) { cts_err("Switch to all failed %d", ret); return ret; } #else ret = cts_enter_program_mode(cts_dev); if (ret) { cts_err("Device enter program mode failed %d", ret); return ret; } #endif return ret; } int cts_update_firmware(struct cts_device *cts_dev) { struct cts_firmware_sect_info firmware_info; struct cts_firmware *firmware = cts_dev->firmware; int ret; cts_info("Update firmware ver: %04x size: %zu", FIRMWARE_VERSION(firmware), firmware->size); if (parse_firmware(firmware, &firmware_info)) { cts_err("Parse firmware failed"); return -EINVAL; } cts_dev->rtdata.updating = true; ret = cts_prepare_update_firmware(cts_dev, firmware_info); if (ret) { cts_err("Prepare update firmware failed, ret=%d", ret); goto out; } cts_info("Write firmware section to sram size %zu", firmware_info.firmware_sect_size); ret = cts_sram_writesb_check_crc_retry(cts_dev, 0, firmware_info.firmware_sect, firmware_info.firmware_sect_size, firmware_info.firmware_sect_crc, 10); if (ret) { cts_err("Write firmware section to sram failed %d", ret); } #ifdef CFG_CTS_UPDATE_CRCCHECK cts_sram_writesb_boot_crc_retry(cts_dev, firmware_info.firmware_sect_size, firmware_info.firmware_sect_crc, 3); #endif #ifdef CONFIG_CTS_I2C_HOST ret = cts_update_firmware_to_flash(cts_dev, firmware_info); if (ret) { cts_err("Update firmware to flash failed"); } #endif out: cts_dev->rtdata.updating = false; if (ret == 0) { if (firmware_info.firmware_sect_size <= cts_dev->hwdata->sfctrl->xchg_sram_base) { ret = cts_enter_normal_mode(cts_dev); if (ret) { cts_err("Enter normal mode failed %d", ret); /* return ret; */ } } } #ifdef CONFIG_CTS_CHARGER_DETECT if (cts_is_charger_exist(cts_dev)) { int r = cts_set_dev_charger_attached(cts_dev, true); if (r) cts_err("Set dev charger attached failed %d", r); } #endif #ifdef CONFIG_CTS_EARJACK_DETECT if (cts_is_earjack_exist(cts_dev)) { int r = cts_set_dev_earjack_attached(cts_dev, true); if (r) cts_err("Set dev earjack attached failed %d", r); } #endif #ifdef CONFIG_CTS_GLOVE if (cts_is_glove_enabled(cts_dev)) cts_enter_glove_mode(cts_dev); #endif return ret; } bool cts_is_firmware_updating(struct cts_device *cts_dev) { return cts_dev->rtdata.updating; }