Added and removed some comments
Renamed the safeDistance function to objectRadius, and made a implementation change in the bearingFromAgentToPoint function
Added destructor, copy constructor, and assignment operator to ObjectManipRecovery, and fixed a commenting error I made in the code