Fix odometry bug
This commit is contained in:
parent
92154ed8ee
commit
047dd9d6bc
1 changed files with 0 additions and 1 deletions
|
@ -99,7 +99,6 @@ namespace create {
|
||||||
deltaDist = (rightWheelDist + leftWheelDist) / 2.0;
|
deltaDist = (rightWheelDist + leftWheelDist) / 2.0;
|
||||||
|
|
||||||
// Moving straight
|
// Moving straight
|
||||||
float deltaX, deltaY;
|
|
||||||
if (fabs(wheelDistDiff) < util::EPS) {
|
if (fabs(wheelDistDiff) < util::EPS) {
|
||||||
deltaX = deltaDist * cos(pose.yaw);
|
deltaX = deltaDist * cos(pose.yaw);
|
||||||
deltaY = deltaDist * sin(pose.yaw);
|
deltaY = deltaDist * sin(pose.yaw);
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue