Added new functionalyty to Odometry.msg