Add a way to trigger commands based on robot position on field, alongside robot position validation. #52
Description
This would be helpful for things like automatically preparing some subsystem of the robot when approaching a game element (i.e. preparing intake when close to reef, or enabling vision when near the coral station).
We could also add checks to ensure that the returned robot position is inside the field, or not inside a game element, so in cases where the robot's pose is incorrect, or if vision returns a solution that is invalid, we could detect this fault, and adjust for it.
This likely would require having an up-to-date field map, but it would help immensely throughout the season.