You are in a 5 by 5 world. There are obstacles that you have to avoid at: (0, 4), (0, 4), (4, 0), (0, 0) and (1, 1). Go from (4, 1) to (1, 4).