Colony

/*

Eugene Marinelli

7/22/06

*/

/* Includes */

#include <stdio.h>

#include <string.h>

#include <firefly+_lib.h>

#include "pindefs_ff.h"

#include <wireless.h>

void init_hardware(void);

/* Main */

int main(void){

  char buf[80];

  char src, dest;

  init_hardware();

  wl_init(15,1);

  orb_set_color(BLUE);

  while(1){

    if(wl_recv(buf, &src, &dest)){

      printf("%s", buf);

      orb_set_color(RED);

    }else{

      printf(".");

      orb_set_color(BLUE);

    }

    wl_send("ABC", 200);

    delay_ms(500);

  }

  return 0;

}

void init_hardware(){

  motors_init();

  orb_init();

  led_init();

  analog_init();

  serial_init(BAUD9600);

  serial1_init(BAUD115200);

  lcd_init();

  fdevopen(&serial1_putchar, &serial1_getchar);

}