use std::vector for store waypoint list