fixed bugs from restructuring

fixed bugs, but still have a bug where Kobuki motor control stops
responding.  ToDo.