Blame view

tools/fit_image.c 20.2 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
  
  	if (!ret) {
  		ret = fit_add_verification_data(params->keydir, dest_blob, ptr,
  						params->comment,
f1ca1fdeb   George McCollister   mkimage: Add supp...
60
61
  						params->require_keys,
  						params->engine_id);
a94681156   Simon Glass   mkimage: Automati...
62
63
64
65
66
67
68
69
70
71
72
73
74
  	}
  
  	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...
75
  /**
8e35bb07e   Simon Glass   mkimage: Support ...
76
77
78
79
   * 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 ...
80
  	struct content_info *cont;
8e35bb07e   Simon Glass   mkimage: Support ...
81
82
83
84
85
  	int size, total_size;
  
  	size = imagetool_get_filesize(params, params->datafile);
  	if (size < 0)
  		return -1;
8e35bb07e   Simon Glass   mkimage: Support ...
86
  	total_size = size;
0f7c6cdc8   Tomeu Vizoso   mkimage: Allow in...
87
88
89
90
91
92
93
  
  	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 ...
94
95
96
97
  	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 ...
98

fb4cce0f9   Simon Glass   mkimage: Support ...
99
100
101
  		/* Add space for properties */
  		total_size += size + 300;
  	}
8e35bb07e   Simon Glass   mkimage: Support ...
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
133
  
  	/* 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...
134
  		goto err;
8e35bb07e   Simon Glass   mkimage: Support ...
135
136
137
138
139
140
141
  	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...
142
  	close(fd);
8e35bb07e   Simon Glass   mkimage: Support ...
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
  
  	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 ...
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
  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 ...
181
182
183
  /**
   * fit_write_images() - Write out a list of images to the FIT
   *
fb4cce0f9   Simon Glass   mkimage: Support ...
184
   * We always include the main image (params->datafile). If there are device
2eda8e9aa   Andre Przywara   tools: fix incorr...
185
   * tree files, we include an fdt- node for each of those too.
8e35bb07e   Simon Glass   mkimage: Support ...
186
187
188
   */
  static int fit_write_images(struct image_tool_params *params, char *fdt)
  {
fb4cce0f9   Simon Glass   mkimage: Support ...
189
  	struct content_info *cont;
8e35bb07e   Simon Glass   mkimage: Support ...
190
191
  	const char *typename;
  	char str[100];
fb4cce0f9   Simon Glass   mkimage: Support ...
192
  	int upto;
8e35bb07e   Simon Glass   mkimage: Support ...
193
194
195
196
197
198
  	int ret;
  
  	fdt_begin_node(fdt, "images");
  
  	/* First the main image */
  	typename = genimg_get_type_short_name(params->fit_image_type);
2eda8e9aa   Andre Przywara   tools: fix incorr...
199
  	snprintf(str, sizeof(str), "%s-1", typename);
8e35bb07e   Simon Glass   mkimage: Support ...
200
201
202
  	fdt_begin_node(fdt, str);
  	fdt_property_string(fdt, "description", params->imagename);
  	fdt_property_string(fdt, "type", typename);
3a45f38d4   Simon Glass   image: Correct au...
203
204
  	fdt_property_string(fdt, "arch",
  			    genimg_get_arch_short_name(params->arch));
8e35bb07e   Simon Glass   mkimage: Support ...
205
206
207
208
209
210
211
212
213
214
215
216
217
218
  	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 ...
219
220
221
222
223
  	/* 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;
2eda8e9aa   Andre Przywara   tools: fix incorr...
224
  		snprintf(str, sizeof(str), "%s-%d", FIT_FDT_PROP, ++upto);
fb4cce0f9   Simon Glass   mkimage: Support ...
225
226
227
228
229
230
231
232
233
234
235
236
237
238
  		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...
239
240
  	/* And a ramdisk file if available */
  	if (params->fit_ramdisk) {
2eda8e9aa   Andre Przywara   tools: fix incorr...
241
  		fdt_begin_node(fdt, FIT_RAMDISK_PROP "-1");
0f7c6cdc8   Tomeu Vizoso   mkimage: Allow in...
242
243
244
245
246
247
248
249
250
251
  
  		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 ...
252
253
254
255
256
257
258
259
  	fdt_end_node(fdt);
  
  	return 0;
  }
  
  /**
   * fit_write_configs() - Write out a list of configurations to the FIT
   *
fb4cce0f9   Simon Glass   mkimage: Support ...
260
261
262
263
264
   * 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 ...
265
266
267
   */
  static void fit_write_configs(struct image_tool_params *params, char *fdt)
  {
fb4cce0f9   Simon Glass   mkimage: Support ...
268
  	struct content_info *cont;
8e35bb07e   Simon Glass   mkimage: Support ...
269
270
  	const char *typename;
  	char str[100];
fb4cce0f9   Simon Glass   mkimage: Support ...
271
  	int upto;
8e35bb07e   Simon Glass   mkimage: Support ...
272
273
  
  	fdt_begin_node(fdt, "configurations");
2eda8e9aa   Andre Przywara   tools: fix incorr...
274
  	fdt_property_string(fdt, "default", "conf-1");
8e35bb07e   Simon Glass   mkimage: Support ...
275

fb4cce0f9   Simon Glass   mkimage: Support ...
276
277
278
279
280
  	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);
2eda8e9aa   Andre Przywara   tools: fix incorr...
281
  		snprintf(str, sizeof(str), "conf-%d", ++upto);
fb4cce0f9   Simon Glass   mkimage: Support ...
282
283
284
285
286
287
  		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);
