https://mcuoneclipse.com/2013/03/28/maze-solving-frdm-kl25z-robot-goes-backward/