204,8 → 204,8 |
roll = AccAttitudeRoll; |
break; |
default: |
nick_rad = 0; |
roll_rad = 0; |
nick = 0; |
roll = 0; |
break; |
} |
|
280,12 → 280,12 |
if((blinkcount + 1 ) >= (2 * cal)) |
{ |
blinkcount = 0; |
Led_Timer = SetDelay(1000); |
Led_Timer = SetDelay(1500); |
} |
else |
{ |
blinkcount++; |
Led_Timer = SetDelay(170); |
Led_Timer = SetDelay(100); |
} |
} |
} |
293,7 → 293,6 |
{ |
if(invert_blinking) LED_GRN_ON; else LED_GRN_OFF; |
} |
|
// calibration state machine |
switch(cal) |
{ |
395,7 → 394,8 |
DebugOut.Analog[11] = Calibration.MagY.Range; |
DebugOut.Analog[12] = Calibration.MagZ.Offset; |
DebugOut.Analog[13] = Calibration.MagZ.Range; |
DebugOut.Analog[14] = ExternData.CalState; |
if(I2C_WriteCal.CalByte) DebugOut.Analog[14] = I2C_WriteCal.CalByte; |
else DebugOut.Analog[14] = ExternData.CalState; |
DebugOut.Analog[15] = Heading; |
DebugOut.Analog[16] = ExternData.UserParam[0]; |
DebugOut.Analog[17] = ExternData.UserParam[1]; |