Added footsteps showing the valid route, cleaned up the code a bit