From patchwork Mon Apr 9 03:39:17 2018 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Su Hang X-Patchwork-Id: 10330313 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 2C2DA60236 for ; Mon, 9 Apr 2018 03:42:39 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 1DB1C1FF1E for ; Mon, 9 Apr 2018 03:42:39 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 1204720856; Mon, 9 Apr 2018 03:42:39 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-7.9 required=2.0 tests=BAYES_00, MAILING_LIST_MULTI, RCVD_IN_DNSWL_HI autolearn=ham version=3.3.1 Received: from lists.gnu.org (lists.gnu.org [208.118.235.17]) (using TLSv1 with cipher AES256-SHA (256/256 bits)) (No client certificate requested) by mail.wl.linuxfoundation.org (Postfix) with ESMTPS id ECD091FF1E for ; Mon, 9 Apr 2018 03:42:37 +0000 (UTC) Received: from localhost ([::1]:54972 helo=lists.gnu.org) by lists.gnu.org with esmtp (Exim 4.71) (envelope-from ) id 1f5NhV-0006Mh-9D for patchwork-qemu-devel@patchwork.kernel.org; Sun, 08 Apr 2018 23:42:37 -0400 Received: from eggs.gnu.org ([2001:4830:134:3::10]:40840) by lists.gnu.org with esmtp (Exim 4.71) (envelope-from ) id 1f5NeU-0003sN-Fa for qemu-devel@nongnu.org; Sun, 08 Apr 2018 23:39:34 -0400 Received: from Debian-exim by eggs.gnu.org with spam-scanned (Exim 4.71) (envelope-from ) id 1f5NeP-0003JI-Tb for qemu-devel@nongnu.org; Sun, 08 Apr 2018 23:39:30 -0400 Received: from smtp17.cstnet.cn ([159.226.251.17]:36434 helo=cstnet.cn) by eggs.gnu.org with esmtp (Exim 4.71) (envelope-from ) id 1f5NeO-0003Eb-Ub for qemu-devel@nongnu.org; Sun, 08 Apr 2018 23:39:25 -0400 Received: from Water.lan (unknown [124.16.136.100]) by APP-09 (Coremail) with SMTP id swCowAA3Ptpm4MpanlA9AA--.63252S4; Mon, 09 Apr 2018 11:39:18 +0800 (CST) From: Su Hang To: qemu-devel@nongnu.org Date: Mon, 9 Apr 2018 11:39:17 +0800 Message-Id: <1523245158-16443-2-git-send-email-suhang16@mails.ucas.ac.cn> X-Mailer: git-send-email 2.7.4 In-Reply-To: <1523245158-16443-1-git-send-email-suhang16@mails.ucas.ac.cn> References: <1523245158-16443-1-git-send-email-suhang16@mails.ucas.ac.cn> X-CM-TRANSID: swCowAA3Ptpm4MpanlA9AA--.63252S4 X-Coremail-Antispam: 1UD129KBjvJXoW3ArW3AFW7Xw4UKF1kJr17trb_yoWDGrWrpF ZxGrs8Jr4ktrW3ZFZxJr1UuFy5CFZ5Xa43WFy8Ww1FkFs3XwnFy3Wjkry3uay5KrykZw43 WFZ8XFW5JasxJaDanT9S1TB71UUUUU7qnTZGkaVYY2UrUUUUjbIjqfuFe4nvWSU5nxnvy2 9KBjDU0xBIdaVrnRJUUUPab7Iv0xC_Kw4lb4IE77IF4wAFF20E14v26r4j6ryUM7CY07I2 0VC2zVCF04k26cxKx2IYs7xG6rWj6s0DM7CIcVAFz4kK6r1j6r18M28IrcIa0xkI8VA2jI 8067AKxVWUGwA2048vs2IY020Ec7CjxVAFwI0_Jrv_JF4l8cAvFVAK0II2c7xJM28CjxkF 64kEwVA0rcxSw2x7M28EF7xvwVC0I7IYx2IY67AKxVW8JVW5JwA2z4x0Y4vE2Ix0cI8IcV CY1x0267AKxVW8JVWxJwA2z4x0Y4vEx4A2jsIE14v26r4UJVWxJr1l84ACjcxK6I8E87Iv 6xkF7I0E14v26r4UJVWxJr1lnxkEFVAIw20F6cxK64vIFxWle2I262IYc4CY6c8Ij28IcV AaY2xG8wAqx4xG64xvF2IEw4CE5I8CrVC2j2WlYx0E2Ix0cI8IcVAFwI0_Jrv_JF1lYx0E x4A2jsIE14v26r4j6F4UMcvjeVCFs4IE7xkEbVWUJVW8JwACjcxG0xvY0x0EwIxGrwCY02 Avz4vE14v_Gr4l42xK82IYc2Ij64vIr41l4I8I3I0E4IkC6x0Yz7v_Jr0_Gr1lx2IqxVAq x4xG67AKxVWUJVWUGwC20s026x8GjcxK67AKxVWUGVWUWwC2zVAF1VAY17CE14v26r126r 1DMIIYrxkI7VAKI48JMIIF0xvE2Ix0cI8IcVAFwI0_Jr0_JF4lIxAIcVC0I7IYx2IY6xkF 7I0E14v26r4j6F4UMIIF0xvE42xK8VAvwI8IcIk0rVWUJVWUCwCI42IY6I8E87Iv67AKxV WUJVW8JwCI42IY6I8E87Iv6xkF7I0E14v26r4j6r4UJbIYCTnIWIevJa73UjIFyTuYvjxU yXTmDUUUU X-CM-SenderInfo: pvxkt0rjrwqzpdlo2hpxfd2hldfou0/ X-detected-operating-system: by eggs.gnu.org: GNU/Linux 3.x [fuzzy] X-Received-From: 159.226.251.17 Subject: [Qemu-devel] [PATCH v4 1/2] Implement .hex file loader X-BeenThere: qemu-devel@nongnu.org X-Mailman-Version: 2.1.21 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: stefanha@gmail.com, jim@groklearning.com, joel@jms.id.au Errors-To: qemu-devel-bounces+patchwork-qemu-devel=patchwork.kernel.org@nongnu.org Sender: "Qemu-devel" X-Virus-Scanned: ClamAV using ClamSMTP This patch adds Intel Hexadecimal Object File format support to the loader. The file format specification is available here: http://www.piclist.com/techref/fileext/hex/intel.htm The file format is mainly intended for embedded systems and microcontrollers, such as Arduino, ARM, STM32, etc. Suggested-by: Stefan Hajnoczi Signed-off-by: Su Hang --- hw/arm/boot.c | 9 +- hw/core/loader.c | 280 ++++++++++++++++++++++++++++++++++++++++++++++++++++ include/hw/loader.h | 17 ++++ 3 files changed, 305 insertions(+), 1 deletion(-) diff --git a/hw/arm/boot.c b/hw/arm/boot.c index 9319b12fcd2a..07ce54e5936d 100644 --- a/hw/arm/boot.c +++ b/hw/arm/boot.c @@ -1060,8 +1060,15 @@ static void arm_load_kernel_notify(Notifier *notifier, void *data) kernel_size = load_aarch64_image(info->kernel_filename, info->loader_start, &entry, as); is_linux = 1; + } else if (kernel_size < 0 && strstr(info->kernel_filename, ".hex")) { + /* 32-bit ARM .hex file */ + entry = info->loader_start + KERNEL_LOAD_ADDR; + kernel_size = load_targphys_hex_as(info->kernel_filename, entry, + info->ram_size - KERNEL_LOAD_ADDR, + as); + is_linux = 1; } else if (kernel_size < 0) { - /* 32-bit ARM */ + /* 32-bit ARM binary file */ entry = info->loader_start + KERNEL_LOAD_ADDR; kernel_size = load_image_targphys_as(info->kernel_filename, entry, info->ram_size - KERNEL_LOAD_ADDR, diff --git a/hw/core/loader.c b/hw/core/loader.c index 06bdbca53709..41d714520be4 100644 --- a/hw/core/loader.c +++ b/hw/core/loader.c @@ -1286,3 +1286,283 @@ void hmp_info_roms(Monitor *mon, const QDict *qdict) } } } + +typedef enum HexRecord HexRecord; +enum HexRecord { + DATA_RECORD = 0, + EOF_RECORD, + EXT_SEG_ADDR_RECORD, + START_SEG_ADDR_RECORD, + EXT_LINEAR_ADDR_RECORD, + START_LINEAR_ADDR_RECORD, +}; + +typedef union HexLine HexLine; +union HexLine { + uint8_t buf[0x25]; + struct __attribute__((packed)) { + uint8_t byte_count; + uint16_t address; + uint8_t record_type; + uint8_t data[0x25 - 0x5]; + uint8_t checksum; + }; +}; + +static uint8_t ctoh(char c) +{ + return (c & 0x10) ? /*0-9*/ c & 0xf : /*A-F, a-f*/ (c & 0xf) + 9; +} + +static uint8_t validate_checksum(HexLine *record) +{ + uint8_t result = 0, i = 0; + + for (; i < (record->byte_count + 5); ++i) { + result += record->buf[i]; + } + + return result == 0; +} + +/* return pointer of bin_blob or NULL if error */ +static uint8_t *parse_hex_blob(char *filename, size_t *p_size) +{ + int fd; + off_t hex_blob_size; + uint8_t *p_data = NULL; + uint8_t *hex_blob; + uint8_t *hex_blob_ori; /* used to free temporary memory */ + uint8_t *bin_buf; + uint8_t *end; + uint8_t idx = 0; + uint8_t in_process = 0; /* avoid re-enter */ + uint8_t low_nibble = 0; /* process two hex char into 8-bits */ + uint8_t ext_linear_record = 0; /* record non-constitutes block */ + uint32_t next_address_to_write = 0; + uint32_t current_address = 0; + uint32_t last_address = 0; + HexLine line = {0}; + + fd = open(filename, O_RDONLY); + if (fd < 0) { + return NULL; + } + hex_blob_size = lseek(fd, 0, SEEK_END); + if (hex_blob_size < 0) { + close(fd); + return NULL; + } + hex_blob = g_malloc(hex_blob_size); + hex_blob_ori = hex_blob; + bin_buf = g_malloc(hex_blob_size * 2); + lseek(fd, 0, SEEK_SET); + if (read(fd, hex_blob, hex_blob_size) != hex_blob_size) { + close(fd); + goto hex_parser_exit; + } + close(fd); + + memset(line.buf, 0, sizeof(HexLine)); + end = (uint8_t *)hex_blob + hex_blob_size; + + for (; hex_blob != end; ++hex_blob) { + switch ((uint8_t)(*hex_blob)) { + case '\r': + case '\n': + if (!in_process) { + break; + } + + in_process = 0; + if (validate_checksum(&line) == 0) { + p_data = NULL; + goto hex_parser_exit; + } + + line.address = bswap16(line.address); + switch (line.record_type) { + case DATA_RECORD: + current_address = + (next_address_to_write & 0xffff0000) | line.address; + /* verify this is a continous block of memory */ + if (current_address != next_address_to_write || + ext_linear_record) { + if (!ext_linear_record) { + /* Store next address to write */ + last_address = next_address_to_write; + next_address_to_write = current_address; + } + ext_linear_record = 0; + memset(bin_buf + last_address, 0x0, + current_address - last_address); + } + + /* copy from line buffer to output bin_buf */ + memcpy((uint8_t *)bin_buf + current_address, + (uint8_t *)line.data, line.byte_count); + /* Save next address to write */ + last_address = current_address; + next_address_to_write = current_address + line.byte_count; + break; + + case EOF_RECORD: + /* nothing to do */ + break; + case EXT_SEG_ADDR_RECORD: + /* save next address to write, + * in case of non-continous block of memory */ + ext_linear_record = 1; + last_address = next_address_to_write; + next_address_to_write = + ((line.data[0] << 12) | (line.data[1] << 4)); + break; + case START_SEG_ADDR_RECORD: + /* TODO */ + break; + + case EXT_LINEAR_ADDR_RECORD: + /* save next address to write, + * in case of non-continous block of memory */ + ext_linear_record = 1; + last_address = next_address_to_write; + next_address_to_write = + ((line.data[0] << 24) | (line.data[1] << 16)); + break; + case START_LINEAR_ADDR_RECORD: + /* TODO */ + break; + + default: + p_data = NULL; + goto hex_parser_exit; + } + break; + + /* start of a new record. */ + case ':': + memset(line.buf, 0, sizeof(HexLine)); + in_process = 1; + low_nibble = 0; + idx = 0; + break; + + /* decoding lines */ + default: + if (low_nibble) { + line.buf[idx] |= ctoh((uint8_t)(*hex_blob)) & 0xf; + ++idx; + } else { + line.buf[idx] = ctoh((uint8_t)(*hex_blob)) << 4; + } + + low_nibble = !low_nibble; + break; + } + + } + + *p_size = (size_t)next_address_to_write; + p_data = g_malloc(next_address_to_write); + + memcpy(p_data, bin_buf, next_address_to_write); +hex_parser_exit: + g_free(hex_blob_ori); + g_free(bin_buf); + return p_data; +} + +/* return size or -1 if error */ +int load_targphys_hex_as(const char *filename, hwaddr addr, uint64_t max_sz, + AddressSpace *as) +{ + return rom_add_hex_file(filename, NULL, addr, -1, false, NULL, as); +} + +/* return size -1 if error */ +int rom_add_hex_file(const char *file, const char *fw_dir, hwaddr addr, + int32_t bootindex, bool option_rom, MemoryRegion *mr, + AddressSpace *as) +{ + MachineClass *mc = MACHINE_GET_CLASS(qdev_get_machine()); + Rom *rom; + char devpath[100]; + size_t datasize = 0; + + if (as && mr) { + fprintf(stderr, "Specifying an Address Space and Memory Region is " + "not valid when loading a rom\n"); + /* We haven't allocated anything so we don't need any cleanup */ + return -1; + } + + rom = g_malloc0(sizeof(*rom)); + rom->name = g_strdup(file); + rom->path = qemu_find_file(QEMU_FILE_TYPE_BIOS, rom->name); + rom->as = as; + if (rom->path == NULL) { + rom->path = g_strdup(file); + } + + rom->data = parse_hex_blob(rom->path, &datasize); + if (rom->data == NULL) { + fprintf(stderr, "failed to parse hex file '%s': %s\n", rom->path, + strerror(errno)); + goto err; + } + rom->datasize = datasize; + + if (fw_dir) { + rom->fw_dir = g_strdup(fw_dir); + rom->fw_file = g_strdup(file); + } + rom->addr = addr; + rom->romsize = rom->datasize; + + rom_insert(rom); + + if (rom->fw_file && fw_cfg) { + const char *basename; + char fw_file_name[FW_CFG_MAX_FILE_PATH]; + void *data; + + basename = strrchr(rom->fw_file, '/'); + if (basename) { + ++basename; + } else { + basename = rom->fw_file; + } + snprintf(fw_file_name, sizeof(fw_file_name), "%s/%s", rom->fw_dir, + basename); + snprintf(devpath, sizeof(devpath), "/rom@%s", fw_file_name); + + if ((!option_rom || mc->option_rom_has_mr) && mc->rom_file_has_mr) { + data = rom_set_mr(rom, OBJECT(fw_cfg), devpath, true); + } else { + data = rom->data; + } + + fw_cfg_add_file(fw_cfg, fw_file_name, data, rom->romsize); + } else { + if (mr) { + rom->mr = mr; + snprintf(devpath, sizeof(devpath), "/rom@%s", file); + } else { + snprintf(devpath, sizeof(devpath), "/rom@" TARGET_FMT_plx, addr); + } + } + + add_boot_device_path(bootindex, NULL, devpath); + return rom->datasize; + +err: + g_free(rom->path); + g_free(rom->name); + if (fw_dir) { + g_free(rom->fw_dir); + g_free(rom->fw_file); + } + g_free(rom); + + return -1; +} diff --git a/include/hw/loader.h b/include/hw/loader.h index 5ed3fd8ae67a..176b11221a27 100644 --- a/include/hw/loader.h +++ b/include/hw/loader.h @@ -28,6 +28,20 @@ ssize_t load_image_size(const char *filename, void *addr, size_t size); int load_image_targphys_as(const char *filename, hwaddr addr, uint64_t max_sz, AddressSpace *as); +/**load_image_targphys_hex_as: + * @filename: Path to the .hex file + * @addr: Address to load the .hex file to + * @max_sz: The maximum size of the .hex file to load + * @as: The AddressSpace to load the .hex file to. The value of + * address_space_memory is used if nothing is supplied here. + * + * Load a fixed .hex file into memory. + * + * Returns the size of the loaded .hex file on success, -1 otherwise. + */ +int load_targphys_hex_as(const char *filename, + hwaddr addr, uint64_t max_sz, AddressSpace *as); + /** load_image_targphys: * Same as load_image_targphys_as(), but doesn't allow the caller to specify * an AddressSpace. @@ -210,6 +224,9 @@ void pstrcpy_targphys(const char *name, extern bool option_rom_has_mr; extern bool rom_file_has_mr; +int rom_add_hex_file(const char *file, const char *fw_dir, + hwaddr addr, int32_t bootindex, + bool option_rom, MemoryRegion *mr, AddressSpace *as); int rom_add_file(const char *file, const char *fw_dir, hwaddr addr, int32_t bootindex, bool option_rom, MemoryRegion *mr, AddressSpace *as);