summaryrefslogtreecommitdiff
path: root/tools/firmware-utils/src/mkdhpimg.c
blob: e61d0425043fef4b947206248ee19d2796277538 (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
/*
 * Copyright (c) 2016 FUKAUMI Naoki <naobsd@gmail.com>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published
 * by the Free Software Foundation.
 *
 */

#include <sys/stat.h>
#include <err.h>
#include <fcntl.h>
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>

#include "buffalo-lib.h"

#define DHP_HEADER_SIZE	20

static char *progname;

static void
usage(void)
{

	fprintf(stderr, "usage: %s <in> <out>\n", progname);
	exit(EXIT_FAILURE);
}

int
main(int argc, char *argv[])
{
	struct stat in_st;
	size_t size;
	uint32_t crc;
	int in, out;
	uint8_t *buf;

	progname = argv[0];

	if (argc != 3)
		usage();

	if ((in = open(argv[1], O_RDONLY)) == -1)
		err(EXIT_FAILURE, "%s", argv[1]);

	if (fstat(in, &in_st) == -1)
		err(EXIT_FAILURE, "%s", argv[1]);

	size = DHP_HEADER_SIZE + in_st.st_size;

	if ((buf = malloc(size)) == NULL)
		err(EXIT_FAILURE, "malloc");

	memset(buf, 0, DHP_HEADER_SIZE);
	buf[0x0] = 0x62;
	buf[0x1] = 0x67;
	buf[0x2] = 0x6e;
	buf[0xb] = 0xb1;
	buf[0xc] = (size >> 24) & 0xff;
	buf[0xd] = (size >> 16) & 0xff;
	buf[0xe] = (size >> 8) & 0xff;
	buf[0xf] = size & 0xff;

	read(in, &buf[DHP_HEADER_SIZE], in_st.st_size);
	close(in);

	crc = buffalo_crc(buf, size);
	buf[0x10] = (crc >> 24) & 0xff;
	buf[0x11] = (crc >> 16) & 0xff;
	buf[0x12] = (crc >> 8) & 0xff;
	buf[0x13] = crc & 0xff;

	if ((out = open(argv[2], O_WRONLY | O_CREAT | O_TRUNC, 0644)) == -1)
		err(EXIT_FAILURE, "%s", argv[2]);
	write(out, buf, size);
	close(out);

	free(buf);

	return EXIT_SUCCESS;
}