firmware/src/modules/WaypointModule.cpp