forked from rrcarlosr/Jetpack
865 lines
20 KiB
C
865 lines
20 KiB
C
|
/*
|
||
|
* Image manipulator for Marvell SoCs
|
||
|
* supports Kirkwood, Dove, Armada 370, and Armada XP
|
||
|
*
|
||
|
* (C) Copyright 2013 Thomas Petazzoni
|
||
|
* <thomas.petazzoni@free-electrons.com>
|
||
|
*
|
||
|
* SPDX-License-Identifier: GPL-2.0+
|
||
|
*
|
||
|
* Not implemented: support for the register headers and secure
|
||
|
* headers in v1 images
|
||
|
*/
|
||
|
|
||
|
#include "imagetool.h"
|
||
|
#include <limits.h>
|
||
|
#include <image.h>
|
||
|
#include <stdint.h>
|
||
|
#include "kwbimage.h"
|
||
|
|
||
|
static struct image_cfg_element *image_cfg;
|
||
|
static int cfgn;
|
||
|
|
||
|
struct boot_mode {
|
||
|
unsigned int id;
|
||
|
const char *name;
|
||
|
};
|
||
|
|
||
|
struct boot_mode boot_modes[] = {
|
||
|
{ 0x4D, "i2c" },
|
||
|
{ 0x5A, "spi" },
|
||
|
{ 0x8B, "nand" },
|
||
|
{ 0x78, "sata" },
|
||
|
{ 0x9C, "pex" },
|
||
|
{ 0x69, "uart" },
|
||
|
{ 0xAE, "sdio" },
|
||
|
{},
|
||
|
};
|
||
|
|
||
|
struct nand_ecc_mode {
|
||
|
unsigned int id;
|
||
|
const char *name;
|
||
|
};
|
||
|
|
||
|
struct nand_ecc_mode nand_ecc_modes[] = {
|
||
|
{ 0x00, "default" },
|
||
|
{ 0x01, "hamming" },
|
||
|
{ 0x02, "rs" },
|
||
|
{ 0x03, "disabled" },
|
||
|
{},
|
||
|
};
|
||
|
|
||
|
/* Used to identify an undefined execution or destination address */
|
||
|
#define ADDR_INVALID ((uint32_t)-1)
|
||
|
|
||
|
#define BINARY_MAX_ARGS 8
|
||
|
|
||
|
/* In-memory representation of a line of the configuration file */
|
||
|
struct image_cfg_element {
|
||
|
enum {
|
||
|
IMAGE_CFG_VERSION = 0x1,
|
||
|
IMAGE_CFG_BOOT_FROM,
|
||
|
IMAGE_CFG_DEST_ADDR,
|
||
|
IMAGE_CFG_EXEC_ADDR,
|
||
|
IMAGE_CFG_NAND_BLKSZ,
|
||
|
IMAGE_CFG_NAND_BADBLK_LOCATION,
|
||
|
IMAGE_CFG_NAND_ECC_MODE,
|
||
|
IMAGE_CFG_NAND_PAGESZ,
|
||
|
IMAGE_CFG_BINARY,
|
||
|
IMAGE_CFG_PAYLOAD,
|
||
|
IMAGE_CFG_DATA,
|
||
|
} type;
|
||
|
union {
|
||
|
unsigned int version;
|
||
|
unsigned int bootfrom;
|
||
|
struct {
|
||
|
const char *file;
|
||
|
unsigned int args[BINARY_MAX_ARGS];
|
||
|
unsigned int nargs;
|
||
|
} binary;
|
||
|
const char *payload;
|
||
|
unsigned int dstaddr;
|
||
|
unsigned int execaddr;
|
||
|
unsigned int nandblksz;
|
||
|
unsigned int nandbadblklocation;
|
||
|
unsigned int nandeccmode;
|
||
|
unsigned int nandpagesz;
|
||
|
struct ext_hdr_v0_reg regdata;
|
||
|
};
|
||
|
};
|
||
|
|
||
|
#define IMAGE_CFG_ELEMENT_MAX 256
|
||
|
|
||
|
/*
|
||
|
* Utility functions to manipulate boot mode and ecc modes (convert
|
||
|
* them back and forth between description strings and the
|
||
|
* corresponding numerical identifiers).
|
||
|
*/
|
||
|
|
||
|
static const char *image_boot_mode_name(unsigned int id)
|
||
|
{
|
||
|
int i;
|
||
|
for (i = 0; boot_modes[i].name; i++)
|
||
|
if (boot_modes[i].id == id)
|
||
|
return boot_modes[i].name;
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
int image_boot_mode_id(const char *boot_mode_name)
|
||
|
{
|
||
|
int i;
|
||
|
for (i = 0; boot_modes[i].name; i++)
|
||
|
if (!strcmp(boot_modes[i].name, boot_mode_name))
|
||
|
return boot_modes[i].id;
|
||
|
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
int image_nand_ecc_mode_id(const char *nand_ecc_mode_name)
|
||
|
{
|
||
|
int i;
|
||
|
for (i = 0; nand_ecc_modes[i].name; i++)
|
||
|
if (!strcmp(nand_ecc_modes[i].name, nand_ecc_mode_name))
|
||
|
return nand_ecc_modes[i].id;
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
static struct image_cfg_element *
|
||
|
image_find_option(unsigned int optiontype)
|
||
|
{
|
||
|
int i;
|
||
|
|
||
|
for (i = 0; i < cfgn; i++) {
|
||
|
if (image_cfg[i].type == optiontype)
|
||
|
return &image_cfg[i];
|
||
|
}
|
||
|
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
static unsigned int
|
||
|
image_count_options(unsigned int optiontype)
|
||
|
{
|
||
|
int i;
|
||
|
unsigned int count = 0;
|
||
|
|
||
|
for (i = 0; i < cfgn; i++)
|
||
|
if (image_cfg[i].type == optiontype)
|
||
|
count++;
|
||
|
|
||
|
return count;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Compute a 8-bit checksum of a memory area. This algorithm follows
|
||
|
* the requirements of the Marvell SoC BootROM specifications.
|
||
|
*/
|
||
|
static uint8_t image_checksum8(void *start, uint32_t len)
|
||
|
{
|
||
|
uint8_t csum = 0;
|
||
|
uint8_t *p = start;
|
||
|
|
||
|
/* check len and return zero checksum if invalid */
|
||
|
if (!len)
|
||
|
return 0;
|
||
|
|
||
|
do {
|
||
|
csum += *p;
|
||
|
p++;
|
||
|
} while (--len);
|
||
|
|
||
|
return csum;
|
||
|
}
|
||
|
|
||
|
static uint32_t image_checksum32(void *start, uint32_t len)
|
||
|
{
|
||
|
uint32_t csum = 0;
|
||
|
uint32_t *p = start;
|
||
|
|
||
|
/* check len and return zero checksum if invalid */
|
||
|
if (!len)
|
||
|
return 0;
|
||
|
|
||
|
if (len % sizeof(uint32_t)) {
|
||
|
fprintf(stderr, "Length %d is not in multiple of %zu\n",
|
||
|
len, sizeof(uint32_t));
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
do {
|
||
|
csum += *p;
|
||
|
p++;
|
||
|
len -= sizeof(uint32_t);
|
||
|
} while (len > 0);
|
||
|
|
||
|
return csum;
|
||
|
}
|
||
|
|
||
|
static void *image_create_v0(size_t *imagesz, struct image_tool_params *params,
|
||
|
int payloadsz)
|
||
|
{
|
||
|
struct image_cfg_element *e;
|
||
|
size_t headersz;
|
||
|
struct main_hdr_v0 *main_hdr;
|
||
|
struct ext_hdr_v0 *ext_hdr;
|
||
|
void *image;
|
||
|
int has_ext = 0;
|
||
|
|
||
|
/*
|
||
|
* Calculate the size of the header and the size of the
|
||
|
* payload
|
||
|
*/
|
||
|
headersz = sizeof(struct main_hdr_v0);
|
||
|
|
||
|
if (image_count_options(IMAGE_CFG_DATA) > 0) {
|
||
|
has_ext = 1;
|
||
|
headersz += sizeof(struct ext_hdr_v0);
|
||
|
}
|
||
|
|
||
|
if (image_count_options(IMAGE_CFG_PAYLOAD) > 1) {
|
||
|
fprintf(stderr, "More than one payload, not possible\n");
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
image = malloc(headersz);
|
||
|
if (!image) {
|
||
|
fprintf(stderr, "Cannot allocate memory for image\n");
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
memset(image, 0, headersz);
|
||
|
|
||
|
main_hdr = image;
|
||
|
|
||
|
/* Fill in the main header */
|
||
|
main_hdr->blocksize =
|
||
|
cpu_to_le32(payloadsz + sizeof(uint32_t) - headersz);
|
||
|
main_hdr->srcaddr = cpu_to_le32(headersz);
|
||
|
main_hdr->ext = has_ext;
|
||
|
main_hdr->destaddr = cpu_to_le32(params->addr);
|
||
|
main_hdr->execaddr = cpu_to_le32(params->ep);
|
||
|
|
||
|
e = image_find_option(IMAGE_CFG_BOOT_FROM);
|
||
|
if (e)
|
||
|
main_hdr->blockid = e->bootfrom;
|
||
|
e = image_find_option(IMAGE_CFG_NAND_ECC_MODE);
|
||
|
if (e)
|
||
|
main_hdr->nandeccmode = e->nandeccmode;
|
||
|
e = image_find_option(IMAGE_CFG_NAND_PAGESZ);
|
||
|
if (e)
|
||
|
main_hdr->nandpagesize = cpu_to_le16(e->nandpagesz);
|
||
|
main_hdr->checksum = image_checksum8(image,
|
||
|
sizeof(struct main_hdr_v0));
|
||
|
|
||
|
/* Generate the ext header */
|
||
|
if (has_ext) {
|
||
|
int cfgi, datai;
|
||
|
|
||
|
ext_hdr = image + sizeof(struct main_hdr_v0);
|
||
|
ext_hdr->offset = cpu_to_le32(0x40);
|
||
|
|
||
|
for (cfgi = 0, datai = 0; cfgi < cfgn; cfgi++) {
|
||
|
e = &image_cfg[cfgi];
|
||
|
if (e->type != IMAGE_CFG_DATA)
|
||
|
continue;
|
||
|
|
||
|
ext_hdr->rcfg[datai].raddr =
|
||
|
cpu_to_le32(e->regdata.raddr);
|
||
|
ext_hdr->rcfg[datai].rdata =
|
||
|
cpu_to_le32(e->regdata.rdata);
|
||
|
datai++;
|
||
|
}
|
||
|
|
||
|
ext_hdr->checksum = image_checksum8(ext_hdr,
|
||
|
sizeof(struct ext_hdr_v0));
|
||
|
}
|
||
|
|
||
|
*imagesz = headersz;
|
||
|
return image;
|
||
|
}
|
||
|
|
||
|
static size_t image_headersz_v1(struct image_tool_params *params,
|
||
|
int *hasext)
|
||
|
{
|
||
|
struct image_cfg_element *binarye;
|
||
|
size_t headersz;
|
||
|
int ret;
|
||
|
|
||
|
/*
|
||
|
* Calculate the size of the header and the size of the
|
||
|
* payload
|
||
|
*/
|
||
|
headersz = sizeof(struct main_hdr_v1);
|
||
|
|
||
|
if (image_count_options(IMAGE_CFG_BINARY) > 1) {
|
||
|
fprintf(stderr, "More than one binary blob, not supported\n");
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
if (image_count_options(IMAGE_CFG_PAYLOAD) > 1) {
|
||
|
fprintf(stderr, "More than one payload, not possible\n");
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
binarye = image_find_option(IMAGE_CFG_BINARY);
|
||
|
if (binarye) {
|
||
|
struct stat s;
|
||
|
|
||
|
ret = stat(binarye->binary.file, &s);
|
||
|
if (ret < 0) {
|
||
|
char cwd[PATH_MAX];
|
||
|
char *dir = cwd;
|
||
|
|
||
|
memset(cwd, 0, sizeof(cwd));
|
||
|
if (!getcwd(cwd, sizeof(cwd))) {
|
||
|
dir = "current working directory";
|
||
|
perror("getcwd() failed");
|
||
|
}
|
||
|
|
||
|
fprintf(stderr,
|
||
|
"Didn't find the file '%s' in '%s' which is mandatory to generate the image\n"
|
||
|
"This file generally contains the DDR3 training code, and should be extracted from an existing bootable\n"
|
||
|
"image for your board. See 'kwbimage -x' to extract it from an existing image.\n",
|
||
|
binarye->binary.file, dir);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
headersz += sizeof(struct opt_hdr_v1) +
|
||
|
s.st_size +
|
||
|
(binarye->binary.nargs + 2) * sizeof(uint32_t);
|
||
|
if (hasext)
|
||
|
*hasext = 1;
|
||
|
}
|
||
|
|
||
|
#if defined(CONFIG_SYS_U_BOOT_OFFS)
|
||
|
if (headersz > CONFIG_SYS_U_BOOT_OFFS) {
|
||
|
fprintf(stderr, "Error: Image header (incl. SPL image) too big!\n");
|
||
|
fprintf(stderr, "header=0x%x CONFIG_SYS_U_BOOT_OFFS=0x%x!\n",
|
||
|
(int)headersz, CONFIG_SYS_U_BOOT_OFFS);
|
||
|
fprintf(stderr, "Increase CONFIG_SYS_U_BOOT_OFFS!\n");
|
||
|
return 0;
|
||
|
} else {
|
||
|
headersz = CONFIG_SYS_U_BOOT_OFFS;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
/*
|
||
|
* The payload should be aligned on some reasonable
|
||
|
* boundary
|
||
|
*/
|
||
|
return ALIGN_SUP(headersz, 4096);
|
||
|
}
|
||
|
|
||
|
static void *image_create_v1(size_t *imagesz, struct image_tool_params *params,
|
||
|
int payloadsz)
|
||
|
{
|
||
|
struct image_cfg_element *e, *binarye;
|
||
|
struct main_hdr_v1 *main_hdr;
|
||
|
size_t headersz;
|
||
|
void *image, *cur;
|
||
|
int hasext = 0;
|
||
|
int ret;
|
||
|
|
||
|
/*
|
||
|
* Calculate the size of the header and the size of the
|
||
|
* payload
|
||
|
*/
|
||
|
headersz = image_headersz_v1(params, &hasext);
|
||
|
if (headersz == 0)
|
||
|
return NULL;
|
||
|
|
||
|
image = malloc(headersz);
|
||
|
if (!image) {
|
||
|
fprintf(stderr, "Cannot allocate memory for image\n");
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
memset(image, 0, headersz);
|
||
|
|
||
|
cur = main_hdr = image;
|
||
|
cur += sizeof(struct main_hdr_v1);
|
||
|
|
||
|
/* Fill the main header */
|
||
|
main_hdr->blocksize =
|
||
|
cpu_to_le32(payloadsz - headersz + sizeof(uint32_t));
|
||
|
main_hdr->headersz_lsb = cpu_to_le16(headersz & 0xFFFF);
|
||
|
main_hdr->headersz_msb = (headersz & 0xFFFF0000) >> 16;
|
||
|
main_hdr->destaddr = cpu_to_le32(params->addr);
|
||
|
main_hdr->execaddr = cpu_to_le32(params->ep);
|
||
|
main_hdr->srcaddr = cpu_to_le32(headersz);
|
||
|
main_hdr->ext = hasext;
|
||
|
main_hdr->version = 1;
|
||
|
e = image_find_option(IMAGE_CFG_BOOT_FROM);
|
||
|
if (e)
|
||
|
main_hdr->blockid = e->bootfrom;
|
||
|
e = image_find_option(IMAGE_CFG_NAND_BLKSZ);
|
||
|
if (e)
|
||
|
main_hdr->nandblocksize = e->nandblksz / (64 * 1024);
|
||
|
e = image_find_option(IMAGE_CFG_NAND_BADBLK_LOCATION);
|
||
|
if (e)
|
||
|
main_hdr->nandbadblklocation = e->nandbadblklocation;
|
||
|
|
||
|
binarye = image_find_option(IMAGE_CFG_BINARY);
|
||
|
if (binarye) {
|
||
|
struct opt_hdr_v1 *hdr = cur;
|
||
|
uint32_t *args;
|
||
|
size_t binhdrsz;
|
||
|
struct stat s;
|
||
|
int argi;
|
||
|
FILE *bin;
|
||
|
|
||
|
hdr->headertype = OPT_HDR_V1_BINARY_TYPE;
|
||
|
|
||
|
bin = fopen(binarye->binary.file, "r");
|
||
|
if (!bin) {
|
||
|
fprintf(stderr, "Cannot open binary file %s\n",
|
||
|
binarye->binary.file);
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
fstat(fileno(bin), &s);
|
||
|
|
||
|
binhdrsz = sizeof(struct opt_hdr_v1) +
|
||
|
(binarye->binary.nargs + 2) * sizeof(uint32_t) +
|
||
|
s.st_size;
|
||
|
|
||
|
/*
|
||
|
* The size includes the binary image size, rounded
|
||
|
* up to a 4-byte boundary. Plus 4 bytes for the
|
||
|
* next-header byte and 3-byte alignment at the end.
|
||
|
*/
|
||
|
binhdrsz = ALIGN_SUP(binhdrsz, 4) + 4;
|
||
|
hdr->headersz_lsb = cpu_to_le16(binhdrsz & 0xFFFF);
|
||
|
hdr->headersz_msb = (binhdrsz & 0xFFFF0000) >> 16;
|
||
|
|
||
|
cur += sizeof(struct opt_hdr_v1);
|
||
|
|
||
|
args = cur;
|
||
|
*args = cpu_to_le32(binarye->binary.nargs);
|
||
|
args++;
|
||
|
for (argi = 0; argi < binarye->binary.nargs; argi++)
|
||
|
args[argi] = cpu_to_le32(binarye->binary.args[argi]);
|
||
|
|
||
|
cur += (binarye->binary.nargs + 1) * sizeof(uint32_t);
|
||
|
|
||
|
ret = fread(cur, s.st_size, 1, bin);
|
||
|
if (ret != 1) {
|
||
|
fprintf(stderr,
|
||
|
"Could not read binary image %s\n",
|
||
|
binarye->binary.file);
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
fclose(bin);
|
||
|
|
||
|
cur += ALIGN_SUP(s.st_size, 4);
|
||
|
|
||
|
/*
|
||
|
* For now, we don't support more than one binary
|
||
|
* header, and no other header types are
|
||
|
* supported. So, the binary header is necessarily the
|
||
|
* last one
|
||
|
*/
|
||
|
*((uint32_t *)cur) = 0x00000000;
|
||
|
|
||
|
cur += sizeof(uint32_t);
|
||
|
}
|
||
|
|
||
|
/* Calculate and set the header checksum */
|
||
|
main_hdr->checksum = image_checksum8(main_hdr, headersz);
|
||
|
|
||
|
*imagesz = headersz;
|
||
|
return image;
|
||
|
}
|
||
|
|
||
|
static int image_create_config_parse_oneline(char *line,
|
||
|
struct image_cfg_element *el)
|
||
|
{
|
||
|
char *keyword, *saveptr;
|
||
|
char deliminiters[] = " \t";
|
||
|
|
||
|
keyword = strtok_r(line, deliminiters, &saveptr);
|
||
|
if (!strcmp(keyword, "VERSION")) {
|
||
|
char *value = strtok_r(NULL, deliminiters, &saveptr);
|
||
|
el->type = IMAGE_CFG_VERSION;
|
||
|
el->version = atoi(value);
|
||
|
} else if (!strcmp(keyword, "BOOT_FROM")) {
|
||
|
char *value = strtok_r(NULL, deliminiters, &saveptr);
|
||
|
int ret = image_boot_mode_id(value);
|
||
|
if (ret < 0) {
|
||
|
fprintf(stderr,
|
||
|
"Invalid boot media '%s'\n", value);
|
||
|
return -1;
|
||
|
}
|
||
|
el->type = IMAGE_CFG_BOOT_FROM;
|
||
|
el->bootfrom = ret;
|
||
|
} else if (!strcmp(keyword, "NAND_BLKSZ")) {
|
||
|
char *value = strtok_r(NULL, deliminiters, &saveptr);
|
||
|
el->type = IMAGE_CFG_NAND_BLKSZ;
|
||
|
el->nandblksz = strtoul(value, NULL, 16);
|
||
|
} else if (!strcmp(keyword, "NAND_BADBLK_LOCATION")) {
|
||
|
char *value = strtok_r(NULL, deliminiters, &saveptr);
|
||
|
el->type = IMAGE_CFG_NAND_BADBLK_LOCATION;
|
||
|
el->nandbadblklocation =
|
||
|
strtoul(value, NULL, 16);
|
||
|
} else if (!strcmp(keyword, "NAND_ECC_MODE")) {
|
||
|
char *value = strtok_r(NULL, deliminiters, &saveptr);
|
||
|
int ret = image_nand_ecc_mode_id(value);
|
||
|
if (ret < 0) {
|
||
|
fprintf(stderr,
|
||
|
"Invalid NAND ECC mode '%s'\n", value);
|
||
|
return -1;
|
||
|
}
|
||
|
el->type = IMAGE_CFG_NAND_ECC_MODE;
|
||
|
el->nandeccmode = ret;
|
||
|
} else if (!strcmp(keyword, "NAND_PAGE_SIZE")) {
|
||
|
char *value = strtok_r(NULL, deliminiters, &saveptr);
|
||
|
el->type = IMAGE_CFG_NAND_PAGESZ;
|
||
|
el->nandpagesz = strtoul(value, NULL, 16);
|
||
|
} else if (!strcmp(keyword, "BINARY")) {
|
||
|
char *value = strtok_r(NULL, deliminiters, &saveptr);
|
||
|
int argi = 0;
|
||
|
|
||
|
el->type = IMAGE_CFG_BINARY;
|
||
|
el->binary.file = strdup(value);
|
||
|
while (1) {
|
||
|
value = strtok_r(NULL, deliminiters, &saveptr);
|
||
|
if (!value)
|
||
|
break;
|
||
|
el->binary.args[argi] = strtoul(value, NULL, 16);
|
||
|
argi++;
|
||
|
if (argi >= BINARY_MAX_ARGS) {
|
||
|
fprintf(stderr,
|
||
|
"Too many argument for binary\n");
|
||
|
return -1;
|
||
|
}
|
||
|
}
|
||
|
el->binary.nargs = argi;
|
||
|
} else if (!strcmp(keyword, "DATA")) {
|
||
|
char *value1 = strtok_r(NULL, deliminiters, &saveptr);
|
||
|
char *value2 = strtok_r(NULL, deliminiters, &saveptr);
|
||
|
|
||
|
if (!value1 || !value2) {
|
||
|
fprintf(stderr,
|
||
|
"Invalid number of arguments for DATA\n");
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
el->type = IMAGE_CFG_DATA;
|
||
|
el->regdata.raddr = strtoul(value1, NULL, 16);
|
||
|
el->regdata.rdata = strtoul(value2, NULL, 16);
|
||
|
} else {
|
||
|
fprintf(stderr, "Ignoring unknown line '%s'\n", line);
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Parse the configuration file 'fcfg' into the array of configuration
|
||
|
* elements 'image_cfg', and return the number of configuration
|
||
|
* elements in 'cfgn'.
|
||
|
*/
|
||
|
static int image_create_config_parse(FILE *fcfg)
|
||
|
{
|
||
|
int ret;
|
||
|
int cfgi = 0;
|
||
|
|
||
|
/* Parse the configuration file */
|
||
|
while (!feof(fcfg)) {
|
||
|
char *line;
|
||
|
char buf[256];
|
||
|
|
||
|
/* Read the current line */
|
||
|
memset(buf, 0, sizeof(buf));
|
||
|
line = fgets(buf, sizeof(buf), fcfg);
|
||
|
if (!line)
|
||
|
break;
|
||
|
|
||
|
/* Ignore useless lines */
|
||
|
if (line[0] == '\n' || line[0] == '#')
|
||
|
continue;
|
||
|
|
||
|
/* Strip final newline */
|
||
|
if (line[strlen(line) - 1] == '\n')
|
||
|
line[strlen(line) - 1] = 0;
|
||
|
|
||
|
/* Parse the current line */
|
||
|
ret = image_create_config_parse_oneline(line,
|
||
|
&image_cfg[cfgi]);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
cfgi++;
|
||
|
|
||
|
if (cfgi >= IMAGE_CFG_ELEMENT_MAX) {
|
||
|
fprintf(stderr,
|
||
|
"Too many configuration elements in .cfg file\n");
|
||
|
return -1;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
cfgn = cfgi;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int image_get_version(void)
|
||
|
{
|
||
|
struct image_cfg_element *e;
|
||
|
|
||
|
e = image_find_option(IMAGE_CFG_VERSION);
|
||
|
if (!e)
|
||
|
return -1;
|
||
|
|
||
|
return e->version;
|
||
|
}
|
||
|
|
||
|
static int image_version_file(const char *input)
|
||
|
{
|
||
|
FILE *fcfg;
|
||
|
int version;
|
||
|
int ret;
|
||
|
|
||
|
fcfg = fopen(input, "r");
|
||
|
if (!fcfg) {
|
||
|
fprintf(stderr, "Could not open input file %s\n", input);
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
image_cfg = malloc(IMAGE_CFG_ELEMENT_MAX *
|
||
|
sizeof(struct image_cfg_element));
|
||
|
if (!image_cfg) {
|
||
|
fprintf(stderr, "Cannot allocate memory\n");
|
||
|
fclose(fcfg);
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
memset(image_cfg, 0,
|
||
|
IMAGE_CFG_ELEMENT_MAX * sizeof(struct image_cfg_element));
|
||
|
rewind(fcfg);
|
||
|
|
||
|
ret = image_create_config_parse(fcfg);
|
||
|
fclose(fcfg);
|
||
|
if (ret) {
|
||
|
free(image_cfg);
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
version = image_get_version();
|
||
|
/* Fallback to version 0 is no version is provided in the cfg file */
|
||
|
if (version == -1)
|
||
|
version = 0;
|
||
|
|
||
|
free(image_cfg);
|
||
|
|
||
|
return version;
|
||
|
}
|
||
|
|
||
|
static void kwbimage_set_header(void *ptr, struct stat *sbuf, int ifd,
|
||
|
struct image_tool_params *params)
|
||
|
{
|
||
|
FILE *fcfg;
|
||
|
void *image = NULL;
|
||
|
int version;
|
||
|
size_t headersz = 0;
|
||
|
uint32_t checksum;
|
||
|
int ret;
|
||
|
int size;
|
||
|
|
||
|
fcfg = fopen(params->imagename, "r");
|
||
|
if (!fcfg) {
|
||
|
fprintf(stderr, "Could not open input file %s\n",
|
||
|
params->imagename);
|
||
|
exit(EXIT_FAILURE);
|
||
|
}
|
||
|
|
||
|
image_cfg = malloc(IMAGE_CFG_ELEMENT_MAX *
|
||
|
sizeof(struct image_cfg_element));
|
||
|
if (!image_cfg) {
|
||
|
fprintf(stderr, "Cannot allocate memory\n");
|
||
|
fclose(fcfg);
|
||
|
exit(EXIT_FAILURE);
|
||
|
}
|
||
|
|
||
|
memset(image_cfg, 0,
|
||
|
IMAGE_CFG_ELEMENT_MAX * sizeof(struct image_cfg_element));
|
||
|
rewind(fcfg);
|
||
|
|
||
|
ret = image_create_config_parse(fcfg);
|
||
|
fclose(fcfg);
|
||
|
if (ret) {
|
||
|
free(image_cfg);
|
||
|
exit(EXIT_FAILURE);
|
||
|
}
|
||
|
|
||
|
/* The MVEBU BootROM does not allow non word aligned payloads */
|
||
|
sbuf->st_size = ALIGN_SUP(sbuf->st_size, 4);
|
||
|
|
||
|
version = image_get_version();
|
||
|
switch (version) {
|
||
|
/*
|
||
|
* Fallback to version 0 if no version is provided in the
|
||
|
* cfg file
|
||
|
*/
|
||
|
case -1:
|
||
|
case 0:
|
||
|
image = image_create_v0(&headersz, params, sbuf->st_size);
|
||
|
break;
|
||
|
|
||
|
case 1:
|
||
|
image = image_create_v1(&headersz, params, sbuf->st_size);
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
fprintf(stderr, "Unsupported version %d\n", version);
|
||
|
free(image_cfg);
|
||
|
exit(EXIT_FAILURE);
|
||
|
}
|
||
|
|
||
|
if (!image) {
|
||
|
fprintf(stderr, "Could not create image\n");
|
||
|
free(image_cfg);
|
||
|
exit(EXIT_FAILURE);
|
||
|
}
|
||
|
|
||
|
free(image_cfg);
|
||
|
|
||
|
/* Build and add image checksum header */
|
||
|
checksum =
|
||
|
cpu_to_le32(image_checksum32((uint32_t *)ptr, sbuf->st_size));
|
||
|
size = write(ifd, &checksum, sizeof(uint32_t));
|
||
|
if (size != sizeof(uint32_t)) {
|
||
|
fprintf(stderr, "Error:%s - Checksum write %d bytes %s\n",
|
||
|
params->cmdname, size, params->imagefile);
|
||
|
exit(EXIT_FAILURE);
|
||
|
}
|
||
|
|
||
|
sbuf->st_size += sizeof(uint32_t);
|
||
|
|
||
|
/* Finally copy the header into the image area */
|
||
|
memcpy(ptr, image, headersz);
|
||
|
|
||
|
free(image);
|
||
|
}
|
||
|
|
||
|
static void kwbimage_print_header(const void *ptr)
|
||
|
{
|
||
|
struct main_hdr_v0 *mhdr = (struct main_hdr_v0 *)ptr;
|
||
|
|
||
|
printf("Image Type: MVEBU Boot from %s Image\n",
|
||
|
image_boot_mode_name(mhdr->blockid));
|
||
|
printf("Image version:%d\n", image_version((void *)ptr));
|
||
|
printf("Data Size: ");
|
||
|
genimg_print_size(mhdr->blocksize - sizeof(uint32_t));
|
||
|
printf("Load Address: %08x\n", mhdr->destaddr);
|
||
|
printf("Entry Point: %08x\n", mhdr->execaddr);
|
||
|
}
|
||
|
|
||
|
static int kwbimage_check_image_types(uint8_t type)
|
||
|
{
|
||
|
if (type == IH_TYPE_KWBIMAGE)
|
||
|
return EXIT_SUCCESS;
|
||
|
else
|
||
|
return EXIT_FAILURE;
|
||
|
}
|
||
|
|
||
|
static int kwbimage_verify_header(unsigned char *ptr, int image_size,
|
||
|
struct image_tool_params *params)
|
||
|
{
|
||
|
struct main_hdr_v0 *main_hdr;
|
||
|
struct ext_hdr_v0 *ext_hdr;
|
||
|
uint8_t checksum;
|
||
|
|
||
|
main_hdr = (void *)ptr;
|
||
|
checksum = image_checksum8(ptr,
|
||
|
sizeof(struct main_hdr_v0)
|
||
|
- sizeof(uint8_t));
|
||
|
if (checksum != main_hdr->checksum)
|
||
|
return -FDT_ERR_BADSTRUCTURE;
|
||
|
|
||
|
/* Only version 0 extended header has checksum */
|
||
|
if (image_version((void *)ptr) == 0) {
|
||
|
ext_hdr = (void *)ptr + sizeof(struct main_hdr_v0);
|
||
|
checksum = image_checksum8(ext_hdr,
|
||
|
sizeof(struct ext_hdr_v0)
|
||
|
- sizeof(uint8_t));
|
||
|
if (checksum != ext_hdr->checksum)
|
||
|
return -FDT_ERR_BADSTRUCTURE;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int kwbimage_generate(struct image_tool_params *params,
|
||
|
struct image_type_params *tparams)
|
||
|
{
|
||
|
int alloc_len;
|
||
|
void *hdr;
|
||
|
int version = 0;
|
||
|
|
||
|
version = image_version_file(params->imagename);
|
||
|
if (version == 0) {
|
||
|
alloc_len = sizeof(struct main_hdr_v0) +
|
||
|
sizeof(struct ext_hdr_v0);
|
||
|
} else {
|
||
|
alloc_len = image_headersz_v1(params, NULL);
|
||
|
}
|
||
|
|
||
|
hdr = malloc(alloc_len);
|
||
|
if (!hdr) {
|
||
|
fprintf(stderr, "%s: malloc return failure: %s\n",
|
||
|
params->cmdname, strerror(errno));
|
||
|
exit(EXIT_FAILURE);
|
||
|
}
|
||
|
|
||
|
memset(hdr, 0, alloc_len);
|
||
|
tparams->header_size = alloc_len;
|
||
|
tparams->hdr = hdr;
|
||
|
|
||
|
/*
|
||
|
* The resulting image needs to be 4-byte aligned. At least
|
||
|
* the Marvell hdrparser tool complains if its unaligned.
|
||
|
* By returning 1 here in this function, called via
|
||
|
* tparams->vrec_header() in mkimage.c, mkimage will
|
||
|
* automatically pad the the resulting image to a 4-byte
|
||
|
* size if necessary.
|
||
|
*/
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Report Error if xflag is set in addition to default
|
||
|
*/
|
||
|
static int kwbimage_check_params(struct image_tool_params *params)
|
||
|
{
|
||
|
if (!strlen(params->imagename)) {
|
||
|
fprintf(stderr, "Error:%s - Configuration file not specified, "
|
||
|
"it is needed for kwbimage generation\n",
|
||
|
params->cmdname);
|
||
|
return CFG_INVALID;
|
||
|
}
|
||
|
|
||
|
return (params->dflag && (params->fflag || params->lflag)) ||
|
||
|
(params->fflag && (params->dflag || params->lflag)) ||
|
||
|
(params->lflag && (params->dflag || params->fflag)) ||
|
||
|
(params->xflag) || !(strlen(params->imagename));
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* kwbimage type parameters definition
|
||
|
*/
|
||
|
U_BOOT_IMAGE_TYPE(
|
||
|
kwbimage,
|
||
|
"Marvell MVEBU Boot Image support",
|
||
|
0,
|
||
|
NULL,
|
||
|
kwbimage_check_params,
|
||
|
kwbimage_verify_header,
|
||
|
kwbimage_print_header,
|
||
|
kwbimage_set_header,
|
||
|
NULL,
|
||
|
kwbimage_check_image_types,
|
||
|
NULL,
|
||
|
kwbimage_generate
|
||
|
);
|