|
|
@ -87,7 +87,12 @@ class PathPlanner(): |
|
|
|
|
|
|
|
|
|
|
|
# Run MPC |
|
|
|
# Run MPC |
|
|
|
self.angle_steers_des_prev = self.angle_steers_des_mpc |
|
|
|
self.angle_steers_des_prev = self.angle_steers_des_mpc |
|
|
|
VM.update_params(sm['liveParameters'].stiffnessFactor, sm['liveParameters'].steerRatio) |
|
|
|
|
|
|
|
|
|
|
|
# Update vehicle model |
|
|
|
|
|
|
|
x = max(sm['liveParameters'].stiffnessFactor, 0.1) |
|
|
|
|
|
|
|
sr = max(sm['liveParameters'].steerRatio, 0.1) |
|
|
|
|
|
|
|
VM.update_params(x, sr) |
|
|
|
|
|
|
|
|
|
|
|
curvature_factor = VM.curvature_factor(v_ego) |
|
|
|
curvature_factor = VM.curvature_factor(v_ego) |
|
|
|
|
|
|
|
|
|
|
|
self.LP.parse_model(sm['model']) |
|
|
|
self.LP.parse_model(sm['model']) |
|
|
|