Pseudo code fixed.
Testing on real pieces, but for one step/board.