Changed template to receive a goal position on a topic and keeps node alive after goal is reached.