From 817c1bc0b61d9a35422cc9add67d0666ba72aebd Mon Sep 17 00:00:00 2001 From: David Woodhouse Date: Thu, 9 Aug 2007 16:23:56 +0800 Subject: Add utilities for multicast send/receive of MTD images. Signed-off-by: David Woodhouse --- serve_image.c | 191 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 191 insertions(+) create mode 100644 serve_image.c (limited to 'serve_image.c') diff --git a/serve_image.c b/serve_image.c new file mode 100644 index 0000000..b016d63 --- /dev/null +++ b/serve_image.c @@ -0,0 +1,191 @@ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "crc32.h" +#include "mcast_image.h" + +int tx_rate = 80000; +int pkt_delay = 12500 * PKT_SIZE / 1024; + +int main(int argc, char **argv) +{ + struct addrinfo *ai; + struct addrinfo hints; + struct addrinfo *runp; + int ret; + int sock; + struct image_pkt pktbuf; + int rfd; + struct stat st; + int writeerrors = 0; + long usec_per_tick = 1000000 / sysconf(_SC_CLK_TCK); + long delay_accum = 0; + uint32_t erasesize; + unsigned char parbuf[PKT_SIZE]; + unsigned char *image, *blockptr; + uint32_t block_nr; + uint32_t block_ofs; + int nr_blocks; + uint32_t droppoint = -1; + + if (argc == 6) { + tx_rate = atol(argv[5]) * 1024; + if (tx_rate < PKT_SIZE || tx_rate > 20000000) { + fprintf(stderr, "Bogus TX rate %d KiB/s\n", tx_rate); + exit(1); + } + argc = 5; + } + + if (argc != 5) { + fprintf(stderr, "usage: %s []\n", + (strrchr(argv[0], '/')?:argv[0]-1)+1); + exit(1); + } + pkt_delay = (PKT_SIZE * 1000000) / tx_rate; + printf("Inter-packet delay (avg): %dµs\n", pkt_delay); + printf("Transmit rate: %d KiB/s\n", tx_rate / 1024); + + erasesize = atol(argv[4]); + if (!erasesize) { + fprintf(stderr, "erasesize cannot be zero\n"); + exit(1); + } + memset(&hints, 0, sizeof(hints)); + hints.ai_flags = AI_ADDRCONFIG; + hints.ai_socktype = SOCK_DGRAM; + + ret = getaddrinfo(argv[1], argv[2], &hints, &ai); + if (ret) { + fprintf(stderr, "getaddrinfo: %s\n", gai_strerror(ret)); + exit(1); + } + runp = ai; + for (runp = ai; runp; runp = runp->ai_next) { + sock = socket(runp->ai_family, runp->ai_socktype, + runp->ai_protocol); + if (sock == -1) { + perror("socket"); + continue; + } + if (connect(sock, runp->ai_addr, runp->ai_addrlen) == 0) + break; + perror("connect"); + close(sock); + } + if (!runp) + exit(1); + + rfd = open(argv[3], O_RDONLY); + if (rfd < 0) { + perror("open"); + exit(1); + } + + if (fstat(rfd, &st)) { + perror("fstat"); + exit(1); + } + + if (st.st_size % erasesize) { + fprintf(stderr, "Image size %ld bytes is not a multiple of erasesize %d bytes\n", + st.st_size, erasesize); + exit(1); + } + image = mmap(NULL, st.st_size, PROT_READ, MAP_PRIVATE, rfd, 0); + if (image == MAP_FAILED) { + perror("mmap"); + exit(1); + } + + + nr_blocks = st.st_size / erasesize; + + pktbuf.hdr.totcrc = htonl(crc32(-1, image, st.st_size)); + pktbuf.hdr.nr_blocks = htonl(nr_blocks); + pktbuf.hdr.blocksize = htonl(erasesize); + + blockptr = image; + + for (block_nr = 0; block_nr < nr_blocks; block_nr++) { + int len; + int dropped = 0; + + pktbuf.hdr.block_nr = htonl(block_nr); + + for (block_ofs = 0; block_ofs <= erasesize; block_ofs += len) { + int i; + + if (block_ofs + PKT_SIZE > erasesize) + len = erasesize - block_ofs; + else + len = PKT_SIZE; + + if (block_ofs == erasesize) { + printf("\rSending parity block: %08x", block_nr * erasesize); + len = PKT_SIZE; + memcpy(pktbuf.data, parbuf, PKT_SIZE); + } else { + if (!block_ofs) + memcpy(parbuf, blockptr, PKT_SIZE); + else for (i=0; i < len; i++) + parbuf[i] ^= blockptr[i]; + + memcpy(pktbuf.data, blockptr, len); + printf("\rSending data block at %08x", + block_nr * erasesize + block_ofs); + blockptr += len; + } + + fflush(stdout); + pktbuf.hdr.thislen = htonl(len); + pktbuf.hdr.block_ofs = htonl(block_ofs); + pktbuf.hdr.thiscrc = htonl(crc32(-1, pktbuf.data, len)); + + if (droppoint == block_ofs && !dropped) { + dropped = 1; + if (droppoint == 0) + droppoint = erasesize; + else if (droppoint == erasesize) + droppoint = ((erasesize - 1) / PKT_SIZE) * PKT_SIZE; + else droppoint -= PKT_SIZE; + printf("\nDropping data block at %08x\n", block_ofs); + continue; + } + + + if (write(sock, &pktbuf, sizeof(pktbuf.hdr)+len) < 0) { + perror("write"); + writeerrors++; + if (writeerrors > 10) { + fprintf(stderr, "Too many consecutive write errors\n"); + exit(1); + } + } else + writeerrors = 0; + + /* Delay, if we are so far ahead of ourselves that we have at + least one tick to wait. */ + delay_accum += pkt_delay; + if (delay_accum >= usec_per_tick) { + usleep(delay_accum); + delay_accum = 0; + } + } + } + munmap(image, st.st_size); + close(rfd); + close(sock); + printf("\n"); + return 0; +} -- cgit v1.2.3