Skip to content

Commit a11dbe4

Browse files
committed
Fix for computing des_speed for spin in place
1 parent 526a68d commit a11dbe4

File tree

1 file changed

+2
-1
lines changed

1 file changed

+2
-1
lines changed

precision_steering/src/ideal_state_generator.cpp

Lines changed: 2 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -227,10 +227,11 @@ bool IdealStateGenerator::computeState(precision_navigation_msgs::DesiredState&
227227
precision_navigation_msgs::PathSegment currentSeg = path_.at(seg_number_);
228228

229229
double vNext;
230-
v = currentSeg.max_speeds.linear.x;
231230
if (currentSeg.seg_type == precision_navigation_msgs::PathSegment::SPIN_IN_PLACE) {
232231
vNext = 0.0;
232+
v = currentSeg.max_speeds.angular.z;
233233
} else {
234+
v = currentSeg.max_speeds.linear.x;
234235
if (seg_number_ < path_.size()-1) {
235236
vNext = path_.at(seg_number_+1).max_speeds.linear.x;
236237
}

0 commit comments

Comments
 (0)