Add subscriber to initialpose topic in kinematic sim
Publish ground truth and odometry data from kinematic sim