Fram till findfirstzero klart

Börjat fundera/koda kring hur man reglerar påväg till en icke genomsökt ruta