I'm trying to us the Sensor Fusion toolbox to fuse accel and gyro data, then get displacement. Here is what I've tried:
>> me = loadTest('Me');
>> accel = me.sdChest(:,2:4);
>> gyro = me.sdChest(:,5:7);
>> FUSE = imufilter;
>> accel = table2array(accel);
>> gyro = table2array(gyro);
>> [orientation,angularVelocity] = FUSE(accel,gyro);
Now I want to get displacement data out. I get the orientation in the form of a quaterion, don't know how to get displacement.
Using: >> [position,orient ] = pose(FUSE); doesn't work
I understand that to get displacement you have to differentiate accel two times, but I was hoping a funtion was available for this.
Best Answer