Added high goal detection

Code now checks for high goal (RoboRealm already filters for whether or
not the goal is lit).