|
|
|
@ -159,15 +159,11 @@ class LongitudinalPlanner: |
|
|
|
|
|
|
|
|
|
plan_send.valid = sm.all_checks(service_list=['carState', 'controlsState']) |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
longitudinalPlan = plan_send.longitudinalPlan |
|
|
|
|
longitudinalPlan.modelMonoTime = sm.logMonoTime['modelV2'] |
|
|
|
|
longitudinalPlan.processingDelay = (plan_send.logMonoTime / 1e9) - sm.logMonoTime['modelV2'] |
|
|
|
|
longitudinalPlan.solverExecutionTime = self.mpc.solve_time |
|
|
|
|
|
|
|
|
|
longitudinalPlan.allowBrake = True |
|
|
|
|
longitudinalPlan.allowThrottle = True |
|
|
|
|
|
|
|
|
|
longitudinalPlan.speeds = self.v_desired_trajectory.tolist() |
|
|
|
|
longitudinalPlan.accels = self.a_desired_trajectory.tolist() |
|
|
|
|
longitudinalPlan.jerks = self.j_desired_trajectory.tolist() |
|
|
|
|