Added a latch, wich helped and a timestamp that didnt much, to the sending of the nav goal