Initial commit

Working maze solver v.0.1