Bug Fix

Bugfix: when backtracking, dont't remove current step from stack, until
we arrived the next step.
Walk out of a 2D maze

Use pure C data structure like struct to build a stack.