--- embedtools/src/imgupd.c 2014/02/06 00:56:16 1.6.2.3 +++ embedtools/src/imgupd.c 2014/02/06 14:22:43 1.6.2.6 @@ -3,7 +3,7 @@ * by Michael Pounov * * $Author: misho $ - * $Id: imgupd.c,v 1.6.2.3 2014/02/06 00:56:16 misho Exp $ + * $Id: imgupd.c,v 1.6.2.6 2014/02/06 14:22:43 misho Exp $ * ************************************************************************* The ELWIX and AITNET software is distributed under the following @@ -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, fromBegin; -int Verbose, bufSize = IMGBUF_SIZE; +int Verbose, nameFlg, fileFlg, bufSize = IMGBUF_SIZE; extern char compiled[], compiledby[], compilehost[]; static void @@ -70,15 +71,49 @@ 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[bufSize]; ssize_t wlen; VERB(1) printf("Erase store %s\n", imgName); - if (!fromBegin) { + if (!fromBegin && flg & FD_SEEK) { iSize = lseek(img, 0, SEEK_END); if (iSize == -1) { ESYSERR(0); @@ -92,36 +127,42 @@ EmptyStore(int img) for (i = howmany(iSize, bufSize); i < howmany(imgSize, bufSize); i++) if ((wlen = write(img, buf, bufSize)) == -1 || (wlen && wlen != bufSize)) { - EERROR(EIO, "Error at chunk %d init %d bytes, " - "should be %u\n", i, wlen, bufSize); + if (wlen == -1) + ESYSERR(0); + else + EERROR(EIO, "Error at chunk %d init %d bytes, " + "should be %u\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[bufSize]; - 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, bufSize); i < howmany(imgSize, bufSize); i++, j++) { memset(buf, 0, sizeof buf); - rlen = read(fd, buf, bufSize); - 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 %d bytes for chunk #%d\n", rlen, j); + } wlen = write(img, buf, bufSize); if (wlen == -1) { @@ -189,22 +230,32 @@ 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, bufSize); - 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", + iSize, 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); @@ -213,12 +264,12 @@ 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", @@ -232,7 +283,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); @@ -242,42 +294,54 @@ 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, bufSize); - 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", + iSize, 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 (EmptyStore(fd, fileFlg) == -1) { if (fd > 2) close(fd); close(img); return 3; } - if (FillStore(fd, img) == -1) { + if (FillStore(fd, fileFlg, img, nameFlg) == -1) { if (fd > 2) close(fd); close(img);