|
- #include <stdlib.h>
- #include <stdio.h>
- #include <fcntl.h>
- #include <unistd.h>
-
- #include "common.h"
-
- /* Push specified file to specified device running Forth and verify
- * that the sent contents is correct.
- */
-
- int main(int argc, char **argv)
- {
- if (argc != 4) {
- fprintf(stderr, "Usage: ./upload device memptr fname\n");
- return 1;
- }
- unsigned int memptr = strtol(argv[2], NULL, 16);
- FILE *fp = fopen(argv[3], "r");
- if (!fp) {
- fprintf(stderr, "Can't open %s.\n", argv[3]);
- return 1;
- }
- fseek(fp, 0, SEEK_END);
- unsigned int bytecount = ftell(fp);
- fprintf(stderr, "memptr: 0x%04x bytecount: 0x%04x.\n", memptr, bytecount);
- if (!bytecount) {
- // Nothing to read
- fclose(fp);
- return 0;
- }
- if (memptr+bytecount > 0xffff) {
- fprintf(stderr, "memptr+bytecount out of range.\n");
- fclose(fp);
- return 1;
- }
- rewind(fp);
- int fd = ttyopen(argv[1]);
- if (fd < 0) {
- fprintf(stderr, "Could not open %s\n", argv[1]);
- return 1;
- }
- char s[0x40];
- sendcmdp(fd, ": K KEY DUP EMIT ;");
- // P: parse digit. We assume '0-9' or 'a-f' range and return a 0-15 value.
- sendcmdp(fd, ": P DUP '0' '9' =><= IF '0' ELSE 0x57 THEN - ;");
- // R: receive hex pairs. we receive values in hex pairs, re-emit them upon
- // reception, and then write them to memory.
- sprintf(s,
- ": R %d %d DO K P 16 * K P OR I C! LOOP ; R",
- memptr+bytecount, memptr);
- sendcmd(fd, s);
-
- int returncode = 0;
- while (fread(s, 1, 1, fp)) {
- unsigned char c1, c2;
- c1 = s[0];
- sprintf(s, "%02x", c1);
- for (int i=0; i<2; i++) {
- c1 = s[i];
- write(fd, &c1, 1);
- usleep(1000); // let it breathe
- mread(fd, &c2, 1); // read ping back
- if (c1 != c2) {
- // mismatch!
- unsigned int pos = ftell(fp);
- fprintf(stderr, "Mismatch at byte %d! %d != %d.\n", pos, c1, c2);
- // we don't exit now because we need to "consume" our whole program.
- returncode = 1;
- }
- }
- putc('.', stderr);
- fflush(stderr);
- }
- readprompt(fd);
- sendcmdp(fd, "FORGET K");
- fprintf(stderr, "Done!\n");
- fclose(fp);
- if (fd > 0) {
- close(fd);
- }
- return returncode;
- }
|