aboutsummaryrefslogtreecommitdiffstats
path: root/tools/firmware-utils/src/uimage_sgehdr.c
blob: 28143a8b22f883f5749d0148fd9b21f50b344462 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
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
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
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
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * uimage_sgehdr.c : add 96 bytes of extra header information after the normal tail of uimage header
 * this is an edited version of uimage_padhdr.c
 *
 * Copyright (C) 2019 NOGUCHI Hiroshi <drvlabo@gmail.com>
 */

#include <stdio.h>
#include <errno.h>
#include <unistd.h>
#include <stdlib.h>
#include <string.h>
#include <fcntl.h>
#include <sys/stat.h>
#include <arpa/inet.h>
#include <zlib.h>


/* from u-boot/include/image.h */
#define IH_NMLEN		32	/* Image Name Length		*/
#define SGE_PRODUCTLEN		64	/* sge_Product Length		*/
#define SGE_VERSIONLEN		16	/* sge Version Length		*/
#define OrignalHL		64	/* Original Header Length	*/

/*
 * SGE format image header,
 * all data in network byte order (aka natural aka bigendian).
 */
struct image_header {
	uint32_t	ih_magic;	/* Image Header Magic Number	*/
	uint32_t	ih_hcrc;	/* Image Header CRC Checksum	*/
	uint32_t	ih_time;	/* Image Creation Timestamp	*/
	uint32_t	ih_size;	/* Image Data Size		*/
	uint32_t	ih_load;	/* Data	 Load  Address		*/
	uint32_t	ih_ep;		/* Entry Point Address		*/
	uint32_t	ih_dcrc;	/* Image Data CRC Checksum	*/
	uint8_t		ih_os;		/* Operating System		*/
	uint8_t		ih_arch;	/* CPU architecture		*/
	uint8_t		ih_type;	/* Image Type			*/
	uint8_t		ih_comp;	/* Compression Type		*/
	uint8_t		ih_name[IH_NMLEN];	/* Image Name		*/
	uint8_t		sgeih_p[SGE_PRODUCTLEN];	/* sge_Product		*/
	uint8_t		sgeih_sv[SGE_VERSIONLEN];	/* sge Software Version		*/
	uint8_t		sgeih_hv[SGE_VERSIONLEN];	/* sge Hardware Version		*/
};


/* default padding size */
#define	IH_PAD_BYTES		(96)


static void usage(char *prog)
{
	fprintf(stderr,
		"%s -i <input_uimage_file> -o <output_file> -m <model> -h <hardware version> -s <software version>\n",
		prog);
}

int main(int argc, char *argv[])
{
	struct stat statbuf;
	u_int8_t *filebuf;
	int ifd;
	int ofd;
	ssize_t rsz;
	u_int32_t crc_recalc;
	struct image_header *imgh;
	int opt;
	char *infname = NULL;
	char *outfname = NULL;
	char *model = NULL;
	char *hversion = NULL;
	char *sversion = NULL;
	int padsz = IH_PAD_BYTES;
	int ltmp;

	while ((opt = getopt(argc, argv, "i:o:m:h:s:")) != -1) {
		switch (opt) {
		case 'i':
			infname = optarg;
			break;
		case 'o':
			outfname = optarg;
			break;
		case 'm':
			model = optarg;
			break;
		case 'h':
			hversion = optarg;
			break;
		case 's':
			sversion = optarg;
			break;
		default:
			break;
		}
	}

	if (!infname || !outfname) {
		usage(argv[0]);
		exit(1);
	}

	ifd = open(infname, O_RDONLY);
	if (ifd < 0) {
		fprintf(stderr,
			"could not open input file. (errno = %d)\n", errno);
		exit(1);
	}

	ofd = open(outfname, O_WRONLY | O_CREAT, 0644);
	if (ofd < 0) {
		fprintf(stderr,
			"could not open output file. (errno = %d)\n", errno);
		exit(1);
	}

	if (fstat(ifd, &statbuf) < 0) {
		fprintf(stderr,
			"could not fstat input file. (errno = %d)\n", errno);
		exit(1);
	}

	filebuf = malloc(statbuf.st_size + padsz);
	if (!filebuf) {
		fprintf(stderr, "buffer allocation failed\n");
		exit(1);
	}

	rsz = read(ifd, filebuf, OrignalHL);
	if (rsz != OrignalHL) {
		fprintf(stderr,
			"could not read input file (errno = %d).\n", errno);
		exit(1);
	}

	memset(&(filebuf[OrignalHL]), 0, padsz);

	rsz = read(ifd, &(filebuf[sizeof(*imgh)]),
				statbuf.st_size - OrignalHL);
	if (rsz != (int32_t)(statbuf.st_size - OrignalHL)) {
		fprintf(stderr,
			"could not read input file (errno = %d).\n", errno);
		exit(1);
	}

	imgh = (struct image_header *)filebuf;

	imgh->ih_hcrc = 0;

	strncpy(imgh->sgeih_p, model, sizeof(imgh->sgeih_p));
	strncpy(imgh->sgeih_sv, sversion, sizeof(imgh->sgeih_sv));
	strncpy(imgh->sgeih_hv, hversion, sizeof(imgh->sgeih_hv));

	crc_recalc = crc32(0, filebuf, sizeof(*imgh));
	imgh->ih_hcrc = htonl(crc_recalc);

	rsz = write(ofd, filebuf, statbuf.st_size + padsz);
	if (rsz != (int32_t)statbuf.st_size + padsz) {
		fprintf(stderr,
			"could not write output file (errnor = %d).\n", errno);
		exit(1);
	}

	return 0;
}