added debug output to miabot driver
added support for initial condition parameters in estimator
fixed typos and cleaned up code for miabot follower control