#include "gyroscope.hpp"

void setup()
{
	Serial.begin(9600);

	Serial.println("Hej!");

	auto gyroscope_id = Gyroscope::initialize();

	if (gyroscope_id == -1)
	{
		Serial.println("Failed to communicate with gyrosensor!");
		exit(1);
	}

	Gyroscope gyroscope(gyroscope_id);
}

void loop()
{
	//auto gyroscope_data = read();

	//char *out;
	//sprintf(out, "X: %d  Y: %d  Z: %d", gyroscope_data.x, gyroscope_data.y, gyroscope_data.z);

	// Serial.println("hej!");
}