Colony

#include <dragonfly_lib.h>

#include <stdlib.h>

#include <eeprom.h>

int main()

{

  char str[5];

  int i=0,id,ir_offset;

  char c;

  dragonfly_init(ALL_ON);

  usb_puts("Here is the current setup:\r\n  ID: ");

  itoa(get_robotid(), str, 10);

  usb_puts(str);

  usb_puts("\r\n  BOM type: ");

  itoa(get_bom_type(), str, 10);

  usb_puts(str);

  usb_puts("\r\n  IR Offset: ");

  itoa(get_ir_offset(), str, 10);

  usb_puts(str);

  usb_puts("\r\n\r\nEnter new ID:");

  while((c = usb_getc()) != '\n' && c != '\r')

    {

      usb_putc(c);

      if(i>=4)

        {

          usb_puts("ERROR: filled buffer\n");

          while(1);

        }

      str[i++] = c;

    }

  while(i<5)

    str[i++] = 0;

  id = atoi(str);

  usb_puts("\r\nsetting new id to: ");

  usb_puti(id);

  eeprom_put_byte(EEPROM_ROBOT_ID_ADDR, 'I');

  eeprom_put_byte(EEPROM_ROBOT_ID_ADDR+1, 'D');

  eeprom_put_byte(EEPROM_ROBOT_ID_ADDR+2, id);

  usb_puts("\r\nEnter BOM type:\r\b"

           "1 for BOM 1.0\r\n"

           "5 for BOM 1.5\r\n"

           "r for RBOM\r\n>");

  c = usb_getc();

  usb_putc(c);

  switch(c)

    {

    case '1': id = BOM10; break;

    case '5': id = BOM15; break;

    case 'r': id = RBOM; break;

    default:

      usb_puts("ERROR: invalid input");

      while(1);

    }

  eeprom_put_byte(EEPROM_BOM_TYPE_ADDR, 'B');

  eeprom_put_byte(EEPROM_BOM_TYPE_ADDR+1, 'O');

  eeprom_put_byte(EEPROM_BOM_TYPE_ADDR+2, 'M');

  eeprom_put_byte(EEPROM_BOM_TYPE_ADDR+3, id);

  usb_puts("\r\n\r\nEnter new IR Offset:");

  i = 0;

  while((c = usb_getc()) != '\n' && c != '\r')

    {

      usb_putc(c);

      if(i>=4)

      {

        usb_puts("ERROR: filled buffer\n");

        while(1);

      }

      str[i++] = c;

    }

  while(i<5)

    str[i++] = 0;

  ir_offset = atoi(str);

  usb_puts("\r\nsetting new IR_offset to: ");

  usb_puti(ir_offset);

  eeprom_put_byte(EEPROM_IR_OFFSET_ADDR, 'I');

  eeprom_put_byte(EEPROM_IR_OFFSET_ADDR+1, 'R');

  eeprom_put_byte(EEPROM_IR_OFFSET_ADDR+2, ir_offset);

  usb_puts("\r\ndone! have a nice day\r\n");

  while(1);

  return 0;

}