--- embedtools/src/imgupd.c 2014/02/05 22:00:29 1.3 +++ embedtools/src/imgupd.c 2017/06/28 15:19:32 1.8 @@ -3,7 +3,7 @@ * by Michael Pounov * * $Author: misho $ - * $Id: imgupd.c,v 1.3 2014/02/05 22:00:29 misho Exp $ + * $Id: imgupd.c,v 1.8 2017/06/28 15:19:32 misho Exp $ * ************************************************************************* The ELWIX and AITNET software is distributed under the following @@ -12,7 +12,7 @@ terms: All of the documentation and software included in the ELWIX and AITNET Releases is copyrighted by ELWIX - Sofia/Bulgaria -Copyright 2004 - 2014 +Copyright 2004 - 2017 by Michael Pounov . All rights reserved. Redistribution and use in source and binary forms, with or without @@ -44,11 +44,12 @@ OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF TH SUCH DAMAGE. */ #include "global.h" +#include "imgupd.h" char imgName[PATH_MAX], imgFile[PATH_MAX]; -off_t imgSize, iSize; -int Verbose; +off_t imgSize, iSize, fromBegin; +int Verbose, nameFlg, fileFlg, bufSize = IMGBUF_SIZE; extern char compiled[], compiledby[], compilehost[]; static void @@ -59,6 +60,8 @@ Usage() "=== %s === %s@%s ===\n\n" " Syntax: imgupd [options] [image_file]\n\n" "\t-v\t\tVerbose ...\n" + "\t-R\t\tReboot system after complete\n" + "\t-i\t\tStart fill storage from begin\n" "\t-g\t\tGet image from Storage\n" "\t-t\t\tTruncate Storage file name\n" "\t-s \tStorage size (required for stdin)\n" @@ -67,65 +70,108 @@ Usage() } static int -EmptyStore(int img) +getFDtype(int fd) { + int type, flg = 0; + struct stat sb; + + if (fstat(fd, &sb) == -1) { + ESYSERR(0); + return -1; + } + if (S_ISREG(sb.st_mode)) + flg |= FD_TRUNC; + if (S_ISCHR(sb.st_mode) || S_ISBLK(sb.st_mode)) { + if (ioctl(fd, FIODTYPE, &type) == -1) { + ESYSERR(0); + return -1; + } + if (type & D_TAPE) + flg |= FD_TAPE; + else if (type & (D_DISK | D_MEM)) + flg |= FD_SEEK; + if (S_ISCHR(sb.st_mode) && !(type & D_TAPE)) + flg |= FD_CHR; + goto end; + } + errno ^= errno; + if (lseek(fd, 0, SEEK_CUR) == -1 && errno == ESPIPE) + flg |= FD_PIPE; + else + flg |= FD_SEEK; +end: + return flg; +} + +static int +EmptyStore(int img, int flg) +{ register int i; - u_char buf[IMGBUF_SIZE]; + u_char buf[bufSize]; ssize_t wlen; VERB(1) printf("Erase store %s\n", imgName); - iSize = lseek(img, 0, SEEK_END); - if (iSize == -1) { - ESYSERR(0); - return -1; + if (!fromBegin && flg & FD_SEEK) { + iSize = lseek(img, 0, SEEK_END); + if (iSize == -1) { + ESYSERR(0); + return -1; + } else + imgSize += E_ALIGN(iSize, bufSize); } else - imgSize += E_ALIGN(iSize, IMGBUF_SIZE); + iSize ^= iSize; memset(buf, 0, sizeof buf); - for (i = howmany(iSize, IMGBUF_SIZE); i < howmany(imgSize, IMGBUF_SIZE); i++) - if ((wlen = write(img, buf, sizeof buf)) == -1 || - wlen != sizeof buf) { - EERROR(EIO, "Error at chunk %d init %d bytes, should be %u\n", - i, wlen, sizeof buf); + for (i = howmany(iSize, bufSize); i < howmany(imgSize, bufSize); i++) + if ((wlen = write(img, buf, bufSize)) == -1 || + (wlen && wlen != bufSize)) { + if (wlen == -1) + ESYSERR(0); + else + EERROR(EIO, "Error at chunk %d init %zd bytes, " + "should be %d\n", i, wlen, bufSize); return -1; } else VERB(1) printf("+Written chunk #%d\n", i); - iSize = lseek(img, iSize, SEEK_SET); + if (flg & FD_SEEK) + iSize = lseek(img, iSize, SEEK_SET); return iSize; } static int -FillStore(int img, int fd) +FillStore(int img, int iflg, int fd, int fflg) { register int i, j; - u_char buf[IMGBUF_SIZE]; - ssize_t rlen, wlen; + u_char *pos, buf[bufSize]; + ssize_t rlen, wlen, len; VERB(1) printf("Fill store %s from image file %s\n", imgName, imgFile); - for (j = 0, i = howmany(iSize, IMGBUF_SIZE); i < howmany(imgSize, IMGBUF_SIZE); + for (j = 0, i = howmany(iSize, bufSize); i < howmany(imgSize, bufSize); i++, j++) { memset(buf, 0, sizeof buf); - rlen = read(fd, buf, sizeof buf); - if (rlen == -1) { - ESYSERR(0); - return -1; - } else if (!rlen) - break; - else - VERB(1) printf("+Readed %d bytes for chunk #%d\n", rlen, j); + for (len = bufSize, pos = buf; len > 0; len -= rlen, pos += rlen) { + rlen = read(fd, pos, len); + if (rlen == -1) { + ESYSERR(0); + return -1; + } else if (!rlen) + break; + else + VERB(1) printf("+Readed %zd bytes for chunk #%d\n", rlen, j); + } - wlen = write(img, buf, rlen); + wlen = write(img, buf, bufSize); if (wlen == -1) { ESYSERR(0); return -1; - } else if (!wlen || wlen != rlen) { - EERROR(EIO, "Readed %d bytes are not equal to written %d bytes\n", - rlen, wlen); + } else if (wlen && wlen != bufSize) { + EERROR(EIO, "Error at chunk %d written %zd bytes, " + "should be %u\n", i, wlen, bufSize); } else - VERB(1) printf("+Written %d bytes at chunk #%d\n", wlen, i); + VERB(1) printf("+Written %zd bytes at chunk #%d\n", wlen, i); } return 0; @@ -134,10 +180,10 @@ FillStore(int img, int fd) int main(int argc, char **argv) { - char ch, m = 0; + char ch, m = 0, R = 0; int fd, img, tr = 0; - while ((ch = getopt(argc, argv, "hvgts:f:")) != -1) + while ((ch = getopt(argc, argv, "hvRigts:f:")) != -1) switch (ch) { case 'f': strlcpy(imgName, optarg, sizeof imgName); @@ -154,7 +200,12 @@ main(int argc, char **argv) break; case 'g': m = 1; + case 'i': + fromBegin = 1; break; + case 'R': + R = 1; + break; case 'v': Verbose++; break; @@ -175,22 +226,33 @@ main(int argc, char **argv) ESYSERR(0); return 2; } else + fileFlg = getFDtype(fd); + + if (fileFlg & FD_SEEK) { iSize = lseek(fd, 0, SEEK_END); - if (!imgSize) - imgSize = E_ALIGN(iSize, IMGBUF_SIZE); - if (iSize == -1 || iSize > imgSize) { + if (!imgSize) + imgSize = E_ALIGN(iSize, bufSize); + if (iSize == -1 || iSize > imgSize) { + close(fd); + EERROR(ENOSPC, "Error:: file size %llu is " + "greater from storage size %llu\n", + (unsigned long long) iSize, + (unsigned long long) imgSize); + return 2; + } else + lseek(fd, 0, SEEK_SET); + } + } else { + fd = STDIN_FILENO; + fileFlg = getFDtype(fd); + } + + if (!imgSize) { + if (fd > 2) close(fd); - EERROR(ENOSPC, "Error:: file size %llu is " - "greater from storage size %llu\n", - iSize, imgSize); - return 2; - } else - lseek(fd, 0, SEEK_SET); - } else if (!imgSize) { Usage(); return 1; - } else - fd = STDIN_FILENO; + } } else { /* GET */ if (argc) { strlcpy(imgFile, *argv, sizeof imgFile); @@ -199,16 +261,16 @@ main(int argc, char **argv) if (fd == -1) { ESYSERR(0); return 2; - } - } else if (!imgSize) { - Usage(); - return 1; - } else + } else + fileFlg = getFDtype(fd); + } else { fd = STDOUT_FILENO; + fileFlg = getFDtype(fd); + } } VERB(1) printf("imgSize=%llu imgName=%s imgFile=%s\n", - imgSize, imgName, argc ? imgFile : ""); + (unsigned long long) imgSize, imgName, argc ? imgFile : ""); if (!m) { /* open storage device */ @@ -218,7 +280,8 @@ main(int argc, char **argv) if (fd > 2) close(fd); return 3; - } + } else + nameFlg = getFDtype(img); } else { /* GET */ /* open storage device */ img = open(imgName, O_RDONLY); @@ -228,45 +291,59 @@ main(int argc, char **argv) close(fd); return 3; } else + nameFlg = getFDtype(img); + + if (nameFlg & FD_SEEK) { iSize = lseek(img, 0, SEEK_END); - if (!imgSize) - imgSize = E_ALIGN(iSize, IMGBUF_SIZE); - if (iSize == -1 || iSize > imgSize) { + if (!imgSize) + imgSize = E_ALIGN(iSize, bufSize); + if (iSize == -1 || iSize > imgSize) { + if (fd > 2) + close(fd); + close(img); + EERROR(ENOSPC, "Error:: storage size %llu is " + "greater from file size %llu\n", + (unsigned long long) iSize, + (unsigned long long) imgSize); + return 3; + } else + lseek(img, 0, SEEK_SET); + } + + if (!imgSize) { if (fd > 2) close(fd); - close(img); - EERROR(ENOSPC, "Error:: storage size %llu is " - "greater from file size %llu\n", - iSize, imgSize); - return 3; - } else - lseek(img, 0, SEEK_SET); + Usage(); + return 1; + } } if (!m) { - if (EmptyStore(img) == -1) { + if (EmptyStore(img, nameFlg) == -1) { if (fd > 2) close(fd); close(img); return 3; } - if (FillStore(img, fd) == -1) { + if (FillStore(img, nameFlg, fd, fileFlg) == -1) { if (fd > 2) close(fd); close(img); return 4; } } else { /* GET */ - if (EmptyStore(fd) == -1) { + iSize ^= iSize; + if (!(fileFlg & FD_PIPE)) + if (EmptyStore(fd, fileFlg) == -1) { + if (fd > 2) + close(fd); + close(img); + return 3; + } + if (FillStore(fd, fileFlg, img, nameFlg) == -1) { if (fd > 2) close(fd); close(img); - return 3; - } - if (FillStore(fd, img) == -1) { - if (fd > 2) - close(fd); - close(img); return 4; } } @@ -274,5 +351,8 @@ main(int argc, char **argv) close(img); if (fd > 2) close(fd); + + if (R) + reboot(RB_AUTOBOOT); return 0; }