Git Commit with changes implementing destinations
Lot of changes. Converted point2d.float to point (custom) implementation
Commiting changes from randomWayPoint(buggy)