Populated WAYPOINT structure in SetWaypoint (telemetry.cpp) and initialized waypointCommand_ variable in WaypointCommand