Fixed many calculation bugs with the map points. Got pathing working. It has NO random X / Y shifts in the path... :(