Now drawing optimal path

Dijkstra's is working! Optimal Path is being drawn now (tiny white
line).
Some errors are being thrown, I'll leave it to Selmar to fix those.