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