Added navigation functionality
Added license header
Implemented nav graph creation