From f4418aaf51c69461c7d158f2c082361e25a7f317 Mon Sep 17 00:00:00 2001
From: lm <pixhawk@pixhawk02.(none)>
Date: Fri, 14 May 2010 11:33:58 +0200
Subject: [PATCH] Added rotation matrix to plot

---
 src/uas/UAS.cc | 10 ++++++++++
 1 file changed, 10 insertions(+)

diff --git a/src/uas/UAS.cc b/src/uas/UAS.cc
index 6092608bc0..49e882cfa2 100644
--- a/src/uas/UAS.cc
+++ b/src/uas/UAS.cc
@@ -285,6 +285,16 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message)
                 emit valueChanged(uasId, "vis. x", pos.x, time);
                 emit valueChanged(uasId, "vis. y", pos.y, time);
                 emit valueChanged(uasId, "vis. z", pos.z, time);
+                // FIXME Only for testing for now
+                emit valueChanged(uasId, "vis. rot r1", pos.r1, time);
+                emit valueChanged(uasId, "vis. rot r2", pos.r2, time);
+                emit valueChanged(uasId, "vis. rot r3", pos.r3, time);
+                emit valueChanged(uasId, "vis. rot r4", pos.r4, time);
+                emit valueChanged(uasId, "vis. rot r5", pos.r5, time);
+                emit valueChanged(uasId, "vis. rot r6", pos.r6, time);
+                emit valueChanged(uasId, "vis. rot r7", pos.r7, time);
+                emit valueChanged(uasId, "vis. rot r8", pos.r8, time);
+                emit valueChanged(uasId, "vis. rot r9", pos.r9, time);
             }
             break;
         case MAVLINK_MSG_ID_POSITION:
-- 
GitLab