Skip to content

Commit c9897d8

Browse files
committed
Temporal fix for parallel parking
1 parent 2a82759 commit c9897d8

1 file changed

Lines changed: 11 additions & 8 deletions

File tree

GEMstack/onboard/planning/pure_pursuit.py

Lines changed: 11 additions & 8 deletions
Original file line numberDiff line numberDiff line change
@@ -184,13 +184,16 @@ def compute(self, state: VehicleState, component: Component = None):
184184
# decay speed when crosstrack error is high
185185
desired_speed *= np.exp(-abs(ct_error) * 0.8)
186186

187-
if len(self.trajectory.points) < 2 or self.current_path_parameter >= self.path.domain()[1]:
188-
if component is not None:
189-
component.debug_event('Past the end of trajectory')
190-
# past the end, just stop
191-
desired_speed = 0.0
192-
feedforward_accel = -2.0
193-
f_delta = 0
187+
188+
# COMMENT OUT BY SUMMONING: parallel_parking returns error under this condition
189+
# if len(self.trajectory.points) < 2 or self.current_path_parameter >= self.path.domain()[1]:
190+
# if component is not None:
191+
# component.debug_event('Past the end of trajectory')
192+
# # past the end, just stop
193+
# desired_speed = 0.0
194+
# feedforward_accel = -2.0
195+
# f_delta = 0
196+
194197

195198
if desired_speed > self.speed_limit:
196199
desired_speed = self.speed_limit
@@ -242,4 +245,4 @@ def update(self, vehicle: VehicleState, trajectory: Trajectory):
242245

243246
def healthy(self):
244247
# return self.pure_pursuit.path is not None
245-
return True
248+
return True

0 commit comments

Comments
 (0)