2eda8e9aa   Andre Przywara   tools: fix incorr...
288
  		snprintf(str, sizeof(str), "%s-1", typename);
fb4cce0f9   Simon Glass   mkimage: Support ...
289
  		fdt_property_string(fdt, typename, str);
0f7c6cdc8   Tomeu Vizoso   mkimage: Allow in...
290
291
  		if (params->fit_ramdisk)
  			fdt_property_string(fdt, FIT_RAMDISK_PROP,
2eda8e9aa   Andre Przywara   tools: fix incorr...
292
  					    FIT_RAMDISK_PROP "-1");
0f7c6cdc8   Tomeu Vizoso   mkimage: Allow in...
293

2eda8e9aa   Andre Przywara   tools: fix incorr...
294
  		snprintf(str, sizeof(str), FIT_FDT_PROP "-%d", upto);
fb4cce0f9   Simon Glass   mkimage: Support ...
295
296
297
  		fdt_property_string(fdt, FIT_FDT_PROP, str);
  		fdt_end_node(fdt);
  	}
0f7c6cdc8   Tomeu Vizoso   mkimage: Allow in...
298

fb4cce0f9   Simon Glass   mkimage: Support ...
299
  	if (!upto) {
2eda8e9aa   Andre Przywara   tools: fix incorr...
300
  		fdt_begin_node(fdt, "conf-1");
fb4cce0f9   Simon Glass   mkimage: Support ...
301
  		typename = genimg_get_type_short_name(params->fit_image_type);
2eda8e9aa   Andre Przywara   tools: fix incorr...
302
  		snprintf(str, sizeof(str), "%s-1", typename);
fb4cce0f9   Simon Glass   mkimage: Support ...
303
  		fdt_property_string(fdt, typename, str);
0f7c6cdc8   Tomeu Vizoso   mkimage: Allow in...
304
305
306
  
  		if (params->fit_ramdisk)
  			fdt_property_string(fdt, FIT_RAMDISK_PROP,
2eda8e9aa   Andre Przywara   tools: fix incorr...
307
  					    FIT_RAMDISK_PROP "-1");
0f7c6cdc8   Tomeu Vizoso   mkimage: Allow in...
308

fb4cce0f9   Simon Glass   mkimage: Support ...
309
310
  		fdt_end_node(fdt);
  	}
8e35bb07e   Simon Glass   mkimage: Support ...
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
359
360
361
362
  
  	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...
363
  		goto err_buf;
8e35bb07e   Simon Glass   mkimage: Support ...
364
365
366
367
368
369
370
  	}
  	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));
3c2dff549   Tom Rini   tools/fit_image.c...
371
  		goto err_buf;
8e35bb07e   Simon Glass   mkimage: Support ...
372
373
374
375
376
377
  	}
  	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 ...
378
379
380
  		goto err;
  	}
  	close(fd);
7b0bbd886   Simon Glass   mkimage: Fix miss...
381
  	free(buf);
8e35bb07e   Simon Glass   mkimage: Support ...
382
383
384
  
  	return 0;
  err:
