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