SPARKZumo.ino

#include <Wire.h>

#define YELLOW_LED  (13)

extern "C" {
	#include <b__sparkzumo.h>
	#include <sparkzumo.h>		

	void __gnat_last_chance_handler(void* msg, int line)
	{
		__gnat_last_chance_handler_impl (msg, __FILE__, __func__, __LINE__);
	}

	void __gnat_last_chance_handler_impl(void* msg, const char* file, const char* func, int line)
	{
		Serial.println("Exception(");
		Serial.print(file);
		Serial.print(":");
		Serial.print(func);
		Serial.print(":");
		Serial.print(line);
		Serial.print("): ");
		Serial.println((char*)msg);


		sparkzumo__exception_handler();		
	}

#ifdef ARDUINO_ARCH_AVR
	void sei_wrapper() 
	{ sei(); }
#endif
}

void Serial_Print(void* msg) 
{ 
	Serial.println(reinterpret_cast<char*>(msg));
}

void Serial_Print_Byte(void* msg, uint8_t val) 
{ 
	Serial.print(reinterpret_cast<char*>(msg));
	Serial.print(": ");
	Serial.println(val);
}

void Serial_Print_Short(void* msg, int16_t val) 
{ 
	Serial.print(reinterpret_cast<char*>(msg));
	Serial.print(": ");
	Serial.println(val);
}

void Serial_Print_Float(void* msg, float val) 
{ 
	Serial.print(reinterpret_cast<char*>(msg));
	Serial.print(": ");
	Serial.println(val);
}

void Serial_Print_Calibration(int i, int min, int max)
{
	Serial.print(i);
	Serial.print(" - ");
	Serial.print("Max: ");
	Serial.print(max);
	Serial.print("  Min: ");
	Serial.println(min);
}

void Wire_Begin_Master(void)
{ Wire.begin(); }

void Wire_Begin_Slave(uint8_t addr)
{ Wire.begin(addr); }

byte Wire_RequestFrom(uint8_t addr, uint8_t quant, uint8_t stop)
{ return Wire.requestFrom(addr, quant, stop); }

void Wire_BeginTransmission(uint8_t addr)
{ Wire.beginTransmission(addr); }

byte Wire_EndTransmission(uint8_t stop)
{ return Wire.endTransmission(stop); }

byte Wire_Write_Value(uint8_t val)
{ return Wire.write(val); }

int Wire_Available(void)
{ return Wire.available(); }

byte Wire_Read(void)
{ return Wire.read(); }

void Wire_SetClock(uint32_t freq)
{ Wire.setClock(freq); }


void setup() 
{	
	Serial.begin(115200);		
	sparkzumoinit();
	sparkzumo__setup();
}

void loop() 
{
	sparkzumo__workloop();
}