| // SPDX-License-Identifier: GPL-2.0+ |
| /* |
| * Generate MediaTek BootROM header for SPL/U-Boot images |
| * |
| * Copyright (C) 2018 MediaTek Inc. |
| * Author: Weijie Gao <weijie.gao@mediatek.com> |
| */ |
| |
| #include <time.h> |
| #include <image.h> |
| #include <u-boot/crc.h> |
| #include <u-boot/sha256.h> |
| #include "imagetool.h" |
| #include "mtk_image.h" |
| #include "mtk_nand_headers.h" |
| |
| static const struct brom_img_type { |
| const char *name; |
| enum brlyt_img_type type; |
| } brom_images[] = { |
| { |
| .name = "nand", |
| .type = BRLYT_TYPE_NAND |
| }, { |
| .name = "emmc", |
| .type = BRLYT_TYPE_EMMC |
| }, { |
| .name = "nor", |
| .type = BRLYT_TYPE_NOR |
| }, { |
| .name = "sdmmc", |
| .type = BRLYT_TYPE_SDMMC |
| }, { |
| .name = "snand", |
| .type = BRLYT_TYPE_SNAND |
| }, { |
| .name = "spim-nand", |
| .type = BRLYT_TYPE_SNAND |
| } |
| }; |
| |
| /* Indicates whether we're generating or verifying */ |
| static bool img_gen; |
| static uint32_t img_size; |
| |
| /* Image type selected by user */ |
| static enum brlyt_img_type hdr_media; |
| static uint32_t hdr_offset; |
| static int use_lk_hdr; |
| static int use_mt7621_hdr; |
| static bool is_arm64_image; |
| |
| /* LK image name */ |
| static char lk_name[32] = "U-Boot"; |
| |
| /* CRC32 normal table required by MT7621 image */ |
| static uint32_t crc32tbl[256]; |
| |
| /* NAND header selected by user */ |
| static const struct nand_header_type *hdr_nand; |
| static uint32_t hdr_nand_size; |
| |
| /* GFH header + 2 * 4KB pages of NAND */ |
| static char hdr_tmp[sizeof(struct gfh_header) + 0x2000]; |
| |
| static uint32_t crc32_normal_cal(uint32_t crc, const void *data, size_t length, |
| const uint32_t *crc32c_table) |
| { |
| const uint8_t *p = data; |
| |
| while (length--) |
| crc = crc32c_table[(uint8_t)((crc >> 24) ^ *p++)] ^ (crc << 8); |
| |
| return crc; |
| } |
| |
| static void crc32_normal_init(uint32_t *crc32c_table, uint32_t poly) |
| { |
| uint32_t v, i, j; |
| |
| for (i = 0; i < 256; i++) { |
| v = i << 24; |
| for (j = 0; j < 8; j++) |
| v = (v << 1) ^ ((v & (1 << 31)) ? poly : 0); |
| |
| crc32c_table[i] = v; |
| } |
| } |
| |
| static int mtk_image_check_image_types(uint8_t type) |
| { |
| if (type == IH_TYPE_MTKIMAGE) |
| return EXIT_SUCCESS; |
| else |
| return EXIT_FAILURE; |
| } |
| |
| static int mtk_brom_parse_imagename(const char *imagename) |
| { |
| #define is_blank_char(c) \ |
| ((c) == '\t' || (c) == '\n' || (c) == '\r' || (c) == ' ') |
| |
| char *buf = strdup(imagename), *key, *val, *end, *next; |
| int i; |
| |
| /* User passed arguments from image name */ |
| static const char *media = ""; |
| static const char *hdr_offs = ""; |
| static const char *nandinfo = ""; |
| static const char *lk = ""; |
| static const char *mt7621 = ""; |
| static const char *arm64_param = ""; |
| |
| key = buf; |
| while (key) { |
| next = strchr(key, ';'); |
| if (next) |
| *next = 0; |
| |
| val = strchr(key, '='); |
| if (val) { |
| *val++ = 0; |
| |
| /* Trim key */ |
| while (is_blank_char(*key)) |
| key++; |
| |
| end = key + strlen(key) - 1; |
| while ((end >= key) && is_blank_char(*end)) |
| end--; |
| end++; |
| |
| if (is_blank_char(*end)) |
| *end = 0; |
| |
| /* Trim value */ |
| while (is_blank_char(*val)) |
| val++; |
| |
| end = val + strlen(val) - 1; |
| while ((end >= val) && is_blank_char(*end)) |
| end--; |
| end++; |
| |
| if (is_blank_char(*end)) |
| *end = 0; |
| |
| /* record user passed arguments */ |
| if (!strcmp(key, "media")) |
| media = val; |
| |
| if (!strcmp(key, "hdroffset")) |
| hdr_offs = val; |
| |
| if (!strcmp(key, "nandinfo")) |
| nandinfo = val; |
| |
| if (!strcmp(key, "lk")) |
| lk = val; |
| |
| if (!strcmp(key, "mt7621")) |
| mt7621 = val; |
| |
| if (!strcmp(key, "lkname")) |
| snprintf(lk_name, sizeof(lk_name), "%s", val); |
| |
| if (!strcmp(key, "arm64")) |
| arm64_param = val; |
| } |
| |
| if (next) |
| key = next + 1; |
| else |
| break; |
| } |
| |
| /* if user specified LK image header, skip following checks */ |
| if (lk && lk[0] == '1') { |
| use_lk_hdr = 1; |
| free(buf); |
| return 0; |
| } |
| |
| /* if user specified MT7621 image header, skip following checks */ |
| if (mt7621 && mt7621[0] == '1') { |
| use_mt7621_hdr = 1; |
| free(buf); |
| return 0; |
| } |
| |
| /* parse media type */ |
| for (i = 0; i < ARRAY_SIZE(brom_images); i++) { |
| if (!strcmp(brom_images[i].name, media)) { |
| hdr_media = brom_images[i].type; |
| break; |
| } |
| } |
| |
| /* parse nand header type */ |
| hdr_nand = mtk_nand_header_find(nandinfo); |
| |
| /* parse device header offset */ |
| if (hdr_offs && hdr_offs[0]) |
| hdr_offset = strtoul(hdr_offs, NULL, 0); |
| |
| if (arm64_param && arm64_param[0] == '1') |
| is_arm64_image = true; |
| |
| free(buf); |
| |
| if (hdr_media == BRLYT_TYPE_INVALID) { |
| fprintf(stderr, "Error: media type is invalid or missing.\n"); |
| fprintf(stderr, " Please specify -n \"media=<type>\"\n"); |
| return -EINVAL; |
| } |
| |
| if ((hdr_media == BRLYT_TYPE_NAND || hdr_media == BRLYT_TYPE_SNAND) && |
| !hdr_nand) { |
| fprintf(stderr, "Error: nand info is invalid or missing.\n"); |
| fprintf(stderr, " Please specify -n \"media=%s;" |
| "nandinfo=<info>\"\n", media); |
| return -EINVAL; |
| } |
| |
| if (hdr_media == BRLYT_TYPE_NAND || hdr_media == BRLYT_TYPE_SNAND) |
| hdr_nand_size = mtk_nand_header_size(hdr_nand); |
| |
| return 0; |
| } |
| |
| static int mtk_image_check_params(struct image_tool_params *params) |
| { |
| if (!params->addr) { |
| fprintf(stderr, "Error: Load Address must be set.\n"); |
| return -EINVAL; |
| } |
| |
| if (!params->imagename) { |
| fprintf(stderr, "Error: Image Name must be set.\n"); |
| return -EINVAL; |
| } |
| |
| return mtk_brom_parse_imagename(params->imagename); |
| } |
| |
| static int mtk_image_vrec_header(struct image_tool_params *params, |
| struct image_type_params *tparams) |
| { |
| if (use_lk_hdr) { |
| tparams->header_size = sizeof(union lk_hdr); |
| tparams->hdr = &hdr_tmp; |
| memset(&hdr_tmp, 0xff, tparams->header_size); |
| return 0; |
| } |
| |
| if (use_mt7621_hdr) { |
| tparams->header_size = image_get_header_size(); |
| tparams->hdr = &hdr_tmp; |
| memset(&hdr_tmp, 0, tparams->header_size); |
| return 0; |
| } |
| |
| if (hdr_media == BRLYT_TYPE_NAND || hdr_media == BRLYT_TYPE_SNAND) |
| tparams->header_size = hdr_nand_size; |
| else |
| tparams->header_size = sizeof(struct gen_device_header); |
| |
| tparams->header_size += sizeof(struct gfh_header); |
| tparams->hdr = &hdr_tmp; |
| |
| memset(&hdr_tmp, 0xff, tparams->header_size); |
| |
| return SHA256_SUM_LEN; |
| } |
| |
| static int mtk_image_verify_gfh(struct gfh_header *gfh, uint32_t type, int print) |
| { |
| if (strcmp(gfh->file_info.name, GFH_FILE_INFO_NAME)) |
| return -1; |
| |
| if (le32_to_cpu(gfh->file_info.flash_type) != type) |
| return -1; |
| |
| if (print) |
| printf("Load Address: %08x\n", |
| le32_to_cpu(gfh->file_info.load_addr) + |
| le32_to_cpu(gfh->file_info.jump_offset)); |
| |
| if (print) |
| printf("Architecture: %s\n", is_arm64_image ? "ARM64" : "ARM"); |
| |
| return 0; |
| } |
| |
| static int mtk_image_verify_gen_header(const uint8_t *ptr, int print) |
| { |
| union gen_boot_header *gbh = (union gen_boot_header *)ptr; |
| uint32_t gfh_offset, total_size, devh_size; |
| struct brom_layout_header *bh; |
| struct gfh_header *gfh; |
| const char *bootmedia; |
| |
| if (!strcmp(gbh->name, SF_BOOT_NAME)) |
| bootmedia = "Serial NOR"; |
| else if (!strcmp(gbh->name, EMMC_BOOT_NAME)) |
| bootmedia = "eMMC"; |
| else if (!strcmp(gbh->name, SDMMC_BOOT_NAME)) |
| bootmedia = "SD/MMC"; |
| else |
| return -1; |
| |
| if (print) |
| printf("Boot Media: %s\n", bootmedia); |
| |
| if (le32_to_cpu(gbh->version) != 1 || |
| le32_to_cpu(gbh->size) != sizeof(union gen_boot_header)) |
| return -1; |
| |
| bh = (struct brom_layout_header *)(ptr + le32_to_cpu(gbh->size)); |
| |
| if (strcmp(bh->name, BRLYT_NAME)) |
| return -1; |
| |
| if (le32_to_cpu(bh->magic) != BRLYT_MAGIC || |
| (le32_to_cpu(bh->type) != BRLYT_TYPE_NOR && |
| le32_to_cpu(bh->type) != BRLYT_TYPE_EMMC && |
| le32_to_cpu(bh->type) != BRLYT_TYPE_SDMMC)) |
| return -1; |
| |
| devh_size = sizeof(struct gen_device_header); |
| |
| if (img_gen) { |
| gfh_offset = devh_size; |
| } else { |
| gfh_offset = le32_to_cpu(bh->header_size); |
| |
| if (gfh_offset + sizeof(struct gfh_header) > img_size) { |
| /* |
| * This may happen if the hdr_offset used to generate |
| * this image is not zero. |
| * Since device header size is not fixed, we can't |
| * cover all possible cases. |
| * Assuming the image is valid only if the real |
| * device header size equals to devh_size. |
| */ |
| total_size = le32_to_cpu(bh->total_size); |
| |
| if (total_size - gfh_offset > img_size - devh_size) |
| return -1; |
| |
| gfh_offset = devh_size; |
| } |
| } |
| |
| gfh = (struct gfh_header *)(ptr + gfh_offset); |
| |
| return mtk_image_verify_gfh(gfh, GFH_FLASH_TYPE_GEN, print); |
| } |
| |
| static int mtk_image_verify_nand_header(const uint8_t *ptr, int print) |
| { |
| struct brom_layout_header *bh; |
| struct nand_header_info info; |
| struct gfh_header *gfh; |
| const char *bootmedia; |
| int ret; |
| |
| ret = mtk_nand_header_info(ptr, &info); |
| if (ret < 0) |
| return ret; |
| |
| if (!ret) { |
| bh = (struct brom_layout_header *)(ptr + info.page_size); |
| |
| if (strcmp(bh->name, BRLYT_NAME)) |
| return -1; |
| |
| if (le32_to_cpu(bh->magic) != BRLYT_MAGIC) |
| return -1; |
| |
| if (le32_to_cpu(bh->type) == BRLYT_TYPE_NAND) |
| bootmedia = "Parallel NAND"; |
| else if (le32_to_cpu(bh->type) == BRLYT_TYPE_SNAND) |
| bootmedia = "Serial NAND (SNFI/AP)"; |
| else |
| return -1; |
| } else { |
| if (info.snfi) |
| bootmedia = "Serial NAND (SNFI/HSM)"; |
| else |
| bootmedia = "Serial NAND (SPIM)"; |
| } |
| |
| if (print) { |
| printf("Boot Media: %s\n", bootmedia); |
| |
| if (info.page_size >= 1024) |
| printf("Page Size: %dKB\n", info.page_size >> 10); |
| else |
| printf("Page Size: %dB\n", info.page_size); |
| |
| printf("Spare Size: %dB\n", info.spare_size); |
| } |
| |
| gfh = (struct gfh_header *)(ptr + info.gfh_offset); |
| |
| return mtk_image_verify_gfh(gfh, GFH_FLASH_TYPE_NAND, print); |
| } |
| |
| static uint32_t crc32be_cal(const void *data, size_t length) |
| { |
| uint32_t crc = 0; |
| uint8_t c; |
| |
| if (crc32tbl[1] != MT7621_IH_CRC_POLYNOMIAL) |
| crc32_normal_init(crc32tbl, MT7621_IH_CRC_POLYNOMIAL); |
| |
| crc = crc32_normal_cal(crc, data, length, crc32tbl); |
| |
| for (; length; length >>= 8) { |
| c = length & 0xff; |
| crc = crc32_normal_cal(crc, &c, 1, crc32tbl); |
| } |
| |
| return ~crc; |
| } |
| |
| static int mtk_image_verify_mt7621_header(const uint8_t *ptr, int print) |
| { |
| const struct legacy_img_hdr *hdr = (const struct legacy_img_hdr *)ptr; |
| struct mt7621_nand_header *nhdr; |
| uint32_t spl_size, crcval; |
| struct legacy_img_hdr header; |
| int ret; |
| |
| spl_size = image_get_size(hdr); |
| |
| if (spl_size > img_size) { |
| if (print) |
| printf("Incomplete SPL image\n"); |
| return -1; |
| } |
| |
| ret = image_check_hcrc(hdr); |
| if (!ret) { |
| if (print) |
| printf("Bad header CRC\n"); |
| return -1; |
| } |
| |
| ret = image_check_dcrc(hdr); |
| if (!ret) { |
| if (print) |
| printf("Bad data CRC\n"); |
| return -1; |
| } |
| |
| /* Copy header so we can blank CRC field for re-calculation */ |
| memmove(&header, hdr, image_get_header_size()); |
| image_set_hcrc(&header, 0); |
| |
| nhdr = (struct mt7621_nand_header *)header.ih_name; |
| crcval = be32_to_cpu(nhdr->crc); |
| nhdr->crc = 0; |
| |
| if (crcval != crc32be_cal(&header, image_get_header_size())) { |
| if (print) |
| printf("Bad NAND header CRC\n"); |
| return -1; |
| } |
| |
| if (print) { |
| printf("Load Address: %08x\n", image_get_load(hdr)); |
| |
| printf("Image Name: %.*s\n", MT7621_IH_NMLEN, |
| image_get_name(hdr)); |
| |
| if (IMAGE_ENABLE_TIMESTAMP) { |
| printf("Created: "); |
| genimg_print_time((time_t)image_get_time(hdr)); |
| } |
| |
| printf("Data Size: "); |
| genimg_print_size(image_get_data_size(hdr)); |
| } |
| |
| return 0; |
| } |
| |
| static int mtk_image_verify_header(unsigned char *ptr, int image_size, |
| struct image_tool_params *params) |
| { |
| struct legacy_img_hdr *hdr = (struct legacy_img_hdr *)ptr; |
| union lk_hdr *lk = (union lk_hdr *)ptr; |
| |
| /* nothing to verify for LK image header */ |
| if (le32_to_cpu(lk->magic) == LK_PART_MAGIC) |
| return 0; |
| |
| img_size = image_size; |
| |
| if (image_get_magic(hdr) == IH_MAGIC) |
| return mtk_image_verify_mt7621_header(ptr, 0); |
| |
| if (is_mtk_nand_header(ptr)) |
| return mtk_image_verify_nand_header(ptr, 0); |
| else |
| return mtk_image_verify_gen_header(ptr, 0); |
| |
| return -1; |
| } |
| |
| static void mtk_image_print_header(const void *ptr, struct image_tool_params *params) |
| { |
| struct legacy_img_hdr *hdr = (struct legacy_img_hdr *)ptr; |
| union lk_hdr *lk = (union lk_hdr *)ptr; |
| |
| if (le32_to_cpu(lk->magic) == LK_PART_MAGIC) { |
| printf("Image Type: MediaTek LK Image\n"); |
| printf("Load Address: %08x\n", le32_to_cpu(lk->loadaddr)); |
| return; |
| } |
| |
| printf("Image Type: MediaTek BootROM Loadable Image\n"); |
| |
| if (image_get_magic(hdr) == IH_MAGIC) { |
| mtk_image_verify_mt7621_header(ptr, 1); |
| return; |
| } |
| |
| if (is_mtk_nand_header(ptr)) |
| mtk_image_verify_nand_header(ptr, 1); |
| else |
| mtk_image_verify_gen_header(ptr, 1); |
| } |
| |
| static void put_brom_layout_header(struct brom_layout_header *hdr, int type) |
| { |
| strncpy(hdr->name, BRLYT_NAME, sizeof(hdr->name)); |
| hdr->version = cpu_to_le32(1); |
| hdr->magic = cpu_to_le32(BRLYT_MAGIC); |
| hdr->type = cpu_to_le32(type); |
| } |
| |
| static void put_ghf_common_header(struct gfh_common_header *gfh, uint16_t size, |
| uint16_t type, uint8_t ver) |
| { |
| uint32_t magic_version = GFH_HEADER_MAGIC | |
| (uint32_t)ver << GFH_HEADER_VERSION_SHIFT; |
| |
| gfh->magic_version = cpu_to_le32(magic_version); |
| gfh->size = cpu_to_le16(size); |
| gfh->type = cpu_to_le16(type); |
| } |
| |
| static void put_ghf_header(struct gfh_header *gfh, int file_size, |
| int dev_hdr_size, int load_addr, int flash_type) |
| { |
| uint32_t cfg_bits; |
| |
| memset(gfh, 0, sizeof(struct gfh_header)); |
| |
| /* GFH_FILE_INFO header */ |
| put_ghf_common_header(&gfh->file_info.gfh, sizeof(gfh->file_info), |
| GFH_TYPE_FILE_INFO, 1); |
| strncpy(gfh->file_info.name, GFH_FILE_INFO_NAME, |
| sizeof(gfh->file_info.name)); |
| gfh->file_info.unused = cpu_to_le32(1); |
| gfh->file_info.file_type = cpu_to_le16(1); |
| gfh->file_info.flash_type = flash_type; |
| gfh->file_info.sig_type = GFH_SIG_TYPE_SHA256; |
| gfh->file_info.load_addr = cpu_to_le32(load_addr - sizeof(*gfh)); |
| gfh->file_info.total_size = cpu_to_le32(file_size - dev_hdr_size); |
| gfh->file_info.max_size = cpu_to_le32(file_size); |
| gfh->file_info.hdr_size = sizeof(*gfh); |
| gfh->file_info.sig_size = SHA256_SUM_LEN; |
| gfh->file_info.jump_offset = sizeof(*gfh); |
| gfh->file_info.processed = cpu_to_le32(1); |
| |
| /* GFH_BL_INFO header */ |
| put_ghf_common_header(&gfh->bl_info.gfh, sizeof(gfh->bl_info), |
| GFH_TYPE_BL_INFO, 1); |
| gfh->bl_info.attr = cpu_to_le32(1); |
| |
| /* GFH_BROM_CFG header */ |
| put_ghf_common_header(&gfh->brom_cfg.gfh, sizeof(gfh->brom_cfg), |
| GFH_TYPE_BROM_CFG, 3); |
| cfg_bits = GFH_BROM_CFG_USBDL_AUTO_DETECT_DIS | |
| GFH_BROM_CFG_USBDL_BY_KCOL0_TIMEOUT_EN | |
| GFH_BROM_CFG_USBDL_BY_FLAG_TIMEOUT_EN; |
| gfh->brom_cfg.usbdl_by_kcol0_timeout_ms = cpu_to_le32(5000); |
| if (is_arm64_image) { |
| gfh->brom_cfg.jump_bl_arm64 = GFH_BROM_CFG_JUMP_BL_ARM64; |
| cfg_bits |= GFH_BROM_CFG_JUMP_BL_ARM64_EN; |
| } |
| gfh->brom_cfg.cfg_bits = cpu_to_le32(cfg_bits); |
| |
| /* GFH_BL_SEC_KEY header */ |
| put_ghf_common_header(&gfh->bl_sec_key.gfh, sizeof(gfh->bl_sec_key), |
| GFH_TYPE_BL_SEC_KEY, 1); |
| |
| /* GFH_ANTI_CLONE header */ |
| put_ghf_common_header(&gfh->anti_clone.gfh, sizeof(gfh->anti_clone), |
| GFH_TYPE_ANTI_CLONE, 1); |
| gfh->anti_clone.ac_offset = cpu_to_le32(0x10); |
| gfh->anti_clone.ac_len = cpu_to_le32(0x80); |
| |
| /* GFH_BROM_SEC_CFG header */ |
| put_ghf_common_header(&gfh->brom_sec_cfg.gfh, |
| sizeof(gfh->brom_sec_cfg), |
| GFH_TYPE_BROM_SEC_CFG, 1); |
| gfh->brom_sec_cfg.cfg_bits = |
| cpu_to_le32(BROM_SEC_CFG_JTAG_EN | BROM_SEC_CFG_UART_EN); |
| } |
| |
| static void put_hash(uint8_t *buff, int size) |
| { |
| sha256_context ctx; |
| |
| sha256_starts(&ctx); |
| sha256_update(&ctx, buff, size); |
| sha256_finish(&ctx, buff + size); |
| } |
| |
| static void mtk_image_set_gen_header(void *ptr, off_t filesize, |
| uint32_t loadaddr) |
| { |
| struct gen_device_header *hdr = (struct gen_device_header *)ptr; |
| struct gfh_header *gfh; |
| const char *bootname = NULL; |
| |
| if (hdr_media == BRLYT_TYPE_NOR) |
| bootname = SF_BOOT_NAME; |
| else if (hdr_media == BRLYT_TYPE_EMMC) |
| bootname = EMMC_BOOT_NAME; |
| else if (hdr_media == BRLYT_TYPE_SDMMC) |
| bootname = SDMMC_BOOT_NAME; |
| |
| /* Generic device header */ |
| snprintf(hdr->boot.name, sizeof(hdr->boot.name), "%s", bootname); |
| hdr->boot.version = cpu_to_le32(1); |
| hdr->boot.size = cpu_to_le32(sizeof(hdr->boot)); |
| |
| /* BRLYT header */ |
| put_brom_layout_header(&hdr->brlyt, hdr_media); |
| hdr->brlyt.header_size = cpu_to_le32(hdr_offset + sizeof(*hdr)); |
| hdr->brlyt.total_size = cpu_to_le32(hdr_offset + filesize); |
| hdr->brlyt.header_size_2 = hdr->brlyt.header_size; |
| hdr->brlyt.total_size_2 = hdr->brlyt.total_size; |
| |
| /* GFH header */ |
| gfh = (struct gfh_header *)(ptr + sizeof(struct gen_device_header)); |
| put_ghf_header(gfh, filesize, sizeof(struct gen_device_header), |
| loadaddr, GFH_FLASH_TYPE_GEN); |
| |
| /* Generate SHA256 hash */ |
| put_hash((uint8_t *)gfh, |
| filesize - sizeof(struct gen_device_header) - SHA256_SUM_LEN); |
| } |
| |
| static void mtk_image_set_nand_header(void *ptr, off_t filesize, |
| uint32_t loadaddr) |
| { |
| struct brom_layout_header *brlyt; |
| struct gfh_header *gfh; |
| uint32_t payload_pages, nand_page_size; |
| |
| /* NAND header */ |
| nand_page_size = mtk_nand_header_put(hdr_nand, ptr); |
| |
| if (nand_page_size) { |
| /* BRLYT header */ |
| payload_pages = (filesize + nand_page_size - 1) / |
| nand_page_size; |
| brlyt = (struct brom_layout_header *)(ptr + nand_page_size); |
| put_brom_layout_header(brlyt, hdr_media); |
| brlyt->header_size = cpu_to_le32(2); |
| brlyt->total_size = cpu_to_le32(payload_pages); |
| brlyt->header_size_2 = brlyt->header_size; |
| brlyt->total_size_2 = brlyt->total_size; |
| brlyt->unused = cpu_to_le32(1); |
| } |
| |
| /* GFH header */ |
| gfh = (struct gfh_header *)(ptr + hdr_nand_size); |
| put_ghf_header(gfh, filesize, hdr_nand_size, loadaddr, |
| GFH_FLASH_TYPE_NAND); |
| |
| /* Generate SHA256 hash */ |
| put_hash((uint8_t *)gfh, filesize - hdr_nand_size - SHA256_SUM_LEN); |
| } |
| |
| static void mtk_image_set_mt7621_header(void *ptr, off_t filesize, |
| uint32_t loadaddr) |
| { |
| struct legacy_img_hdr *hdr = (struct legacy_img_hdr *)ptr; |
| struct mt7621_stage1_header *shdr; |
| struct mt7621_nand_header *nhdr; |
| uint32_t datasize, crcval; |
| |
| datasize = filesize - image_get_header_size(); |
| nhdr = (struct mt7621_nand_header *)hdr->ih_name; |
| shdr = (struct mt7621_stage1_header *)(ptr + image_get_header_size()); |
| |
| shdr->ep = cpu_to_be32(loadaddr); |
| shdr->stage_size = cpu_to_be32(datasize); |
| |
| image_set_magic(hdr, IH_MAGIC); |
| image_set_time(hdr, time(NULL)); |
| image_set_size(hdr, datasize); |
| image_set_load(hdr, loadaddr); |
| image_set_ep(hdr, loadaddr); |
| image_set_os(hdr, IH_OS_U_BOOT); |
| image_set_arch(hdr, IH_ARCH_MIPS); |
| image_set_type(hdr, IH_TYPE_STANDALONE); |
| image_set_comp(hdr, IH_COMP_NONE); |
| |
| crcval = crc32(0, (uint8_t *)shdr, datasize); |
| image_set_dcrc(hdr, crcval); |
| |
| strncpy(nhdr->ih_name, "MT7621 NAND", MT7621_IH_NMLEN); |
| |
| nhdr->ih_stage_offset = cpu_to_be32(image_get_header_size()); |
| |
| crcval = crc32be_cal(hdr, image_get_header_size()); |
| nhdr->crc = cpu_to_be32(crcval); |
| |
| crcval = crc32(0, (uint8_t *)hdr, image_get_header_size()); |
| image_set_hcrc(hdr, crcval); |
| } |
| |
| static void mtk_image_set_header(void *ptr, struct stat *sbuf, int ifd, |
| struct image_tool_params *params) |
| { |
| union lk_hdr *lk = (union lk_hdr *)ptr; |
| |
| if (use_lk_hdr) { |
| lk->magic = cpu_to_le32(LK_PART_MAGIC); |
| lk->size = cpu_to_le32(sbuf->st_size - sizeof(union lk_hdr)); |
| lk->loadaddr = cpu_to_le32(params->addr); |
| lk->mode = 0xffffffff; /* must be non-zero */ |
| memset(lk->name, 0, sizeof(lk->name)); |
| strncpy(lk->name, lk_name, sizeof(lk->name)); |
| return; |
| } |
| |
| img_gen = true; |
| img_size = sbuf->st_size; |
| |
| if (use_mt7621_hdr) { |
| mtk_image_set_mt7621_header(ptr, sbuf->st_size, params->addr); |
| return; |
| } |
| |
| if (hdr_media == BRLYT_TYPE_NAND || hdr_media == BRLYT_TYPE_SNAND) |
| mtk_image_set_nand_header(ptr, sbuf->st_size, params->addr); |
| else |
| mtk_image_set_gen_header(ptr, sbuf->st_size, params->addr); |
| } |
| |
| U_BOOT_IMAGE_TYPE( |
| mtk_image, |
| "MediaTek BootROM Loadable Image support", |
| 0, |
| NULL, |
| mtk_image_check_params, |
| mtk_image_verify_header, |
| mtk_image_print_header, |
| mtk_image_set_header, |
| NULL, |
| mtk_image_check_image_types, |
| NULL, |
| mtk_image_vrec_header |
| ); |