Now can compile with or without USE_DEBUG defined
 Added a NaN Filter
Merge branch 'master' of https://github.com/RoboGroup3/object_recognition
 Nan removing works
Merged
Merge branch 'RoboGroup3-master'