Debugged miabot estimate switch to sin/cos states. Fixes #31