Changes to robot's waitForCommand node. Also added a
sendTwist(geometry_msgs::Twist) method in Corobot