/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 |