trueAcceleration = [1 0 1];
trueAngularVelocity = [0 0 0];
IMU = imuSensor('ReferenceFrame',FRAME_TYPE);
[accelerometerReadings,gyroscopeReadings] = IMU(trueAcceleration,trueAngularVelocity);
gyroBiasNoise = 1.5e-9 * eye(3);
accelBiasNoise = diag([9.62e-9,9.62e-9,2.17e-8]);
gyroNoise = 6.93e-5 * eye(3);
accelNoise = 2.9e-6 * eye(3);
gyroReadings = repmat(gyroscopeReadings, 100,1);
accelReadings = repmat(accelerometerReadings, 100, 1);
params = factorIMUParameters( ...
SampleRate = sampleRate, ...
GyroscopeBiasNoise = gyroBiasNoise, ...
AccelerometerBiasNoise = accelBiasNoise, ...
GyroscopeNoise = gyroNoise, ...
AccelerometerNoise = accelNoise, ...
ReferenceFrame = FRAME_TYPE ...
f = factorIMU(nodeID, gyroReadings, accelReadings, params);
prevPose = [0 0 0 1 0 0 0];
[~,predictedVel] = predict(f,prevPose,prevVel,prevBias)
filter = insfilter('ReferenceFrame',FRAME_TYPE);
filter.IMUSampleRate = sampleRate;
predict(filter,accelReadings(ii,:),gyroReadings(ii,:));
insPredVelocity = filter.State(stateinfo(filter).Velocity)'