[UNTESTED] GridNav - Coloured block scenario

Implemented colour discrimination.
Made appropriate changes to GridMap.
TODO:
If seen block, but haven't sensed colour: Check colour straight away on
next attempt.