[2725] | 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 |
|
---|
[3232] | 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 |
|
---|
[2725] | 16 | #include "libbb.h"
|
---|
| 17 | #include <mtd/mtd-user.h>
|
---|
| 18 |
|
---|
[3621] | 19 | /* If 1, simulates "flashing" by writing to existing regular file */
|
---|
[2725] | 20 | #define MTD_DEBUG 0
|
---|
| 21 |
|
---|
| 22 | #define OPT_v (1 << 0)
|
---|
| 23 |
|
---|
[3621] | 24 | #define BUFSIZE (4 * 1024)
|
---|
[2725] | 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%%) ",
|
---|
[3621] | 36 | (mode < 0) ? "Erasing block" : ((mode == 0) ? "Writing kb" : "Verifying kb"),
|
---|
[2725] | 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 | int 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 */
|
---|
[3232] | 62 | /*opts =*/ getopt32(argv, "v");
|
---|
[2725] | 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++) {
|
---|
[3621] | 101 | progress(-1, i, erase_count);
|
---|
[2725] | 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 */
|
---|
[3621] | 116 | for (i = 0; i <= 1; i++) {
|
---|
[2725] | 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) {
|
---|
[3621] | 125 | uoff_t rem;
|
---|
| 126 |
|
---|
| 127 | progress(i, done / 1024, (uoff_t)statb.st_size / 1024);
|
---|
| 128 | rem = statb.st_size - done;
|
---|
[2725] | 129 | if (rem == 0)
|
---|
| 130 | break;
|
---|
| 131 | if (rem < BUFSIZE)
|
---|
| 132 | count = rem;
|
---|
| 133 | xread(fd_f, buf, count);
|
---|
[3621] | 134 | if (i == 0) {
|
---|
[2725] | 135 | int ret;
|
---|
[3621] | 136 | if (count < BUFSIZE)
|
---|
| 137 | memset((char*)buf + count, 0, BUFSIZE - count);
|
---|
[2725] | 138 | errno = 0;
|
---|
[3621] | 139 | ret = full_write(fd_d, buf, BUFSIZE);
|
---|
| 140 | if (ret != BUFSIZE) {
|
---|
[2725] | 141 | bb_perror_msg_and_die("write error at 0x%"OFF_FMT"x on %s, "
|
---|
| 142 | "write returned %d",
|
---|
| 143 | done, devicename, ret);
|
---|
| 144 | }
|
---|
[3621] | 145 | } else { /* i == 1 */
|
---|
[2725] | 146 | xread(fd_d, buf2, count);
|
---|
[3621] | 147 | if (memcmp(buf, buf2, count) != 0) {
|
---|
[2725] | 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 | }
|
---|