Subversion Repositories FlightCtrl

Compare Revisions

Ignore whitespace Rev 2086 → Rev 2087

/branches/dongfang_FC_rewrite/attitude.c
450,8 → 450,8
int32_t correction = (error * staticParams.compassYawCorrection) >> 8;
//debugOut.analog[30] = correction;
 
debugOut.digital[0] = &= ~DEBUG_COMPASS;
debugOut.digital[1] = &= ~DEBUG_COMPASS;
debugOut.digital[0] &= ~DEBUG_COMPASS;
debugOut.digital[1] &= ~DEBUG_COMPASS;
 
if (correction > 0) {
debugOut.digital[0] ^= DEBUG_COMPASS;
/branches/dongfang_FC_rewrite/directGPSNaviControl.c
277,13 → 277,13
if (navi_testOscTimer == staticParams.naviTestOscPeriod) {
navi_testOscTimer = 0;
if (staticParams.naviTestOscAmplitude) {
holdPosition->status = NEWDATA;
holdPosition->latitude += staticParams.naviTestOscAmplitude * 90L;
holdPosition.status = NEWDATA;
holdPosition.latitude += staticParams.naviTestOscAmplitude * 90L;
}
} else if (navitestOscTimer == staticParams.naviTestOscPeriod/2) {
} else if (navi_testOscTimer == staticParams.naviTestOscPeriod/2) {
if (staticParams.naviTestOscAmplitude) {
holdPosition->status = NEWDATA;
holdPosition->latitude -= staticParams.naviTestOscAmplitude * 90L;
holdPosition.status = NEWDATA;
holdPosition.latitude -= staticParams.naviTestOscAmplitude * 90L;
}
}
}