added the finding direction stuff
removed unnecessary rate (we are blocking until we reach the goal anyway)