fly/flightgear
1
0
Fork 0
Code Activity

YASim: export FDM state (v, a, rot) to property tree.

Browse source
This commit is contained in:
Henning Stahlke 2017-02-16 16:46:34 +01:00
parent 70dd3de3bb
commit 41b18155a8
1 changed files with 20 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

20
src/FDM/YASim/FGFDM.cpp
View file

@ -616,6 +616,26 @@ void FGFDM::setOutputProperties(float dt)
_cg_y->setFloatValue(cg[1]); _cg_y->setFloatValue(cg[1]);
_cg_z->setFloatValue(cg[2]); _cg_z->setFloatValue(cg[2]);
State* s = _airplane.getModel()->getState();
float v[3], acc[3], rot[3], racc[3];
Math::vmul33(s->orient, s->v, v);
Math::vmul33(s->orient, s->acc, acc);
Math::vmul33(s->orient, s->rot, rot);
Math::vmul33(s->orient, s->racc, racc);
_yasimN->getNode("velocities/v-x", true)->setFloatValue(v[0]);
_yasimN->getNode("velocities/v-y", true)->setFloatValue(v[1]);
_yasimN->getNode("velocities/v-z", true)->setFloatValue(v[2]);
_yasimN->getNode("velocities/vrot-x", true)->setFloatValue(rot[0]);
_yasimN->getNode("velocities/vrot-y", true)->setFloatValue(rot[1]);
_yasimN->getNode("velocities/vrot-z", true)->setFloatValue(rot[2]);
_yasimN->getNode("accelerations/a-x", true)->setFloatValue(acc[0]);
_yasimN->getNode("accelerations/a-y", true)->setFloatValue(acc[1]);
_yasimN->getNode("accelerations/a-z", true)->setFloatValue(acc[2]);
_yasimN->getNode("accelerations/arot-x", true)->setFloatValue(racc[0]);
_yasimN->getNode("accelerations/arot-y", true)->setFloatValue(racc[1]);
_yasimN->getNode("accelerations/arot-z", true)->setFloatValue(racc[2]);
ControlMap* cm = _airplane.getControlMap(); ControlMap* cm = _airplane.getControlMap();
for(int i=0; i<_controlProps.size(); i++) { for(int i=0; i<_controlProps.size(); i++) {
PropOut* p = (PropOut*)_controlProps.get(i); PropOut* p = (PropOut*)_controlProps.get(i);