* Added a queue library
* Added a waypoint struct in Types
* Created a header for the waypoint manager