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