Added maze routing, works, needs testing though