Colony

/* robotWirelessRelay

 *

 * Eugene Marinelli

 * 1/25/07

 */

/* Includes */

#include <stdio.h>

#include <string.h>

#include <firefly+_lib.h>

#include "pindefs_ff.h"

//#include "wl_adhoc.h"

void init_hardware(void);

int main(void){

  char wl_buf = 0;

  char serial_buf = 0;

  init_hardware();

  orb_set_color(GREEN);

  UCSR0B |= _BV(RXCIE);

  sei();

  while (1) {

          /* Relay serial data to wireless */

    serial_buf = serial1_getchar();

    serial_putchar(serial_buf);

    //lcd_putchar(serial_buf);

    orb_set_color(YELLOW);

          //serial_buf = 0;

  }

  return 0;

}

void init_hardware(){

  motors_init();

  orb_init();

  led_init();

  analog_init();

  serial_init(BAUD115200);

  serial1_init(BAUD115200);

  //serial1_init(BAUD9600);

  lcd_init();

  fdevopen(&serial1_putchar, &serial1_getchar);

}

ISR(USART0_RX_vect)

{

  char wl_buf;

  wl_buf = UDR0;

  /* Received wireless byte - relay to computer */

  //printf("%c", wl_buf);

  serial1_putchar(wl_buf);

  orb_set_color(RED);

}