Colony

#include <dragonfly_lib.h>

#include <wireless.h>

//#include <termios.h>           

#include <stdio.h>

//#include <unistd.h>

#define GROUP 1

#define TYPE 0

#define ACK 1

unsigned char data[4];

sentCount = 0;

char ack = 0;

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

PacketGroupHandler packetHandler = {GROUP, 0, 0, &packet_receive, 0};

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

        //orb_set_color(YELLOW);

        //send to server

        //lcd_clear_screen();

        //lcd_puts("Writing to server");

        usb_putc(packet[0]);

        //lcd_puti(1);

        usb_putc(packet[1]);

        //lcd_puti(2);

        usb_putc(packet[2]);

        //lcd_puti(3);

        usb_putc(packet[3]);

        //lcd_puti(4);

        //lcd_clear_screen();

        //lcd_puts("Reading from server");

        //Read in from server

        data[0] = usb_getc(); 

        //lcd_puti(1);

        data[1] = usb_getc();

        //lcd_puti(2);

        data[2] = usb_getc();

        //lcd_puti(3);

        data[3] = usb_getc();

        //lcd_puti(4);

        wl_send_global_packet(GROUP, TYPE, data, 4, 0);

        //lcd_clear_screen();

        //lcd_puts("Sent ");

        //lcd_puti(sentCount);

        //sentCount++;

        //orb_set_color(GREEN);

}

int main (void) {

          //dragonfly_init(SERIAL | USB | COMM | ORB | ANALOG | MOTORS | BUZZER);

        dragonfly_init(ALL_ON);

        wl_init();

        lcd_init();

        lcd_puts("S");

//        orb_set_color(RED);

//          wl_register_packet_group(&packetHandler);

  //      orb_set_color(YELLOW);        

        //Read in from server

//        delay_ms(1000);

        lcd_puts("starting init");

        data[0] = usb_getc(); 

        //motor1_set(0,200);

        data[1] = usb_getc();

        //motor2_set(0,200);

        data[2] = usb_getc();

        //motor1_set(1,200);

        data[3] = usb_getc();

        lcd_puts("Done with init\n");

        wl_register_packet_group(&packetHandler);

        //motor2_set(1,200);

//        orb_set_color(PURPLE);

        //packet_receive(TYPE, 0, data, 4);

        wl_send_global_packet(GROUP, TYPE, data, 4, 0);

        lcd_clear_screen();

        lcd_puts("Sent first wireless Packet");

        sentCount++;

//        orb_set_color(GREEN);

  while (1) {

         // char vel[4] = {170, 0, 170, 1};

         // wl_send_global_packet(GROUP, TYPE, vel, 4, 0);          

          wl_do();

  }

}