Ported tracker to Catkin, added new message types