7b0bbd886   Simon Glass   mkimage: Fix miss...
385
386
  	close(fd);
  err_buf:
8e35bb07e   Simon Glass   mkimage: Support ...
387
388
389
390
391
  	free(buf);
  	return -1;
  }
  
  /**
722ebc8f8   Simon Glass   mkimage: Support ...
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
419
420
421
422
   * 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...
423
  		goto err_munmap;
722ebc8f8   Simon Glass   mkimage: Support ...
424
425
426
427
428
429
430
431
  	}
  	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...
432
  		goto err_munmap;
722ebc8f8   Simon Glass   mkimage: Support ...
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
  	}
  
  	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...
451
  			goto err_munmap;
722ebc8f8   Simon Glass   mkimage: Support ...
452
  		}
f8f9107d9   Teddy Reed   mkimage: fit: spl...
453
454
455
456
457
458
459
  		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 ...
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
  		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...
483
484
485
486
487
488
489
490
491
492
493
  
  	/* 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 ...
494
495
496
497
498
499
500
501
502
503
504
505
506
507
  	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;
  	}
3c2dff549   Tom Rini   tools/fit_image.c...
508
  	free(buf);
b97d71e26   Simon Glass   mkimage: Fix erro...
509
510
  	close(fd);
  	return 0;
722ebc8f8   Simon Glass   mkimage: Support ...
511

b97d71e26   Simon Glass   mkimage: Fix erro...
512
513
  err_munmap:
  	munmap(fdt, sbuf.st_size);
722ebc8f8   Simon Glass   mkimage: Support ...
514
  err:
21c2975a9   Simon Glass   mkimage: Fix miss...
515
516
  	if (buf)
  		free(buf);
722ebc8f8   Simon Glass   mkimage: Support ...
517
518
519
  	close(fd);
  	return ret;
  }
529fd1886   Simon Glass   mkimage: Bring da...
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
  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;
bf52fcdef   Tom Rini   cmd/gpt.c, cmd/nv...
544
  		goto err_has_fd;
529fd1886   Simon Glass   mkimage: Bring da...
545
546
547
548
549
550
551
  	}
  	ret = fdt_open_into(old_fdt, fdt, size);
  	if (ret) {
  		debug("%s: Failed to expand FIT: %s
  ", __func__,
  		      fdt_strerror(errno));
  		ret = -EINVAL;
bf52fcdef   Tom Rini   cmd/gpt.c, cmd/nv...
552
  		goto err_has_fd;
529fd1886   Simon Glass   mkimage: Bring da...
553
554
555
556
557
558
559
  	}
  
  	images = fdt_path_offset(fdt, FIT_IMAGES_PATH);
  	if (images < 0) {
  		debug("%s: Cannot find /images node: %d
  ", __func__, images);
  		ret = -EINVAL;
bf52fcdef   Tom Rini   cmd/gpt.c, cmd/nv...
560
  		goto err_has_fd;
529fd1886   Simon Glass   mkimage: Bring da...
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
  	}
  
  	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;
bf52fcdef   Tom Rini   cmd/gpt.c, cmd/nv...
583
  			goto err_has_fd;
529fd1886   Simon Glass   mkimage: Bring da...
584
585
  		}
  	}
bf52fcdef   Tom Rini   cmd/gpt.c, cmd/nv...
586
  	/* Close the old fd so we can re-use it. */
529fd1886   Simon Glass   mkimage: Bring da...
587
588
589
590
591
592
593
594
595
596
597
598
599
600
  	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));
bf52fcdef   Tom Rini   cmd/gpt.c, cmd/nv...
601
602
  		ret = -EIO;
  		goto err_no_fd;
529fd1886   Simon Glass   mkimage: Bring da...
603
604
605
606
607
608
  	}
  	if (write(fd, fdt, new_size) != new_size) {
  		debug("%s: Failed to write external data to file %s
  ",
  		      __func__, strerror(errno));
  		ret = -EIO;
bf52fcdef   Tom Rini   cmd/gpt.c, cmd/nv...
609
  		goto err_has_fd;
529fd1886   Simon Glass   mkimage: Bring da...
610
  	}
529fd1886   Simon Glass   mkimage: Bring da...
611
612
  
  	ret = 0;
bf52fcdef   Tom Rini   cmd/gpt.c, cmd/nv...
613
614
615
  err_has_fd:
  	close(fd);
  err_no_fd:
