Made Nao do a step back when needed in aligngoal and lookforgoal