Fixed calibrated airspeed output so that it accounts for wind.

diff --git a/src/FDM/YASim/YASim.cxx b/src/FDM/YASim/YASim.cxx
index f8c109abd27be3cf2cb89ac5cb8286e80abfb862..80bc0970dba591cc0592f20cc1c8579ae03c7878 100644 (file)
--- a/src/FDM/YASim/YASim.cxx
+++ b/src/FDM/YASim/YASim.cxx
@@ -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?