3c2dff549   Tom Rini   tools/fit_image.c...
616
  	munmap(old_fdt, sbuf.st_size);
6e0ffce6c   Simon Glass   mkimage: Add a mi...
617
  	free(fdt);
529fd1886   Simon Glass   mkimage: Bring da...
618
619
  	return ret;
  }
722ebc8f8   Simon Glass   mkimage: Support ...
620
  /**
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
621
622
623
624
625
626
627
628
629
630
631
   * 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...
632
  static int fit_handle_file(struct image_tool_params *params)
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
633
634
635
  {
  	char tmpfile[MKIMAGE_MAX_TMPFILE_LEN];
  	char cmd[MKIMAGE_MAX_DTC_CMDLINE_LEN];
a94681156   Simon Glass   mkimage: Automati...
636
637
  	size_t size_inc;
  	int ret;
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
638
639
640
641
642
643
644
645
646
647
648
649
650
651
  
  	/* 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...
652
  	/* We either compile the source file, or use the existing FIT image */
8e35bb07e   Simon Glass   mkimage: Support ...
653
654
655
656
657
658
659
660
661
  	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) {
63f881d46   Stefan Theil   tools/mkimage: Us...
662
663
664
  		/* dtc -I dts -O dtb -p 500 -o tmpfile datafile */
  		snprintf(cmd, sizeof(cmd), "%s %s -o \"%s\" \"%s\"",
  			 MKIMAGE_DTC, params->dtc, tmpfile, params->datafile);
95d77b447   Simon Glass   mkimage: Add -F o...
665
666
667
  		debug("Trying to execute \"%s\"
  ", cmd);
  	} else {
a6e981049   Mirza, Taimoor   tools/mkimage: Fi...
668
  		snprintf(cmd, sizeof(cmd), "cp \"%s\" \"%s\"",
95d77b447   Simon Glass   mkimage: Add -F o...
669
670
  			 params->imagefile, tmpfile);
  	}
8e35bb07e   Simon Glass   mkimage: Support ...
671
  	if (*cmd && system(cmd) == -1) {
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
672
673
674
  		fprintf (stderr, "%s: system(%s) failed: %s
  ",
  				params->cmdname, cmd, strerror(errno));
aa6d6db4d   Simon Glass   mkimage: Put FIT ...
675
  		goto err_system;
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
676
  	}
529fd1886   Simon Glass   mkimage: Bring da...
677
678
679
680
  	/* 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...
681
682
683
684
685
686
687
688
689
690
691
692
693
694
  	/*
  	 * 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...
695
  	}
a94681156   Simon Glass   mkimage: Automati...
696
  	if (ret) {
655cc6965   Simon Glass   tools: Add an err...
697
698
699
  		fprintf(stderr, "%s Can't add hashes to FIT blob: %d
  ",
  			params->cmdname, ret);
a94681156   Simon Glass   mkimage: Automati...
700
  		goto err_system;
e29495d37   Simon Glass   mkimage: Add -K t...
701
  	}
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
702

722ebc8f8   Simon Glass   mkimage: Support ...
703
704
705
706
707
708
  	/* 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...
709
710
711
712
713
714
715
  	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...
716
  		return EXIT_FAILURE;
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
717
  	}
a94681156   Simon Glass   mkimage: Automati...
718
  	return EXIT_SUCCESS;
aa6d6db4d   Simon Glass   mkimage: Put FIT ...
719

aa6d6db4d   Simon Glass   mkimage: Put FIT ...
720
721
722
  err_system:
  	unlink(tmpfile);
  	return -1;
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
723
  }
39931f966   Guilherme Maciel Ferreira   dumpimage: fit: e...
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
813
814
815
816
817
818
  /**
   * 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...
819
  static int fit_check_params(struct image_tool_params *params)
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
820
  {
8e35bb07e   Simon Glass   mkimage: Support ...
821
822
  	if (params->auto_its)
  		return 0;
89a4d6b12   Prafulla Wadaskar   tools: mkimage: s...
823
824
825
826
  	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...
827
828
829
830
831
832
833
834
835
  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...
836
  	fit_extract_contents,
a93648d19   Guilherme Maciel Ferreira   imagetool: replac...
837
838
839
840
  	fit_check_image_types,
  	fit_handle_file,
  	NULL /* FIT images use DTB header */
  );