Able to find returnToZone goal point

findClosestPointToLine for 1 border violation and midpoint for 2 border
violation.
Also did some cleanup: variable names in PointRM.