Blame view

tools/fit_image.c 20.1 KB
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
1
2
3
4
5
6
7
8
9
10
11
12
13
  /*
   * (C) Copyright 2008 Semihalf
   *
   * (C) Copyright 2000-2004
   * DENX Software Engineering
   * Wolfgang Denk, wd@denx.de
   *
   * Updated-by: Prafulla Wadaskar <prafulla@marvell.com>
   *		FIT image specific code abstracted from mkimage.c
   *		some functions added to address abstraction
   *
   * All rights reserved.
   *
1a4596601   Wolfgang Denk   Add GPL-2.0+ SPDX...
14
   * SPDX-License-Identifier:	GPL-2.0+
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
15
   */
f86ed6a8d   Guilherme Maciel Ferreira   tools: moved code...
16
  #include "imagetool.h"
6bf4ca076   Heiko Schocher   tools, fit: add f...
17
  #include "fit_common.h"
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
18
19
  #include "mkimage.h"
  #include <image.h>
8e35bb07e   Simon Glass   mkimage: Support ...
20
21
  #include <stdarg.h>
  #include <version.h>
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
22
23
24
  #include <u-boot/crc.h>
  
  static image_header_t header;
a94681156   Simon Glass   mkimage: Automati...
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
  static int fit_add_file_data(struct image_tool_params *params, size_t size_inc,
  			     const char *tmpfile)
  {
  	int tfd, destfd = 0;
  	void *dest_blob = NULL;
  	off_t destfd_size = 0;
  	struct stat sbuf;
  	void *ptr;
  	int ret = 0;
  
  	tfd = mmap_fdt(params->cmdname, tmpfile, size_inc, &ptr, &sbuf, true);
  	if (tfd < 0)
  		return -EIO;
  
  	if (params->keydest) {
  		struct stat dest_sbuf;
  
  		destfd = mmap_fdt(params->cmdname, params->keydest, size_inc,
  				  &dest_blob, &dest_sbuf, false);
  		if (destfd < 0) {
  			ret = -EIO;
  			goto err_keydest;
  		}
  		destfd_size = dest_sbuf.st_size;
  	}
  
  	/* for first image creation, add a timestamp at offset 0 i.e., root  */
5847084f6   Vagrant Cascadian   Respect SOURCE_DA...
52
53
54
55
  	if (params->datafile) {
  		time_t time = imagetool_get_source_date(params, sbuf.st_mtime);
  		ret = fit_set_timestamp(ptr, 0, time);
  	}
a94681156   Simon Glass   mkimage: Automati...
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
  
  	if (!ret) {
  		ret = fit_add_verification_data(params->keydir, dest_blob, ptr,
  						params->comment,
  						params->require_keys);
  	}
  
  	if (dest_blob) {
  		munmap(dest_blob, destfd_size);
  		close(destfd);
  	}
  
  err_keydest:
  	munmap(ptr, sbuf.st_size);
  	close(tfd);
  
  	return ret;
  }
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
74
  /**
8e35bb07e   Simon Glass   mkimage: Support ...
75
76
77
78
   * fit_calc_size() - Calculate the approximate size of the FIT we will generate
   */
  static int fit_calc_size(struct image_tool_params *params)
  {
fb4cce0f9   Simon Glass   mkimage: Support ...
79
  	struct content_info *cont;
8e35bb07e   Simon Glass   mkimage: Support ...
80
81
82
83
84
  	int size, total_size;
  
  	size = imagetool_get_filesize(params, params->datafile);
  	if (size < 0)
  		return -1;
8e35bb07e   Simon Glass   mkimage: Support ...
85
  	total_size = size;
0f7c6cdc8   Tomeu Vizoso   mkimage: Allow in...
86
87
88
89
90
91
92
  
  	if (params->fit_ramdisk) {
  		size = imagetool_get_filesize(params, params->fit_ramdisk);
  		if (size < 0)
  			return -1;
  		total_size += size;
  	}
fb4cce0f9   Simon Glass   mkimage: Support ...
93
94
95
96
  	for (cont = params->content_head; cont; cont = cont->next) {
  		size = imagetool_get_filesize(params, cont->fname);
  		if (size < 0)
  			return -1;
8e35bb07e   Simon Glass   mkimage: Support ...
97

fb4cce0f9   Simon Glass   mkimage: Support ...
98
99
100
  		/* Add space for properties */
  		total_size += size + 300;
  	}
8e35bb07e   Simon Glass   mkimage: Support ...
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
  
  	/* Add plenty of space for headers, properties, nodes, etc. */
  	total_size += 4096;
  
  	return total_size;
  }
  
  static int fdt_property_file(struct image_tool_params *params,
  			     void *fdt, const char *name, const char *fname)
  {
  	struct stat sbuf;
  	void *ptr;
  	int ret;
  	int fd;
  
  	fd = open(fname, O_RDWR | O_BINARY);
  	if (fd < 0) {
  		fprintf(stderr, "%s: Can't open %s: %s
  ",
  			params->cmdname, fname, strerror(errno));
  		return -1;
  	}
  
  	if (fstat(fd, &sbuf) < 0) {
  		fprintf(stderr, "%s: Can't stat %s: %s
  ",
  			params->cmdname, fname, strerror(errno));
  		goto err;
  	}
  
  	ret = fdt_property_placeholder(fdt, "data", sbuf.st_size, &ptr);
  	if (ret)
3bd3a54ac   Simon Glass   mkimage: Ensure f...
133
  		goto err;
8e35bb07e   Simon Glass   mkimage: Support ...
134
135
136
137
138
139
140
  	ret = read(fd, ptr, sbuf.st_size);
  	if (ret != sbuf.st_size) {
  		fprintf(stderr, "%s: Can't read %s: %s
  ",
  			params->cmdname, fname, strerror(errno));
  		goto err;
  	}
3bd3a54ac   Simon Glass   mkimage: Ensure f...
141
  	close(fd);
8e35bb07e   Simon Glass   mkimage: Support ...
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
  
  	return 0;
  err:
  	close(fd);
  	return -1;
  }
  
  static int fdt_property_strf(void *fdt, const char *name, const char *fmt, ...)
  {
  	char str[100];
  	va_list ptr;
  
  	va_start(ptr, fmt);
  	vsnprintf(str, sizeof(str), fmt, ptr);
  	va_end(ptr);
  	return fdt_property_string(fdt, name, str);
  }
