imximage.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712
  1. /*
  2. * (C) Copyright 2009
  3. * Stefano Babic, DENX Software Engineering, sbabic@denx.de.
  4. *
  5. * (C) Copyright 2008
  6. * Marvell Semiconductor <www.marvell.com>
  7. * Written-by: Prafulla Wadaskar <prafulla@marvell.com>
  8. *
  9. * SPDX-License-Identifier: GPL-2.0+
  10. */
  11. #include "imagetool.h"
  12. #include <image.h>
  13. #include "imximage.h"
  14. #define UNDEFINED 0xFFFFFFFF
  15. /*
  16. * Supported commands for configuration file
  17. */
  18. static table_entry_t imximage_cmds[] = {
  19. {CMD_BOOT_FROM, "BOOT_FROM", "boot command", },
  20. {CMD_BOOT_OFFSET, "BOOT_OFFSET", "Boot offset", },
  21. {CMD_DATA, "DATA", "Reg Write Data", },
  22. {CMD_CSF, "CSF", "Command Sequence File", },
  23. {CMD_IMAGE_VERSION, "IMAGE_VERSION", "image version", },
  24. {-1, "", "", },
  25. };
  26. /*
  27. * Supported Boot options for configuration file
  28. * this is needed to set the correct flash offset
  29. */
  30. static table_entry_t imximage_boot_offset[] = {
  31. {FLASH_OFFSET_ONENAND, "onenand", "OneNAND Flash",},
  32. {FLASH_OFFSET_NAND, "nand", "NAND Flash", },
  33. {FLASH_OFFSET_NOR, "nor", "NOR Flash", },
  34. {FLASH_OFFSET_SATA, "sata", "SATA Disk", },
  35. {FLASH_OFFSET_SD, "sd", "SD Card", },
  36. {FLASH_OFFSET_SPI, "spi", "SPI Flash", },
  37. {FLASH_OFFSET_QSPI, "qspi", "QSPI NOR Flash",},
  38. {-1, "", "Invalid", },
  39. };
  40. /*
  41. * Supported Boot options for configuration file
  42. * this is needed to determine the initial load size
  43. */
  44. static table_entry_t imximage_boot_loadsize[] = {
  45. {FLASH_LOADSIZE_ONENAND, "onenand", "OneNAND Flash",},
  46. {FLASH_LOADSIZE_NAND, "nand", "NAND Flash", },
  47. {FLASH_LOADSIZE_NOR, "nor", "NOR Flash", },
  48. {FLASH_LOADSIZE_SATA, "sata", "SATA Disk", },
  49. {FLASH_LOADSIZE_SD, "sd", "SD Card", },
  50. {FLASH_LOADSIZE_SPI, "spi", "SPI Flash", },
  51. {FLASH_LOADSIZE_QSPI, "qspi", "QSPI NOR Flash",},
  52. {-1, "", "Invalid", },
  53. };
  54. /*
  55. * IMXIMAGE version definition for i.MX chips
  56. */
  57. static table_entry_t imximage_versions[] = {
  58. {IMXIMAGE_V1, "", " (i.MX25/35/51 compatible)", },
  59. {IMXIMAGE_V2, "", " (i.MX53/6 compatible)", },
  60. {-1, "", " (Invalid)", },
  61. };
  62. static struct imx_header imximage_header;
  63. static uint32_t imximage_version;
  64. /*
  65. * Image Vector Table Offset
  66. * Initialized to a wrong not 4-bytes aligned address to
  67. * check if it is was set by the cfg file.
  68. */
  69. static uint32_t imximage_ivt_offset = UNDEFINED;
  70. static uint32_t imximage_csf_size = UNDEFINED;
  71. /* Initial Load Region Size */
  72. static uint32_t imximage_init_loadsize;
  73. static set_dcd_val_t set_dcd_val;
  74. static set_dcd_rst_t set_dcd_rst;
  75. static set_imx_hdr_t set_imx_hdr;
  76. static uint32_t max_dcd_entries;
  77. static uint32_t *header_size_ptr;
  78. static uint32_t *csf_ptr;
  79. static uint32_t get_cfg_value(char *token, char *name, int linenr)
  80. {
  81. char *endptr;
  82. uint32_t value;
  83. errno = 0;
  84. value = strtoul(token, &endptr, 16);
  85. if (errno || (token == endptr)) {
  86. fprintf(stderr, "Error: %s[%d] - Invalid hex data(%s)\n",
  87. name, linenr, token);
  88. exit(EXIT_FAILURE);
  89. }
  90. return value;
  91. }
  92. static uint32_t detect_imximage_version(struct imx_header *imx_hdr)
  93. {
  94. imx_header_v1_t *hdr_v1 = &imx_hdr->header.hdr_v1;
  95. imx_header_v2_t *hdr_v2 = &imx_hdr->header.hdr_v2;
  96. flash_header_v1_t *fhdr_v1 = &hdr_v1->fhdr;
  97. flash_header_v2_t *fhdr_v2 = &hdr_v2->fhdr;
  98. /* Try to detect V1 */
  99. if ((fhdr_v1->app_code_barker == APP_CODE_BARKER) &&
  100. (hdr_v1->dcd_table.preamble.barker == DCD_BARKER))
  101. return IMXIMAGE_V1;
  102. /* Try to detect V2 */
  103. if ((fhdr_v2->header.tag == IVT_HEADER_TAG) &&
  104. (hdr_v2->dcd_table.header.tag == DCD_HEADER_TAG))
  105. return IMXIMAGE_V2;
  106. return IMXIMAGE_VER_INVALID;
  107. }
  108. static void err_imximage_version(int version)
  109. {
  110. fprintf(stderr,
  111. "Error: Unsupported imximage version:%d\n", version);
  112. exit(EXIT_FAILURE);
  113. }
  114. static void set_dcd_val_v1(struct imx_header *imxhdr, char *name, int lineno,
  115. int fld, uint32_t value, uint32_t off)
  116. {
  117. dcd_v1_t *dcd_v1 = &imxhdr->header.hdr_v1.dcd_table;
  118. switch (fld) {
  119. case CFG_REG_SIZE:
  120. /* Byte, halfword, word */
  121. if ((value != 1) && (value != 2) && (value != 4)) {
  122. fprintf(stderr, "Error: %s[%d] - "
  123. "Invalid register size " "(%d)\n",
  124. name, lineno, value);
  125. exit(EXIT_FAILURE);
  126. }
  127. dcd_v1->addr_data[off].type = value;
  128. break;
  129. case CFG_REG_ADDRESS:
  130. dcd_v1->addr_data[off].addr = value;
  131. break;
  132. case CFG_REG_VALUE:
  133. dcd_v1->addr_data[off].value = value;
  134. break;
  135. default:
  136. break;
  137. }
  138. }
  139. static void set_dcd_val_v2(struct imx_header *imxhdr, char *name, int lineno,
  140. int fld, uint32_t value, uint32_t off)
  141. {
  142. dcd_v2_t *dcd_v2 = &imxhdr->header.hdr_v2.dcd_table;
  143. switch (fld) {
  144. case CFG_REG_ADDRESS:
  145. dcd_v2->addr_data[off].addr = cpu_to_be32(value);
  146. break;
  147. case CFG_REG_VALUE:
  148. dcd_v2->addr_data[off].value = cpu_to_be32(value);
  149. break;
  150. default:
  151. break;
  152. }
  153. }
  154. /*
  155. * Complete setting up the rest field of DCD of V1
  156. * such as barker code and DCD data length.
  157. */
  158. static void set_dcd_rst_v1(struct imx_header *imxhdr, uint32_t dcd_len,
  159. char *name, int lineno)
  160. {
  161. dcd_v1_t *dcd_v1 = &imxhdr->header.hdr_v1.dcd_table;
  162. dcd_v1->preamble.barker = DCD_BARKER;
  163. dcd_v1->preamble.length = dcd_len * sizeof(dcd_type_addr_data_t);
  164. }
  165. /*
  166. * Complete setting up the reset field of DCD of V2
  167. * such as DCD tag, version, length, etc.
  168. */
  169. static void set_dcd_rst_v2(struct imx_header *imxhdr, uint32_t dcd_len,
  170. char *name, int lineno)
  171. {
  172. dcd_v2_t *dcd_v2 = &imxhdr->header.hdr_v2.dcd_table;
  173. dcd_v2->header.tag = DCD_HEADER_TAG;
  174. dcd_v2->header.length = cpu_to_be16(
  175. dcd_len * sizeof(dcd_addr_data_t) + 8);
  176. dcd_v2->header.version = DCD_VERSION;
  177. dcd_v2->write_dcd_command.tag = DCD_COMMAND_TAG;
  178. dcd_v2->write_dcd_command.length = cpu_to_be16(
  179. dcd_len * sizeof(dcd_addr_data_t) + 4);
  180. dcd_v2->write_dcd_command.param = DCD_COMMAND_PARAM;
  181. }
  182. static void set_imx_hdr_v1(struct imx_header *imxhdr, uint32_t dcd_len,
  183. uint32_t entry_point, uint32_t flash_offset)
  184. {
  185. imx_header_v1_t *hdr_v1 = &imxhdr->header.hdr_v1;
  186. flash_header_v1_t *fhdr_v1 = &hdr_v1->fhdr;
  187. dcd_v1_t *dcd_v1 = &hdr_v1->dcd_table;
  188. uint32_t hdr_base;
  189. uint32_t header_length = (((char *)&dcd_v1->addr_data[dcd_len].addr)
  190. - ((char *)imxhdr));
  191. /* Set magic number */
  192. fhdr_v1->app_code_barker = APP_CODE_BARKER;
  193. /* TODO: check i.MX image V1 handling, for now use 'old' style */
  194. hdr_base = entry_point - 4096;
  195. fhdr_v1->app_dest_ptr = hdr_base - flash_offset;
  196. fhdr_v1->app_code_jump_vector = entry_point;
  197. fhdr_v1->dcd_ptr_ptr = hdr_base + offsetof(flash_header_v1_t, dcd_ptr);
  198. fhdr_v1->dcd_ptr = hdr_base + offsetof(imx_header_v1_t, dcd_table);
  199. /* Security feature are not supported */
  200. fhdr_v1->app_code_csf = 0;
  201. fhdr_v1->super_root_key = 0;
  202. header_size_ptr = (uint32_t *)(((char *)imxhdr) + header_length - 4);
  203. }
  204. static void set_imx_hdr_v2(struct imx_header *imxhdr, uint32_t dcd_len,
  205. uint32_t entry_point, uint32_t flash_offset)
  206. {
  207. imx_header_v2_t *hdr_v2 = &imxhdr->header.hdr_v2;
  208. flash_header_v2_t *fhdr_v2 = &hdr_v2->fhdr;
  209. uint32_t hdr_base;
  210. /* Set magic number */
  211. fhdr_v2->header.tag = IVT_HEADER_TAG; /* 0xD1 */
  212. fhdr_v2->header.length = cpu_to_be16(sizeof(flash_header_v2_t));
  213. fhdr_v2->header.version = IVT_VERSION; /* 0x40 */
  214. fhdr_v2->entry = entry_point;
  215. fhdr_v2->reserved1 = fhdr_v2->reserved2 = 0;
  216. hdr_base = entry_point - imximage_init_loadsize +
  217. flash_offset;
  218. fhdr_v2->self = hdr_base;
  219. fhdr_v2->dcd_ptr = hdr_base + offsetof(imx_header_v2_t, dcd_table);
  220. fhdr_v2->boot_data_ptr = hdr_base
  221. + offsetof(imx_header_v2_t, boot_data);
  222. hdr_v2->boot_data.start = entry_point - imximage_init_loadsize;
  223. fhdr_v2->csf = 0;
  224. header_size_ptr = &hdr_v2->boot_data.size;
  225. csf_ptr = &fhdr_v2->csf;
  226. }
  227. static void set_hdr_func(void)
  228. {
  229. switch (imximage_version) {
  230. case IMXIMAGE_V1:
  231. set_dcd_val = set_dcd_val_v1;
  232. set_dcd_rst = set_dcd_rst_v1;
  233. set_imx_hdr = set_imx_hdr_v1;
  234. max_dcd_entries = MAX_HW_CFG_SIZE_V1;
  235. break;
  236. case IMXIMAGE_V2:
  237. set_dcd_val = set_dcd_val_v2;
  238. set_dcd_rst = set_dcd_rst_v2;
  239. set_imx_hdr = set_imx_hdr_v2;
  240. max_dcd_entries = MAX_HW_CFG_SIZE_V2;
  241. break;
  242. default:
  243. err_imximage_version(imximage_version);
  244. break;
  245. }
  246. }
  247. static void print_hdr_v1(struct imx_header *imx_hdr)
  248. {
  249. imx_header_v1_t *hdr_v1 = &imx_hdr->header.hdr_v1;
  250. flash_header_v1_t *fhdr_v1 = &hdr_v1->fhdr;
  251. dcd_v1_t *dcd_v1 = &hdr_v1->dcd_table;
  252. uint32_t size, length, ver;
  253. size = dcd_v1->preamble.length;
  254. if (size > (MAX_HW_CFG_SIZE_V1 * sizeof(dcd_type_addr_data_t))) {
  255. fprintf(stderr,
  256. "Error: Image corrupt DCD size %d exceed maximum %d\n",
  257. (uint32_t)(size / sizeof(dcd_type_addr_data_t)),
  258. MAX_HW_CFG_SIZE_V1);
  259. exit(EXIT_FAILURE);
  260. }
  261. length = dcd_v1->preamble.length / sizeof(dcd_type_addr_data_t);
  262. ver = detect_imximage_version(imx_hdr);
  263. printf("Image Type: Freescale IMX Boot Image\n");
  264. printf("Image Ver: %x", ver);
  265. printf("%s\n", get_table_entry_name(imximage_versions, NULL, ver));
  266. printf("Data Size: ");
  267. genimg_print_size(dcd_v1->addr_data[length].type);
  268. printf("Load Address: %08x\n", (uint32_t)fhdr_v1->app_dest_ptr);
  269. printf("Entry Point: %08x\n", (uint32_t)fhdr_v1->app_code_jump_vector);
  270. }
  271. static void print_hdr_v2(struct imx_header *imx_hdr)
  272. {
  273. imx_header_v2_t *hdr_v2 = &imx_hdr->header.hdr_v2;
  274. flash_header_v2_t *fhdr_v2 = &hdr_v2->fhdr;
  275. dcd_v2_t *dcd_v2 = &hdr_v2->dcd_table;
  276. uint32_t size, version;
  277. size = be16_to_cpu(dcd_v2->header.length) - 8;
  278. if (size > (MAX_HW_CFG_SIZE_V2 * sizeof(dcd_addr_data_t))) {
  279. fprintf(stderr,
  280. "Error: Image corrupt DCD size %d exceed maximum %d\n",
  281. (uint32_t)(size / sizeof(dcd_addr_data_t)),
  282. MAX_HW_CFG_SIZE_V2);
  283. exit(EXIT_FAILURE);
  284. }
  285. version = detect_imximage_version(imx_hdr);
  286. printf("Image Type: Freescale IMX Boot Image\n");
  287. printf("Image Ver: %x", version);
  288. printf("%s\n", get_table_entry_name(imximage_versions, NULL, version));
  289. printf("Data Size: ");
  290. genimg_print_size(hdr_v2->boot_data.size);
  291. printf("Load Address: %08x\n", (uint32_t)fhdr_v2->boot_data_ptr);
  292. printf("Entry Point: %08x\n", (uint32_t)fhdr_v2->entry);
  293. if (fhdr_v2->csf && (imximage_ivt_offset != UNDEFINED) &&
  294. (imximage_csf_size != UNDEFINED)) {
  295. printf("HAB Blocks: %08x %08x %08x\n",
  296. (uint32_t)fhdr_v2->self, 0,
  297. hdr_v2->boot_data.size - imximage_ivt_offset -
  298. imximage_csf_size);
  299. }
  300. }
  301. static void parse_cfg_cmd(struct imx_header *imxhdr, int32_t cmd, char *token,
  302. char *name, int lineno, int fld, int dcd_len)
  303. {
  304. int value;
  305. static int cmd_ver_first = ~0;
  306. switch (cmd) {
  307. case CMD_IMAGE_VERSION:
  308. imximage_version = get_cfg_value(token, name, lineno);
  309. if (cmd_ver_first == 0) {
  310. fprintf(stderr, "Error: %s[%d] - IMAGE_VERSION "
  311. "command need be the first before other "
  312. "valid command in the file\n", name, lineno);
  313. exit(EXIT_FAILURE);
  314. }
  315. cmd_ver_first = 1;
  316. set_hdr_func();
  317. break;
  318. case CMD_BOOT_FROM:
  319. imximage_ivt_offset = get_table_entry_id(imximage_boot_offset,
  320. "imximage boot option", token);
  321. if (imximage_ivt_offset == -1) {
  322. fprintf(stderr, "Error: %s[%d] -Invalid boot device"
  323. "(%s)\n", name, lineno, token);
  324. exit(EXIT_FAILURE);
  325. }
  326. imximage_init_loadsize =
  327. get_table_entry_id(imximage_boot_loadsize,
  328. "imximage boot option", token);
  329. if (imximage_init_loadsize == -1) {
  330. fprintf(stderr,
  331. "Error: %s[%d] -Invalid boot device(%s)\n",
  332. name, lineno, token);
  333. exit(EXIT_FAILURE);
  334. }
  335. /*
  336. * The SOC loads from the storage starting at address 0
  337. * then ensures that the load size contains the offset
  338. */
  339. if (imximage_init_loadsize < imximage_ivt_offset)
  340. imximage_init_loadsize = imximage_ivt_offset;
  341. if (unlikely(cmd_ver_first != 1))
  342. cmd_ver_first = 0;
  343. break;
  344. case CMD_BOOT_OFFSET:
  345. imximage_ivt_offset = get_cfg_value(token, name, lineno);
  346. if (unlikely(cmd_ver_first != 1))
  347. cmd_ver_first = 0;
  348. break;
  349. case CMD_DATA:
  350. value = get_cfg_value(token, name, lineno);
  351. (*set_dcd_val)(imxhdr, name, lineno, fld, value, dcd_len);
  352. if (unlikely(cmd_ver_first != 1))
  353. cmd_ver_first = 0;
  354. break;
  355. case CMD_CSF:
  356. if (imximage_version != 2) {
  357. fprintf(stderr,
  358. "Error: %s[%d] - CSF only supported for VERSION 2(%s)\n",
  359. name, lineno, token);
  360. exit(EXIT_FAILURE);
  361. }
  362. imximage_csf_size = get_cfg_value(token, name, lineno);
  363. if (unlikely(cmd_ver_first != 1))
  364. cmd_ver_first = 0;
  365. break;
  366. }
  367. }
  368. static void parse_cfg_fld(struct imx_header *imxhdr, int32_t *cmd,
  369. char *token, char *name, int lineno, int fld, int *dcd_len)
  370. {
  371. int value;
  372. switch (fld) {
  373. case CFG_COMMAND:
  374. *cmd = get_table_entry_id(imximage_cmds,
  375. "imximage commands", token);
  376. if (*cmd < 0) {
  377. fprintf(stderr, "Error: %s[%d] - Invalid command"
  378. "(%s)\n", name, lineno, token);
  379. exit(EXIT_FAILURE);
  380. }
  381. break;
  382. case CFG_REG_SIZE:
  383. parse_cfg_cmd(imxhdr, *cmd, token, name, lineno, fld, *dcd_len);
  384. break;
  385. case CFG_REG_ADDRESS:
  386. case CFG_REG_VALUE:
  387. if (*cmd != CMD_DATA)
  388. return;
  389. value = get_cfg_value(token, name, lineno);
  390. (*set_dcd_val)(imxhdr, name, lineno, fld, value, *dcd_len);
  391. if (fld == CFG_REG_VALUE) {
  392. (*dcd_len)++;
  393. if (*dcd_len > max_dcd_entries) {
  394. fprintf(stderr, "Error: %s[%d] -"
  395. "DCD table exceeds maximum size(%d)\n",
  396. name, lineno, max_dcd_entries);
  397. exit(EXIT_FAILURE);
  398. }
  399. }
  400. break;
  401. default:
  402. break;
  403. }
  404. }
  405. static uint32_t parse_cfg_file(struct imx_header *imxhdr, char *name)
  406. {
  407. FILE *fd = NULL;
  408. char *line = NULL;
  409. char *token, *saveptr1, *saveptr2;
  410. int lineno = 0;
  411. int fld;
  412. size_t len;
  413. int dcd_len = 0;
  414. int32_t cmd;
  415. fd = fopen(name, "r");
  416. if (fd == 0) {
  417. fprintf(stderr, "Error: %s - Can't open DCD file\n", name);
  418. exit(EXIT_FAILURE);
  419. }
  420. /*
  421. * Very simple parsing, line starting with # are comments
  422. * and are dropped
  423. */
  424. while ((getline(&line, &len, fd)) > 0) {
  425. lineno++;
  426. token = strtok_r(line, "\r\n", &saveptr1);
  427. if (token == NULL)
  428. continue;
  429. /* Check inside the single line */
  430. for (fld = CFG_COMMAND, cmd = CMD_INVALID,
  431. line = token; ; line = NULL, fld++) {
  432. token = strtok_r(line, " \t", &saveptr2);
  433. if (token == NULL)
  434. break;
  435. /* Drop all text starting with '#' as comments */
  436. if (token[0] == '#')
  437. break;
  438. parse_cfg_fld(imxhdr, &cmd, token, name,
  439. lineno, fld, &dcd_len);
  440. }
  441. }
  442. (*set_dcd_rst)(imxhdr, dcd_len, name, lineno);
  443. fclose(fd);
  444. /* Exit if there is no BOOT_FROM field specifying the flash_offset */
  445. if (imximage_ivt_offset == FLASH_OFFSET_UNDEFINED) {
  446. fprintf(stderr, "Error: No BOOT_FROM tag in %s\n", name);
  447. exit(EXIT_FAILURE);
  448. }
  449. return dcd_len;
  450. }
  451. static int imximage_check_image_types(uint8_t type)
  452. {
  453. if (type == IH_TYPE_IMXIMAGE)
  454. return EXIT_SUCCESS;
  455. else
  456. return EXIT_FAILURE;
  457. }
  458. static int imximage_verify_header(unsigned char *ptr, int image_size,
  459. struct image_tool_params *params)
  460. {
  461. struct imx_header *imx_hdr = (struct imx_header *) ptr;
  462. if (detect_imximage_version(imx_hdr) == IMXIMAGE_VER_INVALID)
  463. return -FDT_ERR_BADSTRUCTURE;
  464. return 0;
  465. }
  466. static void imximage_print_header(const void *ptr)
  467. {
  468. struct imx_header *imx_hdr = (struct imx_header *) ptr;
  469. uint32_t version = detect_imximage_version(imx_hdr);
  470. switch (version) {
  471. case IMXIMAGE_V1:
  472. print_hdr_v1(imx_hdr);
  473. break;
  474. case IMXIMAGE_V2:
  475. print_hdr_v2(imx_hdr);
  476. break;
  477. default:
  478. err_imximage_version(version);
  479. break;
  480. }
  481. }
  482. static void imximage_set_header(void *ptr, struct stat *sbuf, int ifd,
  483. struct image_tool_params *params)
  484. {
  485. struct imx_header *imxhdr = (struct imx_header *)ptr;
  486. uint32_t dcd_len;
  487. /*
  488. * In order to not change the old imx cfg file
  489. * by adding VERSION command into it, here need
  490. * set up function ptr group to V1 by default.
  491. */
  492. imximage_version = IMXIMAGE_V1;
  493. /* Be able to detect if the cfg file has no BOOT_FROM tag */
  494. imximage_ivt_offset = FLASH_OFFSET_UNDEFINED;
  495. imximage_csf_size = 0;
  496. set_hdr_func();
  497. /* Parse dcd configuration file */
  498. dcd_len = parse_cfg_file(imxhdr, params->imagename);
  499. if (imximage_version == IMXIMAGE_V2) {
  500. if (imximage_init_loadsize < imximage_ivt_offset +
  501. sizeof(imx_header_v2_t))
  502. imximage_init_loadsize = imximage_ivt_offset +
  503. sizeof(imx_header_v2_t);
  504. }
  505. /* Set the imx header */
  506. (*set_imx_hdr)(imxhdr, dcd_len, params->ep, imximage_ivt_offset);
  507. /*
  508. * ROM bug alert
  509. *
  510. * MX53 only loads 512 byte multiples in case of SD boot.
  511. * MX53 only loads NAND page multiples in case of NAND boot and
  512. * supports up to 4096 byte large pages, thus align to 4096.
  513. *
  514. * The remaining fraction of a block bytes would not be loaded!
  515. */
  516. *header_size_ptr = ROUND((sbuf->st_size + imximage_ivt_offset), 4096);
  517. if (csf_ptr && imximage_csf_size) {
  518. *csf_ptr = params->ep - imximage_init_loadsize +
  519. *header_size_ptr;
  520. *header_size_ptr += imximage_csf_size;
  521. }
  522. }
  523. int imximage_check_params(struct image_tool_params *params)
  524. {
  525. if (!params)
  526. return CFG_INVALID;
  527. if (!strlen(params->imagename)) {
  528. fprintf(stderr, "Error: %s - Configuration file not specified, "
  529. "it is needed for imximage generation\n",
  530. params->cmdname);
  531. return CFG_INVALID;
  532. }
  533. /*
  534. * Check parameters:
  535. * XIP is not allowed and verify that incompatible
  536. * parameters are not sent at the same time
  537. * For example, if list is required a data image must not be provided
  538. */
  539. return (params->dflag && (params->fflag || params->lflag)) ||
  540. (params->fflag && (params->dflag || params->lflag)) ||
  541. (params->lflag && (params->dflag || params->fflag)) ||
  542. (params->xflag) || !(strlen(params->imagename));
  543. }
  544. static int imximage_generate(struct image_tool_params *params,
  545. struct image_type_params *tparams)
  546. {
  547. struct imx_header *imxhdr;
  548. size_t alloc_len;
  549. struct stat sbuf;
  550. char *datafile = params->datafile;
  551. uint32_t pad_len;
  552. memset(&imximage_header, 0, sizeof(imximage_header));
  553. /*
  554. * In order to not change the old imx cfg file
  555. * by adding VERSION command into it, here need
  556. * set up function ptr group to V1 by default.
  557. */
  558. imximage_version = IMXIMAGE_V1;
  559. /* Be able to detect if the cfg file has no BOOT_FROM tag */
  560. imximage_ivt_offset = FLASH_OFFSET_UNDEFINED;
  561. imximage_csf_size = 0;
  562. set_hdr_func();
  563. /* Parse dcd configuration file */
  564. parse_cfg_file(&imximage_header, params->imagename);
  565. /* TODO: check i.MX image V1 handling, for now use 'old' style */
  566. if (imximage_version == IMXIMAGE_V1) {
  567. alloc_len = 4096;
  568. } else {
  569. if (imximage_init_loadsize < imximage_ivt_offset +
  570. sizeof(imx_header_v2_t))
  571. imximage_init_loadsize = imximage_ivt_offset +
  572. sizeof(imx_header_v2_t);
  573. alloc_len = imximage_init_loadsize - imximage_ivt_offset;
  574. }
  575. if (alloc_len < sizeof(struct imx_header)) {
  576. fprintf(stderr, "%s: header error\n",
  577. params->cmdname);
  578. exit(EXIT_FAILURE);
  579. }
  580. imxhdr = malloc(alloc_len);
  581. if (!imxhdr) {
  582. fprintf(stderr, "%s: malloc return failure: %s\n",
  583. params->cmdname, strerror(errno));
  584. exit(EXIT_FAILURE);
  585. }
  586. memset(imxhdr, 0, alloc_len);
  587. tparams->header_size = alloc_len;
  588. tparams->hdr = imxhdr;
  589. /* determine data image file length */
  590. if (stat(datafile, &sbuf) < 0) {
  591. fprintf(stderr, "%s: Can't stat %s: %s\n",
  592. params->cmdname, datafile, strerror(errno));
  593. exit(EXIT_FAILURE);
  594. }
  595. pad_len = ROUND(sbuf.st_size, 4096) - sbuf.st_size;
  596. /* TODO: check i.MX image V1 handling, for now use 'old' style */
  597. if (imximage_version == IMXIMAGE_V1)
  598. return 0;
  599. else
  600. return pad_len;
  601. }
  602. /*
  603. * imximage parameters
  604. */
  605. U_BOOT_IMAGE_TYPE(
  606. imximage,
  607. "Freescale i.MX Boot Image support",
  608. 0,
  609. NULL,
  610. imximage_check_params,
  611. imximage_verify_header,
  612. imximage_print_header,
  613. imximage_set_header,
  614. NULL,
  615. imximage_check_image_types,
  616. NULL,
  617. imximage_generate
  618. );