fixed a bug that keep sending 0 vel to the robot base