mirror of
https://github.com/modelec/modelec-marcel-ROS.git
synced 2026-01-18 16:47:43 +01:00
only stop
This commit is contained in:
@@ -56,12 +56,12 @@ class SimulatedPCB:
|
||||
self.waypoint_order.pop(0)
|
||||
del self.waypoints[wp['id']]
|
||||
else:
|
||||
speed = min(150.0, distance)
|
||||
speed = min(300.0, distance * 2)
|
||||
self.vx = speed * math.cos(angle)
|
||||
self.vy = speed * math.sin(angle)
|
||||
self.vtheta = max(-9.0, min(9.0, angle_diff * 2))
|
||||
else:
|
||||
speed = min(200.0, distance * 2)
|
||||
speed = min(400.0, distance * 3)
|
||||
self.vx = speed * math.cos(angle)
|
||||
self.vy = speed * math.sin(angle)
|
||||
self.vtheta = 0.0
|
||||
|
||||
@@ -159,9 +159,9 @@ namespace Modelec
|
||||
{
|
||||
Transition(State::DO_PROMOTION, "Start promotion");
|
||||
}
|
||||
else
|
||||
else if (elapsed.seconds() >= 100)
|
||||
{
|
||||
Transition(State::DO_GO_HOME, "All missions done");
|
||||
Transition(State::STOP, "All missions done");
|
||||
}
|
||||
|
||||
/*if (elapsed.seconds() >= 2)
|
||||
|
||||
Reference in New Issue
Block a user