1
0
Fork 0

Fixed calibrated airspeed output so that it accounts for wind.

This commit is contained in:
david 2003-02-19 17:41:53 +00:00
parent b78d5a0b93
commit 8eac88efe9

View file

@ -368,7 +368,7 @@ void YASim::copyFromYASim()
wind[2] = get_V_down_airmass() * FT2M * -1.0;
Math::tmul33(xyz2ned, wind, wind); // Wind in global
Math::sub3(s->v, wind, v); // V - wind in global
Math::vmul33(s->orient, s->v, v); // to body coordinates
Math::vmul33(s->orient, v, v); // to body coordinates
_set_Velocities_Wind_Body(v[0]*M2FT, -v[1]*M2FT, -v[2]*M2FT);
_set_V_rel_wind(Math::mag3(v)*M2FT); // units?