#include <Wire.h>
#include <LiquidCrystal_I2C.h>
#include "xbee_wrapper.h"
#include "packet.h"

#define WAVE_TIMEOUT 5000

// Peripherals
LiquidCrystal_I2C screen(0x20, 16, 2);
XBeeWrapper xbee = XBeeWrapper();

// ACTUAL DATA
uint8_t wave_id = 250;
Packet send;

void setup() {
	Serial.begin(38400);
	Serial.println("+ ready");

	screen.begin();
	screen.backlight();
	screen.home();
	screen.setCursor(0,0);
	screen.print("ready");

	xbee.begin(38400);
}

void loop() {

	delay(WAVE_TIMEOUT);

	screen.clear();
	screen.print("+ wave");
	screen.print(wave_id+1);

	// increment wave id (will overflow from 255 to 0)
	send.setOpcode(0);
	send.setWave(++wave_id);
	send.setDist(0);
	send.setSender(42);

	if( xbee.broadcast(send) == XBWSEND_OK )
		Serial.println("sent");
	else
		Serial.println("failed");

}