Bug fixes in autocalibration.m
Mark: IMU observation is functioning for naive configuration.