Diag rom now runs from bootloader!

[fpgaboy.git] / binwire.c

#include <stdio.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <stdlib.h>
#include <poll.h>

void dowrite(char *s, int len)
{
  int i;
  for (i=0; i<len; i++)
  {
    write(1, s+i, 1);
  }
}

int waitchar(int timeout)
{
  struct pollfd pfd;
  
  pfd.fd = 0;
  pfd.events = POLLIN;
  return poll(&pfd, 1, timeout) == 1;
}

void expect(char *s, int len)
{
  int i;
  char c;
  for (i=0; i < len; i++)
  {
    if (waitchar(100) == 0)
    {
      fprintf(stderr, "Timeout reached in expect (expected %c)\n", s[i]);
      return;
    }
    while (read(0, &c, 1) == 0)
      fprintf(stderr, "Short read...\n");
    if (c != s[i])
      fprintf(stderr, "Expect failed: expected %d, got %d (pos %d)\n", s[i], c, i);
  }
}

void expect_no_chars()
{
  int cs = 0;
  
  while (waitchar(100) == 1)
  {
    char c;
    if (read(0, &c, 1) == 0)
      fprintf(stderr, "enc Short read...\n");
    cs++;
    fprintf(stderr, "Warning: expected no chars, got %d\n", c);
  }
  if (cs)
    fprintf(stderr, "Expect no chars failed: got %d chars\n", cs);
  
  
}

void main(int argc, char **argv)
{
  unsigned char buf[259];
  int sz;
  int rfd;
  
  if (argc < 2)
  {
    fprintf(stderr, "Usage: %s [filename]\n", argv[0]);
    exit(1);
  }
  rfd = open(argv[1], O_RDONLY);
  if (rfd < 0)
  {
    perror("open");
    exit(1);
  }
  
  dowrite("\x1B" "A\x00\x00\x00", 5);
  fprintf(stderr, "Address sent\n");
  expect("A", 1);
  expect_no_chars();
  while ((sz = read(rfd, buf+3, 255)) > 0)
  {
    buf[0] = 0x1B;
    buf[1] = 'D';
    buf[2] = sz+1;
    dowrite(buf, sz + 3);
    fprintf(stderr, "Data sent\n");
    expect("D", 1);
    expect_no_chars();
  }
  exit(0);
}