Implemented of the waypoints navigation tools