added gtest for miabot state propagation in estimator
Merge branch 'master' of https://github.com/leonard-lab/dcslROS
fixed typos in estimator math