Add maximum error limit to robot matching #48
Description
When matching robots to detected robots in the vision system, there should be an upper limit on the differences in position between the detected robot and the estimate.
This should help filter out some false positions