PatrikE code integration phase 1

Code builds but is not really usable. Need to change babayaga.cpp code
to complete. Need to understand changes to 'nav_bearing'.