Mer rydding og omstrukturering, opprettet høydebegrensningsobjekt og skrev logikk for å finne nærmeste punkt-objekt på veglenken og i riktig retning.