Added findROS
Added convertToRosTf and testers