Removed debug, went back to roslog info
Minor fix in tracker heartbeat
Merged