Implemented way points
Implemented road trace function for enemies