added publishing of tracked object pose as PoseStamped msg