Adds odometry publishing to Husky base controller

Includes (considerable) fixes and additions by @chadrockey