Fix waypoint speed issue