Switched miabot model to use sin and cos instead of theta.
Debugged miabot estimate switch to sin/cos states. Fixes #31