Colony

#include "lbomtest.h"

#include "orbtest.h"

#include "testhoming.h"

#include "bayboard_lib.h"

#include<stdio.h>

#include<stdlib.h>

#include <i2c.h>

#include "../libbayboard/orb.h"

#include <avr/interrupt.h>

#include "../libwireless/lib/wireless.h"

#include "../libwireless/lib/wl_token_ring.h"

void colonet_receive (char type, int source, unsigned char* packet,int length);

volatile int red;

volatile int blue;

volatile int green;

int main(void){

    red=255;

    blue=0;

    green=0;

    bayboard_init(ALL_ON);

    set_orb(255,255,255);

        wl_init();

    PacketGroupHandler colonetHandler = {7, NULL, NULL, &colonet_receive, NULL};

  wl_register_packet_group(&colonetHandler);

    while(1){

          wl_send_global_packet(7, 'a', NULL, 0, 0);

        wl_do();}

}

void colonet_receive (char type, int source, unsigned char* packet,int length)

{

  switch (type)

  {

    case 'a':

        if(red == 255){

            blue = 255;

            red = 0;

            green = 0;

        }

        else if(blue == 255){

            green = 255;

            red = 0;

            blue = 0;

        }

        else if(green ==255){

            red =255;

            green =0;

            blue =0;

        }

        set_orb(red, green, blue);

                delay_ms(2000);

        wl_send_global_packet(7, 'a', NULL, 0, 0);

                wl_do();

  }

}