1
0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-01-29 14:52:12 +01:00
git-svn-id: svn://svn.openpilot.org/OpenPilot/trunk@2803 ebee16cc-31ac-478f-84a7-5cbb03baadba
This commit is contained in:
corvus 2011-02-17 01:51:49 +00:00 committed by corvus
parent a91a35685a
commit 50e78b4265

View File

@ -253,7 +253,7 @@ void IL2Simulator::processUpdate(const QByteArray& inp)
float quat[4];
rpy[0]=current.roll;
rpy[1]=current.pitch;
rpy[2]=current.yaw;
rpy[2]=current.azimuth;
Utils::CoordinateConversions().RPY2Quaternion(rpy,quat);
attActualData.q1 = quat[0];
attActualData.q2 = quat[1];
@ -281,9 +281,9 @@ void IL2Simulator::processUpdate(const QByteArray& inp)
rawData.gyros[0] = current.dRoll;
rawData.gyros[1] = cos(DEG2RAD * current.roll) * current.dPitch + sin(DEG2RAD * current.roll) * current.dAzimuth;
rawData.gyros[2] = cos(DEG2RAD * current.roll) * current.dAzimuth - sin(DEG2RAD * current.roll) * current.dPitch;
rawDara.accels[0] = current.ddX;
rawDara.accels[1] = current.ddY;
rawDara.accels[2] = current.ddZ;
rawData.accels[0] = current.ddX;
rawData.accels[1] = current.ddY;
rawData.accels[2] = current.ddZ;
// Update homelocation
HomeLocation::DataFields homeData;