Added trajectory publisher.