send_goal.cpp added to move the robot to relative coordinates