ESP32-CAN/main/nav.cpp