Implemented right hand maze solver