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