- Collision working

- Reaching Waypoint smoother
- Updating Minimap better performance