diff --git a/src/create.cpp b/src/create.cpp index 4612aa9..e77a560 100644 --- a/src/create.cpp +++ b/src/create.cpp @@ -67,7 +67,7 @@ namespace create { float deltaDist, deltaX, deltaY, deltaYaw; if (model == CREATE_1) { deltaDist = GET_DATA(ID_DISTANCE) / 1000.0; //mm -> m - deltaYaw = GET_DATA(ID_ANGLE) * util::PI / 180.0; // D2R + deltaYaw = ((int16_t) GET_DATA(ID_ANGLE)) * (util::PI / 180.0); // D2R deltaX = deltaDist * cos(pose.yaw); deltaY = deltaDist * sin(pose.yaw); }