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;
|
using namespace yasim;
|
||||||
|
|
||||||
static const float RAD2DEG = 180/3.14159265358979323846;
|
static const float RAD2DEG = 180/3.14159265358979323846;
|
||||||
|
static const float PI2 = 3.14159265358979323846*2;
|
||||||
static const float RAD2RPM = 9.54929658551;
|
static const float RAD2RPM = 9.54929658551;
|
||||||
static const float M2FT = 3.2808399;
|
static const float M2FT = 3.2808399;
|
||||||
static const float FT2M = 0.3048;
|
static const float FT2M = 0.3048;
|
||||||
|
@ -466,6 +467,8 @@ void YASim::copyFromYASim()
|
||||||
Math::mmul33(s->orient, tmp, tmp);
|
Math::mmul33(s->orient, tmp, tmp);
|
||||||
float roll, pitch, hdg;
|
float roll, pitch, hdg;
|
||||||
Glue::orient2euler(tmp, &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);
|
_set_Euler_Angles(roll, pitch, hdg);
|
||||||
|
|
||||||
// rotation
|
// rotation
|
||||||
|
|
Loading…
Add table
Reference in a new issue