diff --git a/src/odom_new.cpp b/src/odom_new.cpp index 3ba526d4eb86d6e391ecf1159611e03b781aeff2..2ca4689eda03aed30741bfdd3acd85f99814f740 100644 --- a/src/odom_new.cpp +++ b/src/odom_new.cpp @@ -69,12 +69,6 @@ class OdomNew //this->x = //this->y = //this->th = - vx = this->radius*( left_vel + right_vel) / 2.0; - vth = this->radius*( right_vel - left_vel ) / this->wheel_distance; - this->x += vx * cos(this->th) * dt; - this->y += vx * sin(this->th) * dt; - this->th += vth * dt; - //////// TODO ////// this->odom_msg.header.stamp = time;