Enhanced GridNav simulation

Removed current behaviour for block grab failure.  This will need to be
re-implemented correctly when considering colour.
Confirmed IR reference passing works.
Labelled the lines which need to be commented out to prevent hangs when
simulating.