mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-07-17 07:12:08 +08:00
James
21 lines
724 B
Python
21 lines
724 B
Python
#!/usr/bin/env python3
|
|
from openpilot.common.constants import CV
|
|
|
|
from openpilot.frogpilot.common.frogpilot_variables import CRUISING_SPEED
|
|
|
|
class FrogPilotVCruise:
|
|
def __init__(self, FrogPilotPlanner):
|
|
self.frogpilot_planner = FrogPilotPlanner
|
|
|
|
def update(self, long_control_active, now, time_validated, v_cruise, v_ego, sm, frogpilot_toggles):
|
|
v_cruise_cluster = max(sm["carState"].vCruiseCluster * CV.KPH_TO_MS, v_cruise)
|
|
v_cruise_diff = v_cruise_cluster - v_cruise
|
|
|
|
v_ego_cluster = max(sm["carState"].vEgoCluster, v_ego)
|
|
v_ego_diff = v_ego_cluster - v_ego
|
|
|
|
targets = [v_cruise]
|
|
v_cruise = min([target if target >= CRUISING_SPEED else v_cruise for target in targets])
|
|
|
|
return v_cruise
|