Changeset 15 in flair-src for trunk/lib/FlairFilter/src/SimuAhrs.cpp
- Timestamp:
- 04/08/16 15:40:57 (8 years ago)
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
trunk/lib/FlairFilter/src/SimuAhrs.cpp
r10 r15 25 25 using namespace flair::sensor; 26 26 27 namespace flair { namespace filter { 27 namespace flair { 28 namespace filter { 28 29 29 SimuAhrs::SimuAhrs(const FrameworkManager* parent,string name,uint32_t dev_id,uint8_t priority) :Ahrs(new SimuImu(parent,name,dev_id,priority),name) { 30 } 30 SimuAhrs::SimuAhrs(const FrameworkManager *parent, string name, uint32_t dev_id, 31 uint8_t priority) 32 : Ahrs(new SimuImu(parent, name, dev_id, priority), name) {} 31 33 32 34 SimuAhrs::~SimuAhrs() {} 33 35 34 void SimuAhrs::Start(void) { 35 ((SimuImu*)GetImu())->Start(); 36 } 36 void SimuAhrs::Start(void) { ((SimuImu *)GetImu())->Start(); } 37 37 38 // datas from SimuImu are AhrsData!38 // datas from SimuImu are AhrsData! 39 39 void SimuAhrs::UpdateFrom(const io_data *data) { 40 AhrsData *input=(AhrsData*)data;41 42 40 AhrsData *input = (AhrsData *)data; 41 AhrsData *output; 42 GetDatas(&output); 43 43 44 45 46 input->GetQuaternionAndAngularRates(quaternion,filteredAngRates);47 output->SetQuaternionAndAngularRates(quaternion,filteredAngRates);48 44 Quaternion quaternion; 45 Vector3D filteredAngRates; 46 input->GetQuaternionAndAngularRates(quaternion, filteredAngRates); 47 output->SetQuaternionAndAngularRates(quaternion, filteredAngRates); 48 output->SetDataTime(input->DataTime()); 49 49 50 50 ProcessUpdate(output); 51 51 } 52 52
Note:
See TracChangeset
for help on using the changeset viewer.