added some functions for odometry and twist manipulation