1
2
3
4
5
6
7
8
9
10
11
12#include <fcntl.h>
13#include <stdio.h>
14#include <stdlib.h>
15#include <string.h>
16#include <sys/stat.h>
17#include <unistd.h>
18#include <netinet/in.h>
19#ifdef __sun__
20#include <inttypes.h>
21#else
22#include <stdint.h>
23#endif
24
25
26
27
28
29typedef struct boot_block {
30 uint32_t bb_magic;
31 uint32_t bb_dest;
32 uint32_t bb_num_512blocks;
33 uint32_t bb_debug_flag;
34 uint32_t bb_entry_point;
35 uint32_t bb_checksum;
36 uint32_t reserved[2];
37} boot_block_t;
38
39#define IMGBLK 512
40unsigned int tmpbuf[IMGBLK / sizeof(unsigned int)];
41
42int main(int argc, char *argv[])
43{
44 int in_fd, out_fd;
45 int nblks, i;
46 unsigned int cksum, *cp;
47 struct stat st;
48 boot_block_t bt;
49
50 if (argc < 5) {
51 fprintf(stderr, "usage: %s <zImage-file> <boot-image> <load address> <entry point>\n",argv[0]);
52 exit(1);
53 }
54
55 if (stat(argv[1], &st) < 0) {
56 perror("stat");
57 exit(2);
58 }
59
60 nblks = (st.st_size + IMGBLK) / IMGBLK;
61
62 bt.bb_magic = htonl(0x0052504F);
63
64
65 bt.bb_dest = htonl(strtoul(argv[3], NULL, 0));
66 bt.bb_entry_point = htonl(strtoul(argv[4], NULL, 0));
67
68
69
70
71
72 bt.bb_num_512blocks = htonl(nblks);
73 bt.bb_debug_flag = 0;
74
75 bt.bb_checksum = 0;
76
77
78
79 bt.reserved[0] = 0;
80 bt.reserved[1] = 0;
81
82 if ((in_fd = open(argv[1], O_RDONLY)) < 0) {
83 perror("zImage open");
84 exit(3);
85 }
86
87 if ((out_fd = open(argv[2], (O_RDWR | O_CREAT | O_TRUNC), 0666)) < 0) {
88 perror("bootfile open");
89 exit(3);
90 }
91
92 cksum = 0;
93 cp = (void *)&bt;
94 for (i = 0; i < sizeof(bt) / sizeof(unsigned int); i++)
95 cksum += *cp++;
96
97
98
99 if (read(in_fd, tmpbuf, sizeof(tmpbuf)) != sizeof(tmpbuf)) {
100 fprintf(stderr, "%s is too small to be an ELF image\n",
101 argv[1]);
102 exit(4);
103 }
104
105 if (tmpbuf[0] != htonl(0x7f454c46)) {
106 fprintf(stderr, "%s is not an ELF image\n", argv[1]);
107 exit(4);
108 }
109
110 if (lseek(in_fd, (64 * 1024), SEEK_SET) < 0) {
111 fprintf(stderr, "%s failed to seek in ELF image\n", argv[1]);
112 exit(4);
113 }
114
115 nblks -= (64 * 1024) / IMGBLK;
116
117
118
119 if (write(out_fd, &bt, sizeof(bt)) != sizeof(bt)) {
120 perror("boot-image write");
121 exit(5);
122 }
123
124 while (nblks-- > 0) {
125 if (read(in_fd, tmpbuf, sizeof(tmpbuf)) < 0) {
126 perror("zImage read");
127 exit(5);
128 }
129 cp = tmpbuf;
130 for (i = 0; i < sizeof(tmpbuf) / sizeof(unsigned int); i++)
131 cksum += *cp++;
132 if (write(out_fd, tmpbuf, sizeof(tmpbuf)) != sizeof(tmpbuf)) {
133 perror("boot-image write");
134 exit(5);
135 }
136 }
137
138
139
140 bt.bb_checksum = htonl(cksum);
141 if (lseek(out_fd, 0, SEEK_SET) < 0) {
142 perror("rewrite seek");
143 exit(1);
144 }
145 if (write(out_fd, &bt, sizeof(bt)) != sizeof(bt)) {
146 perror("boot-image rewrite");
147 exit(1);
148 }
149
150 exit(0);
151}
152