HebiPoseFilter DEPRECATED pose filter for fusing IMU feedback.
THIS API IS DEPRECATED AND WILL BE REMOVED IN A FUTURE RELEASE. The
primary purpose of this API was to provide an orientation estimate
of a module based on its IMU. This estimate is now done on each
module in firmware and is returned as a quaternion orientation.
HebiPoseFilter Methods:
setMaxAccelNormDev - max deviation from the norm
setMaxAccelWeight - trust in accelerometers [0-1]
setYaw - sets dead-reackoned yaw [rad] (rotation about z in world)
update - input: 3x accel [g], 3x gyro [rad/s], abs time [s]
getPose - out: 4x4 transform matrix
Example
% Continuously find pose of a module
group = HebiLookup.newGroupFromSerials('SA023');
poseFilter = HebiPoseFilter();
poseFilter.setYaw(0.23); % (optional) set yaw to non-zero origin
while true
% Update filter
fbk = group.getNextFeedback();
accels = [fbk.accelX, fbk.accelY, fbk.accelZ];
gyros = [fbk.gyroX, fbk.gyroY, fbk.gyroZ];
poseFilter.update(accels, gyros, fbk.time);
% Show current pose
pose = poseFilter.getPose();
disp(pose);
end