added sensor_ddcm -- works
fixed sensor calibration -- works
added gyro and iddcm observation updates
added gyro+iddcm update
added state sanitizing