Browse Source

AP_Common: make angles in degrees end in _deg

to make it obvious it is not radians
zr-v5.1
Andrew Tridgell 4 years ago
parent
commit
71f207403e
  1. 14
      libraries/AP_Common/Location.cpp
  2. 4
      libraries/AP_Common/Location.h

14
libraries/AP_Common/Location.cpp

@ -259,20 +259,20 @@ void Location::offset(float ofs_north, float ofs_east) @@ -259,20 +259,20 @@ void Location::offset(float ofs_north, float ofs_east)
* positions, so it keeps the accuracy even when dealing with small
* distances and floating point numbers
*/
void Location::offset_bearing(float bearing, float distance)
void Location::offset_bearing(float bearing_deg, float distance)
{
const float ofs_north = cosf(radians(bearing)) * distance;
const float ofs_east = sinf(radians(bearing)) * distance;
const float ofs_north = cosf(radians(bearing_deg)) * distance;
const float ofs_east = sinf(radians(bearing_deg)) * distance;
offset(ofs_north, ofs_east);
}
// extrapolate latitude/longitude given bearing, pitch and distance
void Location::offset_bearing_and_pitch(float bearing, float pitch, float distance)
void Location::offset_bearing_and_pitch(float bearing_deg, float pitch_deg, float distance)
{
const float ofs_north = cosf(radians(pitch)) * cosf(radians(bearing)) * distance;
const float ofs_east = cosf(radians(pitch)) * sinf(radians(bearing)) * distance;
const float ofs_north = cosf(radians(pitch_deg)) * cosf(radians(bearing_deg)) * distance;
const float ofs_east = cosf(radians(pitch_deg)) * sinf(radians(bearing_deg)) * distance;
offset(ofs_north, ofs_east);
const int32_t dalt = sinf(radians(pitch)) * distance *100.0f;
const int32_t dalt = sinf(radians(pitch_deg)) * distance *100.0f;
alt += dalt;
}

4
libraries/AP_Common/Location.h

@ -72,10 +72,10 @@ public: @@ -72,10 +72,10 @@ public:
void offset(float ofs_north, float ofs_east);
// extrapolate latitude/longitude given bearing and distance
void offset_bearing(float bearing, float distance);
void offset_bearing(float bearing_deg, float distance);
// extrapolate latitude/longitude given bearing, pitch and distance
void offset_bearing_and_pitch(float bearing, float pitch, float distance);
void offset_bearing_and_pitch(float bearing_deg, float pitch_deg, float distance);
// longitude_scale - returns the scaler to compensate for
// shrinking longitude as you move north or south from the equator

Loading…
Cancel
Save