fb4cce0f9   Simon Glass   mkimage: Support ...
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
  static void get_basename(char *str, int size, const char *fname)
  {
  	const char *p, *start, *end;
  	int len;
  
  	/*
  	 * Use the base name as the 'name' field. So for example:
  	 *
  	 * "arch/arm/dts/sun7i-a20-bananapro.dtb"
  	 * becomes "sun7i-a20-bananapro"
  	 */
  	p = strrchr(fname, '/');
  	start = p ? p + 1 : fname;
  	p = strrchr(fname, '.');
  	end = p ? p : fname + strlen(fname);
  	len = end - start;
  	if (len >= size)
  		len = size - 1;
  	memcpy(str, start, len);
  	str[len] = '\0';
  }
8e35bb07e   Simon Glass   mkimage: Support ...
180
181
182
  /**
   * fit_write_images() - Write out a list of images to the FIT
   *
fb4cce0f9   Simon Glass   mkimage: Support ...
183
184
   * We always include the main image (params->datafile). If there are device
   * tree files, we include an fdt@ node for each of those too.
8e35bb07e   Simon Glass   mkimage: Support ...
185
186
187
   */
  static int fit_write_images(struct image_tool_params *params, char *fdt)
  {
fb4cce0f9   Simon Glass   mkimage: Support ...
188
  	struct content_info *cont;
8e35bb07e   Simon Glass   mkimage: Support ...
189
190
  	const char *typename;
  	char str[100];
fb4cce0f9   Simon Glass   mkimage: Support ...
191
  	int upto;
8e35bb07e   Simon Glass   mkimage: Support ...
192
193
194
195
196
197
198
199
200
201
  	int ret;
  
  	fdt_begin_node(fdt, "images");
  
  	/* First the main image */
  	typename = genimg_get_type_short_name(params->fit_image_type);
  	snprintf(str, sizeof(str), "%s@1", typename);
  	fdt_begin_node(fdt, str);
  	fdt_property_string(fdt, "description", params->imagename);
  	fdt_property_string(fdt, "type", typename);
3a45f38d4   Simon Glass   image: Correct au...
202
203
  	fdt_property_string(fdt, "arch",
  			    genimg_get_arch_short_name(params->arch));
8e35bb07e   Simon Glass   mkimage: Support ...
204
205
206
207
208
209
210
211
212
213
214
215
216
217
  	fdt_property_string(fdt, "os", genimg_get_os_short_name(params->os));
  	fdt_property_string(fdt, "compression",
  			    genimg_get_comp_short_name(params->comp));
  	fdt_property_u32(fdt, "load", params->addr);
  	fdt_property_u32(fdt, "entry", params->ep);
  
  	/*
  	 * Put data last since it is large. SPL may only load the first part
  	 * of the DT, so this way it can access all the above fields.
  	 */
  	ret = fdt_property_file(params, fdt, "data", params->datafile);
  	if (ret)
  		return ret;
  	fdt_end_node(fdt);
fb4cce0f9   Simon Glass   mkimage: Support ...
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
  	/* Now the device tree files if available */
  	upto = 0;
  	for (cont = params->content_head; cont; cont = cont->next) {
  		if (cont->type != IH_TYPE_FLATDT)
  			continue;
  		snprintf(str, sizeof(str), "%s@%d", FIT_FDT_PROP, ++upto);
  		fdt_begin_node(fdt, str);
  
  		get_basename(str, sizeof(str), cont->fname);
  		fdt_property_string(fdt, "description", str);
  		ret = fdt_property_file(params, fdt, "data", cont->fname);
  		if (ret)
  			return ret;
  		fdt_property_string(fdt, "type", typename);
  		fdt_property_string(fdt, "arch",
  				    genimg_get_arch_short_name(params->arch));
  		fdt_property_string(fdt, "compression",
  				    genimg_get_comp_short_name(IH_COMP_NONE));
  		fdt_end_node(fdt);
  	}
0f7c6cdc8   Tomeu Vizoso   mkimage: Allow in...
238
239
240
241
242
243
244
245
246
247
248
249
250
  	/* And a ramdisk file if available */
  	if (params->fit_ramdisk) {
  		fdt_begin_node(fdt, FIT_RAMDISK_PROP "@1");
  
  		fdt_property_string(fdt, "type", FIT_RAMDISK_PROP);
  		fdt_property_string(fdt, "os", genimg_get_os_short_name(params->os));
  
  		ret = fdt_property_file(params, fdt, "data", params->fit_ramdisk);
  		if (ret)
  			return ret;
  
  		fdt_end_node(fdt);
  	}
8e35bb07e   Simon Glass   mkimage: Support ...
251
252
253
254
255
256
257
258
  	fdt_end_node(fdt);
  
  	return 0;
  }
  
  /**
   * fit_write_configs() - Write out a list of configurations to the FIT
   *
fb4cce0f9   Simon Glass   mkimage: Support ...
259
260
261
262
263
   * If there are device tree files, we include a configuration for each, which
   * selects the main image (params->datafile) and its corresponding device
   * tree file.
   *
   * Otherwise we just create a configuration with the main image in it.
8e35bb07e   Simon Glass   mkimage: Support ...
264
265
266
   */
  static void fit_write_configs(struct image_tool_params *params, char *fdt)
  {
fb4cce0f9   Simon Glass   mkimage: Support ...
267
  	struct content_info *cont;
8e35bb07e   Simon Glass   mkimage: Support ...
268
269
  	const char *typename;
  	char str[100];
fb4cce0f9   Simon Glass   mkimage: Support ...
270
  	int upto;
8e35bb07e   Simon Glass   mkimage: Support ...
271
272
273
  
  	fdt_begin_node(fdt, "configurations");
  	fdt_property_string(fdt, "default", "conf@1");
fb4cce0f9   Simon Glass   mkimage: Support ...
274
275
276
277
278
279
280
281
282
283
284
285
286
287
  	upto = 0;
  	for (cont = params->content_head; cont; cont = cont->next) {
  		if (cont->type != IH_TYPE_FLATDT)
  			continue;
  		typename = genimg_get_type_short_name(cont->type);
  		snprintf(str, sizeof(str), "conf@%d", ++upto);
  		fdt_begin_node(fdt, str);
  
  		get_basename(str, sizeof(str), cont->fname);
  		fdt_property_string(fdt, "description", str);
  
  		typename = genimg_get_type_short_name(params->fit_image_type);
  		snprintf(str, sizeof(str), "%s@1", typename);
  		fdt_property_string(fdt, typename, str);
0f7c6cdc8   Tomeu Vizoso   mkimage: Allow in...
288
289
290
  		if (params->fit_ramdisk)
  			fdt_property_string(fdt, FIT_RAMDISK_PROP,
  					    FIT_RAMDISK_PROP "@1");
fb4cce0f9   Simon Glass   mkimage: Support ...
291
292
293
294
  		snprintf(str, sizeof(str), FIT_FDT_PROP "@%d", upto);
  		fdt_property_string(fdt, FIT_FDT_PROP, str);
  		fdt_end_node(fdt);
  	}
0f7c6cdc8   Tomeu Vizoso   mkimage: Allow in...
295

fb4cce0f9   Simon Glass   mkimage: Support ...
296
297
298
299
300
  	if (!upto) {
  		fdt_begin_node(fdt, "conf@1");
  		typename = genimg_get_type_short_name(params->fit_image_type);
  		snprintf(str, sizeof(str), "%s@1", typename);
  		fdt_property_string(fdt, typename, str);
0f7c6cdc8   Tomeu Vizoso   mkimage: Allow in...
301
302
303
304
  
  		if (params->fit_ramdisk)
  			fdt_property_string(fdt, FIT_RAMDISK_PROP,
  					    FIT_RAMDISK_PROP "@1");
fb4cce0f9   Simon Glass   mkimage: Support ...
305
306
  		fdt_end_node(fdt);
  	}
8e35bb07e   Simon Glass   mkimage: Support ...
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
  
  	fdt_end_node(fdt);
  }
  
  static int fit_build_fdt(struct image_tool_params *params, char *fdt, int size)
  {
  	int ret;
  
  	ret = fdt_create(fdt, size);
  	if (ret)
  		return ret;
  	fdt_finish_reservemap(fdt);
  	fdt_begin_node(fdt, "");
  	fdt_property_strf(fdt, "description",
  			  "%s image with one or more FDT blobs",
  			  genimg_get_type_name(params->fit_image_type));
  	fdt_property_strf(fdt, "creator", "U-Boot mkimage %s", PLAIN_VERSION);
  	fdt_property_u32(fdt, "#address-cells", 1);
  	ret = fit_write_images(params, fdt);
  	if (ret)
  		return ret;
  	fit_write_configs(params, fdt);
  	fdt_end_node(fdt);
  	ret = fdt_finish(fdt);
  	if (ret)
  		return ret;
  
  	return fdt_totalsize(fdt);
  }
  
  static int fit_build(struct image_tool_params *params, const char *fname)
  {
  	char *buf;
  	int size;
  	int ret;
  	int fd;
  
  	size = fit_calc_size(params);
  	if (size < 0)
  		return -1;
  	buf = malloc(size);
  	if (!buf) {
  		fprintf(stderr, "%s: Out of memory (%d bytes)
  ",
  			params->cmdname, size);
  		return -1;
  	}
  	ret = fit_build_fdt(params, buf, size);
  	if (ret < 0) {
  		fprintf(stderr, "%s: Failed to build FIT image
  ",
  			params->cmdname);
7b0bbd886   Simon Glass   mkimage: Fix miss...
359
  		goto err_buf;
8e35bb07e   Simon Glass   mkimage: Support ...
360
361
362
363
364
365
366
367
368
369
370
371
372
373
  	}
  	size = ret;
  	fd = open(fname, O_RDWR | O_CREAT | O_TRUNC | O_BINARY, 0666);
  	if (fd < 0) {
  		fprintf(stderr, "%s: Can't open %s: %s
  ",
  			params->cmdname, fname, strerror(errno));
  		goto err;
  	}
  	ret = write(fd, buf, size);
  	if (ret != size) {
  		fprintf(stderr, "%s: Can't write %s: %s
  ",
  			params->cmdname, fname, strerror(errno));
8e35bb07e   Simon Glass   mkimage: Support ...
374
375
376
  		goto err;
  	}
  	close(fd);
7b0bbd886   Simon Glass   mkimage: Fix miss...
377
  	free(buf);
8e35bb07e   Simon Glass   mkimage: Support ...
378
379
380
  
  	return 0;
  err:
7b0bbd886   Simon Glass   mkimage: Fix miss...
381
382
  	close(fd);
  err_buf:
8e35bb07e   Simon Glass   mkimage: Support ...
383
384
385
386
387
  	free(buf);
  	return -1;
  }
  
  /**
722ebc8f8   Simon Glass   mkimage: Support ...
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
   * fit_extract_data() - Move all data outside the FIT
   *
   * This takes a normal FIT file and removes all the 'data' properties from it.
   * The data is placed in an area after the FIT so that it can be accessed
   * using an offset into that area. The 'data' properties turn into
   * 'data-offset' properties.
   *
   * This function cannot cope with FITs with 'data-offset' properties. All
   * data must be in 'data' properties on entry.
   */
  static int fit_extract_data(struct image_tool_params *params, const char *fname)
  {
  	void *buf;
  	int buf_ptr;
  	int fit_size, new_size;
  	int fd;
  	struct stat sbuf;
  	void *fdt;
  	int ret;
  	int images;
  	int node;
  
  	fd = mmap_fdt(params->cmdname, fname, 0, &fdt, &sbuf, false);
  	if (fd < 0)
  		return -EIO;
  	fit_size = fdt_totalsize(fdt);
  
  	/* Allocate space to hold the image data we will extract */
  	buf = malloc(fit_size);
  	if (!buf) {
  		ret = -ENOMEM;
b97d71e26   Simon Glass   mkimage: Fix erro...
419
  		goto err_munmap;
722ebc8f8   Simon Glass   mkimage: Support ...
420
421
422
423
424
425
426
427
  	}
  	buf_ptr = 0;
  
  	images = fdt_path_offset(fdt, FIT_IMAGES_PATH);
  	if (images < 0) {
  		debug("%s: Cannot find /images node: %d
  ", __func__, images);
  		ret = -EINVAL;
b97d71e26   Simon Glass   mkimage: Fix erro...
428
  		goto err_munmap;
722ebc8f8   Simon Glass   mkimage: Support ...
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
  	}
  
  	for (node = fdt_first_subnode(fdt, images);
  	     node >= 0;
  	     node = fdt_next_subnode(fdt, node)) {
  		const char *data;
  		int len;
  
  		data = fdt_getprop(fdt, node, "data", &len);
  		if (!data)
  			continue;
  		memcpy(buf + buf_ptr, data, len);
  		debug("Extracting data size %x
  ", len);
  
  		ret = fdt_delprop(fdt, node, "data");
  		if (ret) {
  			ret = -EPERM;
b97d71e26   Simon Glass   mkimage: Fix erro...
447
  			goto err_munmap;
722ebc8f8   Simon Glass   mkimage: Support ...
448
  		}
f8f9107d9   Teddy Reed   mkimage: fit: spl...
449
450
451
452
453
454
455
  		if (params->external_offset > 0) {
  			/* An external offset positions the data absolutely. */
  			fdt_setprop_u32(fdt, node, "data-position",
  					params->external_offset + buf_ptr);
  		} else {
  			fdt_setprop_u32(fdt, node, "data-offset", buf_ptr);
  		}
722ebc8f8   Simon Glass   mkimage: Support ...
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
  		fdt_setprop_u32(fdt, node, "data-size", len);
  
  		buf_ptr += (len + 3) & ~3;
  	}
  
  	/* Pack the FDT and place the data after it */
  	fdt_pack(fdt);
  
  	debug("Size reduced from %x to %x
  ", fit_size, fdt_totalsize(fdt));
  	debug("External data size %x
  ", buf_ptr);
  	new_size = fdt_totalsize(fdt);
  	new_size = (new_size + 3) & ~3;
  	munmap(fdt, sbuf.st_size);
  
  	if (ftruncate(fd, new_size)) {
  		debug("%s: Failed to truncate file: %s
  ", __func__,
  		      strerror(errno));
  		ret = -EIO;
  		goto err;
  	}
f8f9107d9   Teddy Reed   mkimage: fit: spl...
479
480
481
482
483
484
485
486
487
488
489
  
  	/* Check if an offset for the external data was set. */
  	if (params->external_offset > 0) {
  		if (params->external_offset < new_size) {
  			debug("External offset %x overlaps FIT length %x",
  			      params->external_offset, new_size);
  			ret = -EINVAL;
  			goto err;
  		}
  		new_size = params->external_offset;
  	}
722ebc8f8   Simon Glass   mkimage: Support ...
490
491
492
493
494
495
496
497
498
499
500
501
502
503
  	if (lseek(fd, new_size, SEEK_SET) < 0) {
  		debug("%s: Failed to seek to end of file: %s
  ", __func__,
  		      strerror(errno));
  		ret = -EIO;
  		goto err;
  	}
  	if (write(fd, buf, buf_ptr) != buf_ptr) {
  		debug("%s: Failed to write external data to file %s
  ",
  		      __func__, strerror(errno));
  		ret = -EIO;
  		goto err;
  	}
b97d71e26   Simon Glass   mkimage: Fix erro...
504
505
  	close(fd);
  	return 0;
722ebc8f8   Simon Glass   mkimage: Support ...
506

b97d71e26   Simon Glass   mkimage: Fix erro...
507
508
  err_munmap:
  	munmap(fdt, sbuf.st_size);
722ebc8f8   Simon Glass   mkimage: Support ...
509
  err:
21c2975a9   Simon Glass   mkimage: Fix miss...
510
511
  	if (buf)
  		free(buf);
722ebc8f8   Simon Glass   mkimage: Support ...
512
513
514
  	close(fd);
  	return ret;
  }
529fd1886   Simon Glass   mkimage: Bring da...
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
  static int fit_import_data(struct image_tool_params *params, const char *fname)
  {
  	void *fdt, *old_fdt;
  	int fit_size, new_size, size, data_base;
  	int fd;
  	struct stat sbuf;
  	int ret;
  	int images;
  	int node;
  
  	fd = mmap_fdt(params->cmdname, fname, 0, &old_fdt, &sbuf, false);
  	if (fd < 0)
  		return -EIO;
  	fit_size = fdt_totalsize(old_fdt);
  	data_base = (fit_size + 3) & ~3;
  
  	/* Allocate space to hold the new FIT */
  	size = sbuf.st_size + 16384;
  	fdt = malloc(size);
  	if (!fdt) {
  		fprintf(stderr, "%s: Failed to allocate memory (%d bytes)
  ",
  			__func__, size);
  		ret = -ENOMEM;
  		goto err;
  	}
  	ret = fdt_open_into(old_fdt, fdt, size);
  	if (ret) {
  		debug("%s: Failed to expand FIT: %s
  ", __func__,
  		      fdt_strerror(errno));
  		ret = -EINVAL;
  		goto err;
  	}
  
  	images = fdt_path_offset(fdt, FIT_IMAGES_PATH);
  	if (images < 0) {
  		debug("%s: Cannot find /images node: %d
  ", __func__, images);
  		ret = -EINVAL;
  		goto err;
  	}
  
  	for (node = fdt_first_subnode(fdt, images);
  	     node >= 0;
  	     node = fdt_next_subnode(fdt, node)) {
  		int buf_ptr;
  		int len;
  
  		buf_ptr = fdtdec_get_int(fdt, node, "data-offset", -1);
  		len = fdtdec_get_int(fdt, node, "data-size", -1);
  		if (buf_ptr == -1 || len == -1)
  			continue;
  		debug("Importing data size %x
  ", len);
  
  		ret = fdt_setprop(fdt, node, "data", fdt + data_base + buf_ptr,
  				  len);
  		if (ret) {
  			debug("%s: Failed to write property: %s
  ", __func__,
  			      fdt_strerror(ret));
  			ret = -EINVAL;
  			goto err;
  		}
  	}
9cff2d1e3   Simon Glass   mkimage: Fix munm...
581
  	munmap(old_fdt, sbuf.st_size);
529fd1886   Simon Glass   mkimage: Bring da...
582
583
584
585
586
587
588
589
590
591
592
593
594
595
  	close(fd);
  
  	/* Pack the FDT and place the data after it */
  	fdt_pack(fdt);
  
  	new_size = fdt_totalsize(fdt);
  	debug("Size expanded from %x to %x
  ", fit_size, new_size);
  
  	fd = open(fname, O_RDWR | O_CREAT | O_TRUNC | O_BINARY, 0666);
  	if (fd < 0) {
  		fprintf(stderr, "%s: Can't open %s: %s
  ",
  			params->cmdname, fname, strerror(errno));
5b15a2596   Simon Glass   mkimage: Don't cl...
596
597
  		free(fdt);
  		return -EIO;
529fd1886   Simon Glass   mkimage: Bring da...
598
599
600
601
602
603
604
605
  	}
  	if (write(fd, fdt, new_size) != new_size) {
  		debug("%s: Failed to write external data to file %s
  ",
  		      __func__, strerror(errno));
  		ret = -EIO;
  		goto err;
  	}
529fd1886   Simon Glass   mkimage: Bring da...
606
607
608
609
  
  	ret = 0;
  
  err:
6e0ffce6c   Simon Glass   mkimage: Add a mi...
610
  	free(fdt);
529fd1886   Simon Glass   mkimage: Bring da...
611
612
613
  	close(fd);
  	return ret;
  }
722ebc8f8   Simon Glass   mkimage: Support ...
614
  /**
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
615
616
617
618
619
620
621
622
623
624
625
   * fit_handle_file - main FIT file processing function
   *
   * fit_handle_file() runs dtc to convert .its to .itb, includes
   * binary data, updates timestamp property and calculates hashes.
   *
   * datafile  - .its file
   * imagefile - .itb file
   *
   * returns:
   *     only on success, otherwise calls exit (EXIT_FAILURE);
   */
f86ed6a8d   Guilherme Maciel Ferreira   tools: moved code...
626
  static int fit_handle_file(struct image_tool_params *params)
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
627
628
629
  {
  	char tmpfile[MKIMAGE_MAX_TMPFILE_LEN];
  	char cmd[MKIMAGE_MAX_DTC_CMDLINE_LEN];
a94681156   Simon Glass   mkimage: Automati...
630
631
  	size_t size_inc;
  	int ret;
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
632
633
634
635
636
637
638
639
640
641
642
643
644
645
  
  	/* Flattened Image Tree (FIT) format  handling */
  	debug ("FIT format handling
  ");
  
  	/* call dtc to include binary properties into the tmp file */
  	if (strlen (params->imagefile) +
  		strlen (MKIMAGE_TMPFILE_SUFFIX) + 1 > sizeof (tmpfile)) {
  		fprintf (stderr, "%s: Image file name (%s) too long, "
  				"can't create tmpfile",
  				params->imagefile, params->cmdname);
  		return (EXIT_FAILURE);
  	}
  	sprintf (tmpfile, "%s%s", params->imagefile, MKIMAGE_TMPFILE_SUFFIX);
95d77b447   Simon Glass   mkimage: Add -F o...
646
  	/* We either compile the source file, or use the existing FIT image */
8e35bb07e   Simon Glass   mkimage: Support ...
647
648
649
650
651
652
653
654
655
  	if (params->auto_its) {
  		if (fit_build(params, tmpfile)) {
  			fprintf(stderr, "%s: failed to build FIT
  ",
  				params->cmdname);
  			return EXIT_FAILURE;
  		}
  		*cmd = '\0';
  	} else if (params->datafile) {
95d77b447   Simon Glass   mkimage: Add -F o...
656
657
658
659
660
661
662
663
664
  		/* dtc -I dts -O dtb -p 500 datafile > tmpfile */
  		snprintf(cmd, sizeof(cmd), "%s %s %s > %s",
  			 MKIMAGE_DTC, params->dtc, params->datafile, tmpfile);
  		debug("Trying to execute \"%s\"
  ", cmd);
  	} else {
  		snprintf(cmd, sizeof(cmd), "cp %s %s",
  			 params->imagefile, tmpfile);
  	}
8e35bb07e   Simon Glass   mkimage: Support ...
665
  	if (*cmd && system(cmd) == -1) {
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
666
667
668
  		fprintf (stderr, "%s: system(%s) failed: %s
  ",
  				params->cmdname, cmd, strerror(errno));
aa6d6db4d   Simon Glass   mkimage: Put FIT ...
669
  		goto err_system;
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
670
  	}
529fd1886   Simon Glass   mkimage: Bring da...
671
672
673
674
  	/* Move the data so it is internal to the FIT, if needed */
  	ret = fit_import_data(params, tmpfile);
  	if (ret)
  		goto err_system;
a94681156   Simon Glass   mkimage: Automati...
675
676
677
678
679
680
681
682
683
684
685
686
687
688
  	/*
  	 * Set hashes for images in the blob. Unfortunately we may need more
  	 * space in either FDT, so keep trying until we succeed.
  	 *
  	 * Note: this is pretty inefficient for signing, since we must
  	 * calculate the signature every time. It would be better to calculate
  	 * all the data and then store it in a separate step. However, this
  	 * would be considerably more complex to implement. Generally a few
  	 * steps of this loop is enough to sign with several keys.
  	 */
  	for (size_inc = 0; size_inc < 64 * 1024; size_inc += 1024) {
  		ret = fit_add_file_data(params, size_inc, tmpfile);
  		if (!ret || ret != -ENOSPC)
  			break;
e29495d37   Simon Glass   mkimage: Add -K t...
689
  	}
a94681156   Simon Glass   mkimage: Automati...
690
  	if (ret) {
655cc6965   Simon Glass   tools: Add an err...
691
692
693
  		fprintf(stderr, "%s Can't add hashes to FIT blob: %d
  ",
  			params->cmdname, ret);
a94681156   Simon Glass   mkimage: Automati...
694
  		goto err_system;
e29495d37   Simon Glass   mkimage: Add -K t...
695
  	}
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
696

722ebc8f8   Simon Glass   mkimage: Support ...
697
698
699
700
701
702
  	/* Move the data so it is external to the FIT, if requested */
  	if (params->external_data) {
  		ret = fit_extract_data(params, tmpfile);
  		if (ret)
  			goto err_system;
  	}
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
703
704
705
706
707
708
709
  	if (rename (tmpfile, params->imagefile) == -1) {
  		fprintf (stderr, "%s: Can't rename %s to %s: %s
  ",
  				params->cmdname, tmpfile, params->imagefile,
  				strerror (errno));
  		unlink (tmpfile);
  		unlink (params->imagefile);
a94681156   Simon Glass   mkimage: Automati...
710
  		return EXIT_FAILURE;
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
711
  	}
a94681156   Simon Glass   mkimage: Automati...
712
  	return EXIT_SUCCESS;
aa6d6db4d   Simon Glass   mkimage: Put FIT ...
713

aa6d6db4d   Simon Glass   mkimage: Put FIT ...
714
715
716
  err_system:
  	unlink(tmpfile);
  	return -1;
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
717
  }
39931f966   Guilherme Maciel Ferreira   dumpimage: fit: e...
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
770
771
772
773
774
775
776
777
778
779
780
781
782
783
784
785
786
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801
802
803
804
805
806
807
808
809
810
811
812
  /**
   * fit_image_extract - extract a FIT component image
   * @fit: pointer to the FIT format image header
   * @image_noffset: offset of the component image node
   * @file_name: name of the file to store the FIT sub-image
   *
   * returns:
   *     zero in case of success or a negative value if fail.
   */
  static int fit_image_extract(
  	const void *fit,
  	int image_noffset,
  	const char *file_name)
  {
  	const void *file_data;
  	size_t file_size = 0;
  
  	/* get the "data" property of component at offset "image_noffset" */
  	fit_image_get_data(fit, image_noffset, &file_data, &file_size);
  
  	/* save the "file_data" into the file specified by "file_name" */
  	return imagetool_save_subimage(file_name, (ulong) file_data, file_size);
  }
  
  /**
   * fit_extract_contents - retrieve a sub-image component from the FIT image
   * @ptr: pointer to the FIT format image header
   * @params: command line parameters
   *
   * returns:
   *     zero in case of success or a negative value if fail.
   */
  static int fit_extract_contents(void *ptr, struct image_tool_params *params)
  {
  	int images_noffset;
  	int noffset;
  	int ndepth;
  	const void *fit = ptr;
  	int count = 0;
  	const char *p;
  
  	/* Indent string is defined in header image.h */
  	p = IMAGE_INDENT_STRING;
  
  	if (!fit_check_format(fit)) {
  		printf("Bad FIT image format
  ");
  		return -1;
  	}
  
  	/* Find images parent node offset */
  	images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
  	if (images_noffset < 0) {
  		printf("Can't find images parent node '%s' (%s)
  ",
  		       FIT_IMAGES_PATH, fdt_strerror(images_noffset));
  		return -1;
  	}
  
  	/* Avoid any overrun */
  	count = fit_get_subimage_count(fit, images_noffset);
  	if ((params->pflag < 0) || (count <= params->pflag)) {
  		printf("No such component at '%d'
  ", params->pflag);
  		return -1;
  	}
  
  	/* Process its subnodes, extract the desired component from image */
  	for (ndepth = 0, count = 0,
  		noffset = fdt_next_node(fit, images_noffset, &ndepth);
  		(noffset >= 0) && (ndepth > 0);
  		noffset = fdt_next_node(fit, noffset, &ndepth)) {
  		if (ndepth == 1) {
  			/*
  			 * Direct child node of the images parent node,
  			 * i.e. component image node.
  			 */
  			if (params->pflag == count) {
  				printf("Extracted:
  %s Image %u (%s)
  ", p,
  				       count, fit_get_name(fit, noffset, NULL));
  
  				fit_image_print(fit, noffset, p);
  
  				return fit_image_extract(fit, noffset,
  						params->outfile);
  			}
  
  			count++;
  		}
  	}
  
  	return 0;
  }
f86ed6a8d   Guilherme Maciel Ferreira   tools: moved code...
813
  static int fit_check_params(struct image_tool_params *params)
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
814
  {
8e35bb07e   Simon Glass   mkimage: Support ...
815
816
  	if (params->auto_its)
  		return 0;
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
817
818
819
820
  	return	((params->dflag && (params->fflag || params->lflag)) ||
  		(params->fflag && (params->dflag || params->lflag)) ||
  		(params->lflag && (params->dflag || params->fflag)));
  }
a93648d19   Guilherme Maciel Ferreira   imagetool: replac...
821
822
823
824
825
826
827
828
829
  U_BOOT_IMAGE_TYPE(
  	fitimage,
  	"FIT Image support",
  	sizeof(image_header_t),
  	(void *)&header,
  	fit_check_params,
  	fit_verify_header,
  	fit_print_contents,
  	NULL,
39931f966   Guilherme Maciel Ferreira   dumpimage: fit: e...
830
  	fit_extract_contents,
a93648d19   Guilherme Maciel Ferreira   imagetool: replac...
831
832
833
834
  	fit_check_image_types,
  	fit_handle_file,
  	NULL /* FIT images use DTB header */
  );