67,7 → 67,7 |
/*********************************************/ |
/* Initialize Interface to MM3 Compass */ |
/*********************************************/ |
void MM3_init(void) |
void MM3_Init(void) |
{ |
uint8_t sreg = SREG; |
|
114,7 → 114,7 |
/*********************************************/ |
/* Get Data from MM3 */ |
/*********************************************/ |
void MM3_timer0() // called every 102.4 ms by timer 0 ISR |
void MM3_Update() // called every 102.4 ms by timer 0 ISR |
{ |
switch (MM3.STATE) |
{ |
202,7 → 202,7 |
/*********************************************/ |
/* Calibrate Compass */ |
/*********************************************/ |
void MM3_calibrate(void) |
void MM3_Calibrate(void) |
{ |
int16_t x_min = 0, x_max = 0, y_min = 0, y_max = 0, z_min = 0, z_max = 0; |
uint8_t measurement = 50, beeper = 0; |
263,7 → 263,7 |
/*********************************************/ |
/* Calculate north direction (heading) */ |
/*********************************************/ |
int16_t MM3_heading(void) |
int16_t MM3_Heading(void) |
{ |
int32_t sin_pitch, cos_pitch, sin_roll, cos_roll, sin_yaw, cos_yaw; |
int32_t Hx, Hy, Hz, Hx_corr, Hy_corr; |