Skip to content

Commit 7d19230

Browse files
committed
Updating the spin in place test a bit
1 parent 2d63173 commit 7d19230

File tree

1 file changed

+20
-4
lines changed

1 file changed

+20
-4
lines changed

precision_steering/src/path_sender.py

Lines changed: 20 additions & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -472,14 +472,30 @@ def makeDummyPaths():
472472
paths['lab_test'] = p8
473473

474474
p9 = ExecutePathGoal()
475-
p.header.frame_id = "base_link"
476-
p.seg_type = PathSegment.ARC
475+
p = PathSegment()
476+
p.header.frame_id = "odom"
477+
p.seg_type = PathSegment.SPIN_IN_PLACE
477478
p.ref_point.x = 0.0
478479
p.ref_point.y = 0.0
479480
p.init_tan_angle = Quaternion(*(tf_math.quaternion_about_axis(0.00000, (0,0,1))))
480-
p.curvature = 100.0
481+
p.curvature = 1.0
481482
p.seg_length = 3.14159
482-
p.max_speeds.linear.x = 0.5
483+
p.max_speeds.linear.x = 0.0
484+
p.max_speeds.angular.z = 1.0
485+
p.accel_limit = 0.1
486+
p.decel_limit = 0.1
487+
p9.segments.append(p)
488+
489+
p = PathSegment()
490+
p.header.frame_id = "odom"
491+
p.seg_type = PathSegment.SPIN_IN_PLACE
492+
p.ref_point.x = 0.0
493+
p.ref_point.y = 0.0
494+
p.init_tan_angle = Quaternion(*(tf_math.quaternion_about_axis(3.14159, (0,0,1))))
495+
p.curvature = -1.0
496+
p.seg_length = 3.14159
497+
p.max_speeds.linear.x = 0.0
498+
p.max_speeds.angular.z = 1.0
483499
p.accel_limit = 0.1
484500
p.decel_limit = 0.1
485501
p9.segments.append(p)

0 commit comments

Comments
 (0)