protected override void ConfigureStateSubscriber()
{
base.ConfigureStateSubscriber();
Topics.AddSubscriber <Odometry>(nameof(DigestOdometryStateMessage), "rovio/odometry", RosSocket, DigestOdometryStateMessage);
Topics.AddSubscriber <Imu>(nameof(DigestImuStateMessage), "versavis/imu", RosSocket, DigestImuStateMessage);
Topics.AddSubscriber <JointState>(nameof(DigestJointStateMessage), "joint_states", RosSocket, DigestJointStateMessage);
}