| /* vi: set sw=4 ts=4: */ |
| /* |
| * busybox reimplementation of flashcp |
| * |
| * (C) 2009 Stefan Seyfried <seife@sphairon.com> |
| * |
| * Licensed under GPLv2, see file LICENSE in this source tree. |
| */ |
| |
| //usage:#define flashcp_trivial_usage |
| //usage: "-v FILE MTD_DEVICE" |
| //usage:#define flashcp_full_usage "\n\n" |
| //usage: "Copy an image to MTD device\n" |
| //usage: "\n -v Verbose" |
| |
| #include "libbb.h" |
| #include <mtd/mtd-user.h> |
| |
| #define MTD_DEBUG 0 |
| |
| #define OPT_v (1 << 0) |
| |
| #define BUFSIZE (8 * 1024) |
| |
| static void progress(int mode, uoff_t count, uoff_t total) |
| { |
| uoff_t percent; |
| |
| if (!option_mask32) //if (!(option_mask32 & OPT_v)) |
| return; |
| percent = count * 100; |
| if (total) |
| percent = (unsigned) (percent / total); |
| printf("\r%s: %"OFF_FMT"u/%"OFF_FMT"u (%u%%) ", |
| (mode == 0) ? "Erasing block" : ((mode == 1) ? "Writing kb" : "Verifying kb"), |
| count, total, (unsigned)percent); |
| fflush_all(); |
| } |
| |
| static void progress_newline(void) |
| { |
| if (!option_mask32) //if (!(option_mask32 & OPT_v)) |
| return; |
| bb_putchar('\n'); |
| } |
| |
| int flashcp_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE; |
| int flashcp_main(int argc UNUSED_PARAM, char **argv) |
| { |
| int fd_f, fd_d; /* input file and mtd device file descriptors */ |
| int i; |
| uoff_t erase_count; |
| unsigned opts; |
| struct mtd_info_user mtd; |
| struct erase_info_user e; |
| struct stat statb; |
| // const char *filename, *devicename; |
| RESERVE_CONFIG_UBUFFER(buf, BUFSIZE); |
| RESERVE_CONFIG_UBUFFER(buf2, BUFSIZE); |
| |
| opt_complementary = "=2"; /* exactly 2 non-option args: file, dev */ |
| opts = getopt32(argv, "v"); |
| argv += optind; |
| // filename = *argv++; |
| // devicename = *argv; |
| #define filename argv[0] |
| #define devicename argv[1] |
| |
| /* open input file and mtd device and do sanity checks */ |
| fd_f = xopen(filename, O_RDONLY); |
| fstat(fd_f, &statb); |
| fd_d = xopen(devicename, O_SYNC | O_RDWR); |
| #if !MTD_DEBUG |
| if (ioctl(fd_d, MEMGETINFO, &mtd) < 0) { |
| bb_error_msg_and_die("%s is not a MTD flash device", devicename); |
| } |
| if (statb.st_size > mtd.size) { |
| bb_error_msg_and_die("%s bigger than %s", filename, devicename); |
| } |
| #else |
| mtd.erasesize = 64 * 1024; |
| #endif |
| |
| /* always erase a complete block */ |
| erase_count = (uoff_t)(statb.st_size + mtd.erasesize - 1) / mtd.erasesize; |
| /* erase 1 block at a time to be able to give verbose output */ |
| e.length = mtd.erasesize; |
| #if 0 |
| /* (1) bloat |
| * (2) will it work for multi-gigabyte devices? |
| * (3) worse wrt error detection granularity |
| */ |
| /* optimization: if not verbose, erase in one go */ |
| if (!opts) { // if (!(opts & OPT_v)) |
| e.length = mtd.erasesize * erase_count; |
| erase_count = 1; |
| } |
| #endif |
| e.start = 0; |
| for (i = 1; i <= erase_count; i++) { |
| progress(0, i, erase_count); |
| errno = 0; |
| #if !MTD_DEBUG |
| if (ioctl(fd_d, MEMERASE, &e) < 0) { |
| bb_perror_msg_and_die("erase error at 0x%llx on %s", |
| (long long)e.start, devicename); |
| } |
| #else |
| usleep(100*1000); |
| #endif |
| e.start += mtd.erasesize; |
| } |
| progress_newline(); |
| |
| /* doing this outer loop gives significantly smaller code |
| * than doing two separate loops for writing and verifying */ |
| for (i = 1; i <= 2; i++) { |
| uoff_t done; |
| unsigned count; |
| |
| xlseek(fd_f, 0, SEEK_SET); |
| xlseek(fd_d, 0, SEEK_SET); |
| done = 0; |
| count = BUFSIZE; |
| while (1) { |
| uoff_t rem = statb.st_size - done; |
| if (rem == 0) |
| break; |
| if (rem < BUFSIZE) |
| count = rem; |
| progress(i, done / 1024, (uoff_t)statb.st_size / 1024); |
| xread(fd_f, buf, count); |
| if (i == 1) { |
| int ret; |
| errno = 0; |
| ret = full_write(fd_d, buf, count); |
| if (ret != count) { |
| bb_perror_msg_and_die("write error at 0x%"OFF_FMT"x on %s, " |
| "write returned %d", |
| done, devicename, ret); |
| } |
| } else { /* i == 2 */ |
| xread(fd_d, buf2, count); |
| if (memcmp(buf, buf2, count)) { |
| bb_error_msg_and_die("verification mismatch at 0x%"OFF_FMT"x", done); |
| } |
| } |
| |
| done += count; |
| } |
| |
| progress_newline(); |
| } |
| /* we won't come here if there was an error */ |
| |
| return EXIT_SUCCESS; |
| } |