Started adding imperative maze solution