Test voor kompas

//Bij defines:
#define CMPS03 0x60

/*
* Test kompas
*/

verzenden(CMPS03, 1);   //verzend een 1 naar de slave
for(uint8_t i=0;i<8;i++) _delay_ms(250); //Delay

ontvangen(CMPS03,data,1);     //ontvang 1 byte van slave
double kompasdata = ((double)data[0]*1.407); //Omrekenen naar grade
writeString("\n\rkompaswaarde: "); writeInteger((uint16_t)kompasdata,10);
for(uint8_t i=0;i<8;i++) _delay_ms(250);