Fixes
merging toblingong height change now working
Added safety in the navigation
copied code in highlevelwalking to c++ project Gangenheten
Buttons for navigation
made c++ project
merging
Find high pass obstacles, can't send command to gangenheten and is not in the mainloop
Stared working on new turning based on gyro
Looks a bit better now
Tested code, some minor stuff
Added climbing
Merge
New turn function in gang
Redone turn function, works for angles aproaching 180 degrees.
Fixed turn function
Turn function done, auto settings is sent to Arkenstone.
moved a check
It can almost get over obstacles