Added vector flow field
Added shortest path and travelling salesman code
Incorporated travelling salesman into route plan