Commented out printf statement in RobotMath

It gives an error when compiling.
Implemented bordercheck function

To verify if a given location is within the digital fence.
Added calibration mode and inverted height

In OpenCV, the origin is top-left, however as the image is mirrored, it
is in fact top-right.