Fix cast-related bug in Geom2D
Removed solved TODOs
Added real-time tracking in pathfinding (w/ mouse drag), and ESC to exit