Changed all coords functions to take pointers
- pathfinding still broken