blob: a834a7facde0459cda164c227f6ee59d7299d0fe
1 | /* vi: set sw=4 ts=4: */ |
2 | /* |
3 | * busybox reimplementation of flashcp |
4 | * |
5 | * (C) 2009 Stefan Seyfried <seife@sphairon.com> |
6 | * |
7 | * Licensed under GPLv2, see file LICENSE in this source tree. |
8 | */ |
9 | |
10 | //usage:#define flashcp_trivial_usage |
11 | //usage: "-v FILE MTD_DEVICE" |
12 | //usage:#define flashcp_full_usage "\n\n" |
13 | //usage: "Copy an image to MTD device\n" |
14 | //usage: "\n -v Verbose" |
15 | |
16 | #include "libbb.h" |
17 | #include <mtd/mtd-user.h> |
18 | |
19 | /* If 1, simulates "flashing" by writing to existing regular file */ |
20 | #define MTD_DEBUG 0 |
21 | |
22 | #define OPT_v (1 << 0) |
23 | |
24 | #define BUFSIZE (8 * 1024) |
25 | |
26 | static void progress(int mode, uoff_t count, uoff_t total) |
27 | { |
28 | uoff_t percent; |
29 | |
30 | if (!option_mask32) //if (!(option_mask32 & OPT_v)) |
31 | return; |
32 | percent = count * 100; |
33 | if (total) |
34 | percent = (unsigned) (percent / total); |
35 | printf("\r%s: %"OFF_FMT"u/%"OFF_FMT"u (%u%%) ", |
36 | (mode < 0) ? "Erasing block" : ((mode == 0) ? "Writing kb" : "Verifying kb"), |
37 | count, total, (unsigned)percent); |
38 | fflush_all(); |
39 | } |
40 | |
41 | static void progress_newline(void) |
42 | { |
43 | if (!option_mask32) //if (!(option_mask32 & OPT_v)) |
44 | return; |
45 | bb_putchar('\n'); |
46 | } |
47 | |
48 | int flashcp_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE; |
49 | int flashcp_main(int argc UNUSED_PARAM, char **argv) |
50 | { |
51 | int fd_f, fd_d; /* input file and mtd device file descriptors */ |
52 | unsigned i; |
53 | uoff_t erase_count; |
54 | struct mtd_info_user mtd; |
55 | struct erase_info_user e; |
56 | struct stat statb; |
57 | // const char *filename, *devicename; |
58 | RESERVE_CONFIG_UBUFFER(buf, BUFSIZE); |
59 | RESERVE_CONFIG_UBUFFER(buf2, BUFSIZE); |
60 | |
61 | opt_complementary = "=2"; /* exactly 2 non-option args: file, dev */ |
62 | /*opts =*/ getopt32(argv, "v"); |
63 | argv += optind; |
64 | // filename = *argv++; |
65 | // devicename = *argv; |
66 | #define filename argv[0] |
67 | #define devicename argv[1] |
68 | |
69 | /* open input file and mtd device and do sanity checks */ |
70 | fd_f = xopen(filename, O_RDONLY); |
71 | fstat(fd_f, &statb); |
72 | fd_d = xopen(devicename, O_SYNC | O_RDWR); |
73 | #if !MTD_DEBUG |
74 | if (ioctl(fd_d, MEMGETINFO, &mtd) < 0) { |
75 | bb_error_msg_and_die("%s is not a MTD flash device", devicename); |
76 | } |
77 | if (statb.st_size > mtd.size) { |
78 | bb_error_msg_and_die("%s bigger than %s", filename, devicename); |
79 | } |
80 | #else |
81 | mtd.erasesize = 64 * 1024; |
82 | #endif |
83 | |
84 | /* always erase a complete block */ |
85 | erase_count = (uoff_t)(statb.st_size + mtd.erasesize - 1) / mtd.erasesize; |
86 | /* erase 1 block at a time to be able to give verbose output */ |
87 | e.length = mtd.erasesize; |
88 | #if 0 |
89 | /* (1) bloat |
90 | * (2) will it work for multi-gigabyte devices? |
91 | * (3) worse wrt error detection granularity |
92 | */ |
93 | /* optimization: if not verbose, erase in one go */ |
94 | if (!opts) { // if (!(opts & OPT_v)) |
95 | e.length = mtd.erasesize * erase_count; |
96 | erase_count = 1; |
97 | } |
98 | #endif |
99 | e.start = 0; |
100 | for (i = 1; i <= erase_count; i++) { |
101 | progress(-1, i, erase_count); |
102 | #if !MTD_DEBUG |
103 | if (ioctl(fd_d, MEMERASE, &e) < 0) { |
104 | bb_perror_msg_and_die("erase error at 0x%llx on %s", |
105 | (long long)e.start, devicename); |
106 | } |
107 | #else |
108 | usleep(100*1000); |
109 | #endif |
110 | e.start += mtd.erasesize; |
111 | } |
112 | progress_newline(); |
113 | |
114 | /* doing this outer loop gives significantly smaller code |
115 | * than doing two separate loops for writing and verifying */ |
116 | for (i = 0; i <= 1; i++) { |
117 | uoff_t done; |
118 | unsigned count; |
119 | |
120 | xlseek(fd_f, 0, SEEK_SET); |
121 | xlseek(fd_d, 0, SEEK_SET); |
122 | done = 0; |
123 | count = BUFSIZE; |
124 | while (1) { |
125 | uoff_t rem; |
126 | |
127 | progress(i, done / 1024, (uoff_t)statb.st_size / 1024); |
128 | rem = statb.st_size - done; |
129 | if (rem == 0) |
130 | break; |
131 | if (rem < BUFSIZE) |
132 | count = rem; |
133 | xread(fd_f, buf, count); |
134 | if (i == 0) { |
135 | int ret; |
136 | if (count < BUFSIZE) |
137 | memset((char*)buf + count, 0, BUFSIZE - count); |
138 | errno = 0; |
139 | ret = full_write(fd_d, buf, BUFSIZE); |
140 | if (ret != BUFSIZE) { |
141 | bb_perror_msg_and_die("write error at 0x%"OFF_FMT"x on %s, " |
142 | "write returned %d", |
143 | done, devicename, ret); |
144 | } |
145 | } else { /* i == 1 */ |
146 | xread(fd_d, buf2, count); |
147 | if (memcmp(buf, buf2, count) != 0) { |
148 | bb_error_msg_and_die("verification mismatch at 0x%"OFF_FMT"x", done); |
149 | } |
150 | } |
151 | |
152 | done += count; |
153 | } |
154 | |
155 | progress_newline(); |
156 | } |
157 | /* we won't come here if there was an error */ |
158 | |
159 | return EXIT_SUCCESS; |
160 | } |
161 |