Add cmd_vel control of base. Published tf based on odom