Changeset 167 in flair-src for trunk/lib/FlairSensorActuator
- Timestamp:
- Apr 12, 2017, 1:59:38 PM (8 years ago)
- Location:
- trunk/lib/FlairSensorActuator/src
- Files:
-
- 11 edited
Legend:
- Unmodified
- Added
- Removed
-
trunk/lib/FlairSensorActuator/src/Gx3_25_imu_impl.cpp
r157 r167 130 130 eulerAngles.yaw = Dequeue(&buf); 131 131 132 Vector3D filteredAngRates;132 Vector3Df filteredAngRates; 133 133 filteredAngRates.x = Dequeue(&buf); 134 134 filteredAngRates.y = Dequeue(&buf); … … 143 143 GetData(response, sizeof(response), &imuTime); 144 144 145 Vector3D rawAcc;145 Vector3Df rawAcc; 146 146 rawAcc.x = 9.80665 * Dequeue(&buf); 147 147 rawAcc.y = 9.80665 * Dequeue(&buf); 148 148 rawAcc.z = 9.80665 * Dequeue(&buf); 149 149 150 Vector3D filteredAngRates;150 Vector3Df filteredAngRates; 151 151 filteredAngRates.x = Dequeue(&buf); 152 152 filteredAngRates.y = Dequeue(&buf); … … 178 178 quaternion.q3 = Dequeue(&buf); 179 179 180 Vector3D filteredAngRates;180 Vector3Df filteredAngRates; 181 181 filteredAngRates.x = 0; 182 182 filteredAngRates.y = 0; -
trunk/lib/FlairSensorActuator/src/Imu.cpp
r137 r167 69 69 return; 70 70 } 71 Vector3D rawAcc, rawMag, rawGyr;71 Vector3Df rawAcc, rawMag, rawGyr; 72 72 imuData->GetRawAccMagAndGyr(rawAcc, rawMag, rawGyr); 73 73 rotation->ComputeRotation(rawAcc); -
trunk/lib/FlairSensorActuator/src/NmeaGps.cpp
r137 r167 173 173 void NmeaGps::SetRef(void) { takeRef = true; } 174 174 175 void NmeaGps::GetEnu(Vector3D *point) {175 void NmeaGps::GetEnu(Vector3Df *point) { 176 176 gpsData->GetMutex(); 177 177 gpsData->GetEnu(point->x,point->y,point->z); -
trunk/lib/FlairSensorActuator/src/NmeaGps.h
r137 r167 15 15 16 16 #include <IODevice.h> 17 #include <Vector3D.h> 17 18 #include <nmea/nmea.h> 18 19 … … 21 22 class FrameworkManager; 22 23 class GeoCoordinate; 23 class Vector3D;24 24 class GpsData; 25 25 } … … 168 168 * \param point to store position 169 169 */ 170 void GetEnu(core::Vector3D *point);170 void GetEnu(core::Vector3Df *point); 171 171 172 172 protected: -
trunk/lib/FlairSensorActuator/src/SimuImu.cpp
r158 r167 107 107 ahrsData->SetQuaternionAndAngularRates( 108 108 Quaternion(state.q0, state.q1, state.q2, state.q3), 109 Vector3D (state.wx, state.wy, state.wz));109 Vector3Df(state.wx, state.wy, state.wz)); 110 110 111 111 imuData->SetDataTime(GetTime()); -
trunk/lib/FlairSensorActuator/src/VrpnClient_impl.cpp
r140 r167 104 104 } 105 105 106 void VrpnClient_impl::ComputeRotations(Vector3D &point) {106 void VrpnClient_impl::ComputeRotations(Vector3Df &point) { 107 107 rotation_1->ComputeRotation(point); 108 108 rotation_2->ComputeRotation(point); -
trunk/lib/FlairSensorActuator/src/VrpnObject.cpp
r157 r167 77 77 } 78 78 79 void VrpnObject::GetPosition(Vector3D &point) const {79 void VrpnObject::GetPosition(Vector3Df &point) const { 80 80 pimpl_->GetPosition(point); 81 81 } -
trunk/lib/FlairSensorActuator/src/VrpnObject.h
r140 r167 16 16 17 17 #include <IODevice.h> 18 #include <Vector3D.h> 18 19 #include <stdint.h> 19 20 … … 21 22 namespace core { 22 23 class cvmatrix; 23 class Vector3D;24 24 class Quaternion; 25 25 } … … 110 110 * \param point output datas 111 111 */ 112 void GetPosition(core::Vector3D &point) const;112 void GetPosition(core::Vector3Df &point) const; 113 113 114 114 /*! -
trunk/lib/FlairSensorActuator/src/VrpnObject_impl.cpp
r148 r167 129 129 } 130 130 131 void VrpnObject_impl::GetPosition(Vector3D &point) {131 void VrpnObject_impl::GetPosition(Vector3Df &point) { 132 132 output->GetMutex(); 133 133 point.x = output->ValueNoMutex(4, 0); … … 163 163 // flair::core::Quaternion 164 164 Quaternion quaternion(t.quat[3],t.quat[0],t.quat[1],t.quat[2]); 165 Vector3D pos((float)t.pos[0], (float)t.pos[1], (float)t.pos[2]);165 Vector3Df pos((float)t.pos[0], (float)t.pos[1], (float)t.pos[2]); 166 166 167 167 // on effectue les rotation -
trunk/lib/FlairSensorActuator/src/unexported/VrpnClient_impl.h
r140 r167 21 21 #include <string> 22 22 #include <vector> 23 #include "Vector3D.h" 23 24 24 25 namespace flair { 25 26 namespace core { 26 27 class OneAxisRotation; 27 class Vector3D;28 28 class Quaternion; 29 29 class Mutex; … … 54 54 void AddTrackable(VrpnObject_impl *obj, uint8_t id); // xbee 55 55 void RemoveTrackable(VrpnObject_impl *obj); // normal+xbee 56 void ComputeRotations(flair::core::Vector3D &point);56 void ComputeRotations(flair::core::Vector3Df &point); 57 57 void ComputeRotations(flair::core::Quaternion &quat); 58 58 bool UseXbee(void); -
trunk/lib/FlairSensorActuator/src/unexported/VrpnObject_impl.h
r140 r167 24 24 #include <vrpn_Tracker.h> 25 25 #include "Quaternion.h" 26 #include "Vector3D.h" 26 27 27 28 namespace flair { 28 29 namespace core { 29 30 class cvmatrix; 30 class Vector3D;31 31 } 32 32 namespace gui { … … 51 51 52 52 void GetQuaternion(flair::core::Quaternion &quaternion); 53 void GetPosition(flair::core::Vector3D &point);53 void GetPosition(flair::core::Vector3Df &point); 54 54 bool IsTracked(unsigned int timeout_ms); 55 55
Note:
See TracChangeset
for help on using the changeset viewer.