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