This patch normalizes the heading value YASim reports to the interface
This commit is contained in:
parent
5e2dacbee5
commit
0ff6c68c01
1 changed files with 3 additions and 0 deletions
|
@ -24,6 +24,7 @@
|
|||
using namespace yasim;
|
||||
|
||||
static const float RAD2DEG = 180/3.14159265358979323846;
|
||||
static const float PI2 = 3.14159265358979323846*2;
|
||||
static const float RAD2RPM = 9.54929658551;
|
||||
static const float M2FT = 3.2808399;
|
||||
static const float FT2M = 0.3048;
|
||||
|
@ -466,6 +467,8 @@ void YASim::copyFromYASim()
|
|||
Math::mmul33(s->orient, tmp, tmp);
|
||||
float roll, pitch, hdg;
|
||||
Glue::orient2euler(tmp, &roll, &pitch, &hdg);
|
||||
// make heading positive value
|
||||
if(hdg < 0.0) hdg += PI2;
|
||||
_set_Euler_Angles(roll, pitch, hdg);
|
||||
|
||||
// rotation
|
||||
|
|
Loading…
Add table
Reference in a new issue