Adding StackVector and StackQueue working fine with a little tests, still need to create some other data types like for example StackList
Adding also the gps (General Purpose SubSystems), in this case, Pathfinding (WayPoint Pathfinding), still working on this
Still working on Pathfinding, already implemented the algorithm, still have to complete the last part.
Added also StackPriorityQueue, using the stl::heap_xxx methods, probably in the future we can implement a better data structure