Changeset 167 in flair-src for trunk/demos/SimpleFleet/uav/src

Timestamp:

04/12/17 13:59:38 (7 years ago)

Author:

Sanahuja Guillaume

Message:

modifs pour template vectors

Location:

trunk/demos/SimpleFleet/uav/src

Files:

• SimpleFleet.cpp (modified) (7 diffs)
• SimpleFleet.h (modified) (2 diffs)

trunk/demos/SimpleFleet/uav/src/SimpleFleet.cpp

@@ -111 +111 @@
     //get roll, pitch and w from imu
     Quaternion ahrsQuaternion;
-    Vector3D ahrsAngularSpeed;
+    Vector3Df ahrsAngularSpeed;
     GetDefaultOrientation()->GetQuaternionAndAngularRates(ahrsQuaternion, ahrsAngularSpeed);
 
@@ -124 +124 @@
 
 void SimpleFleet::AltitudeValues(float &z,float &dz) const {
-    Vector3D uav_pos,uav_vel;
+    Vector3Df uav_pos,uav_vel;
 
     uavVrpn->GetPosition(uav_pos);
@@ -134 +134 @@
 
 const AhrsData *SimpleFleet::GetReferenceOrientation(void) {
-    Vector2D pos_err, vel_err; // in uav coordinate system
+    Vector2Df pos_err, vel_err; // in uav coordinate system
     float yaw_ref;
     Euler refAngles;
@@ -150 +150 @@
     refAngles.roll=-u_y->Output();
 
-    customReferenceOrientation->SetQuaternionAndAngularRates(refAngles.ToQuaternion(),Vector3D(0,0,0));
+    customReferenceOrientation->SetQuaternionAndAngularRates(refAngles.ToQuaternion(),Vector3Df(0,0,0));
 
     return customReferenceOrientation;
 }
 
-void SimpleFleet::PositionValues(Vector2D &pos_error,Vector2D &vel_error,float &yaw_ref) {
-    Vector3D uav_pos,uav_vel; // in VRPN coordinate system
-    Vector2D uav_2Dpos,uav_2Dvel; // in VRPN coordinate system
+void SimpleFleet::PositionValues(Vector2Df &pos_error,Vector2Df &vel_error,float &yaw_ref) {
+    Vector3Df uav_pos,uav_vel; // in VRPN coordinate system
+    Vector2Df uav_2Dpos,uav_2Dvel; // in VRPN coordinate system
 
     uavVrpn->GetPosition(uav_pos);
@@ -171 +171 @@
         yaw_ref=yawHold;
     } else { //Circle
-        Vector2D circle_pos,circle_vel;
-        Vector2D target_2Dpos;
+        Vector2Df circle_pos,circle_vel;
+        Vector2Df target_2Dpos;
 
         //circle center
@@ -318 +318 @@
         return;
     }
-    Vector3D uav_pos;
-    Vector2D uav_2Dpos,target_2Dpos;
+    Vector3Df uav_pos;
+    Vector2Df uav_2Dpos,target_2Dpos;
 
     //circle center
@@ -352 +352 @@
                 yawHold=vrpnQuaternion.ToEuler().yaw;
 
-                Vector3D vrpnPosition;
+                Vector3Df vrpnPosition;
     uavVrpn->GetPosition(vrpnPosition);
     vrpnPosition.To2Dxy(posHold);

trunk/demos/SimpleFleet/uav/src/SimpleFleet.h

@@ -63 +63 @@
         const flair::core::AhrsData *GetOrientation(void) const;
         void AltitudeValues(float &z,float &dz) const;
-        void PositionValues(flair::core::Vector2D &pos_error,flair::core::Vector2D &vel_error,float &yaw_ref);
+        void PositionValues(flair::core::Vector2Df &pos_error,flair::core::Vector2Df &vel_error,float &yaw_ref);
         const flair::core::AhrsData *GetReferenceOrientation(void);
         void SignalEvent(Event_t event);
@@ -70 +70 @@
         flair::filter::Pid *u_x, *u_y;
 
-        flair::core::Vector2D posHold;
+        flair::core::Vector2Df posHold;
         float yawHold;
         flair::core::Socket *message;