Subversion Repositories NaviCtrl

Compare Revisions

Ignore whitespace Rev 130 → Rev 131

/trunk/GPS.c
498,7 → 498,6
// of min 8*1.11cm * 5Hz = 8.88 = 44.4cm/s an max 127*1.11cm *5Hz = 705cm/s
GPS_HoldPosition.Latitude += (s32)(cos_h*FC.StickNick + sin_h*FC.StickRoll);
GPS_HoldPosition.Longitude += (s32)((sin_h*FC.StickNick - cos_h*FC.StickRoll) / cos(RadiansFromGPS(GPS_HoldPosition.Latitude)) );
GPS_HoldPosition.Status = NEWDATA;
}
GPS_pTargetPosition = &GPS_HoldPosition;
GPS_TargetRadius = 100; // 1 meter