Adds TestStand class to r/w cmds for testStand

See Issue #145 (closed)

Closes #145 (closed)

crazyflie_groundstation/inc/CCrazyflie.h

@@ -52,6 +52,7 @@
 #include "serial/serial.h"
 #include "vrpn_Connection.h"
 #include "vrpn_Tracker.h"
+#include "testStand.h"
 
 
 // Ports defined for the CRTP protocol
@@ -298,7 +299,7 @@ class CCrazyflie {
     CTOC *m_tocParameters;
     CTOC *m_tocLogs;
     int testStandError = 0;
-    serial::Serial * test_stand;
+    TestStand testStand;
     bool allowLogging = false;
 
   CCrazyflie(CCrazyRadio *crRadio, int radioChannel, XferRate dataRate, int quadNum, double startTime);