Able to send message to cmd_vel topic