212,7 → 212,7 |
} |
// reset timeout counter on good packet |
SPI0_Timeout = SetDelay(SPI0_TIMEOUT); |
DebugOut.Analog[13]++; |
// DebugOut.Analog[13]++; |
} |
else // bad checksum byte |
{ |
631,8 → 631,9 |
HeadFreeStartAngle = (3600 + Compass_Heading * 10 + GeoMagDec) % 3600; |
CompassDirectionAtMotorStart = HeadFreeStartAngle; |
Compass_Init(); |
FCCalibActive = 10; |
FCCalibActive = 15; |
FC_is_Calibrated = 0; |
FreqNewGpsDataIn5Sec = 50; |
} |
else |
{ |
858,6 → 859,7 |
NaviData_Home.LipoCellCount = FromFlightCtrl.Param.Byte[5]; |
NaviData_Volatile.ShutterCounter = FromFlightCtrl.Param.Int[3]; // 6 & 7 |
LowVoltageLandingActive = FromFlightCtrl.Param.Byte[8]; |
Parameter.FailSafeTime = FromFlightCtrl.Param.Byte[9]; |
// DebugOut.Analog[] = NaviData_Volatile.ShutterCounter; |
// 8 |
// 9 |
921,7 → 923,7 |
}while (!CheckDelay(timeout)); |
UART1_PutString("."); |
repeat++; |
FCCalibActive = 1; |
FCCalibActive = 0; |
}while((FC_Version.Major == 0xFF) && (repeat < 40)); // 40*250ms = 10s |
// if we got it |
if (FC_Version.Major != 0xFF) |