void cmdCallback(const geometry_msgs::Twist::ConstPtr &msg) {
...
vL = msg->linear.x - msg->angular.z *(wheel_dist_ / 2);
vR = msg->linear.x + msg->angular.z *(wheel_dist_ / 2);
...
}
void publishOdom() {
...
double dth = (dr - dl) / wheel_dist_;
th += dth; // robot' angular displacement
...