add iterative mpc
This commit is contained in:
parent
bf703611bd
commit
10b5b9011a
|
@ -265,7 +265,7 @@ def main():
|
||||||
R = np.diag([0.01])
|
R = np.diag([0.01])
|
||||||
|
|
||||||
# System model update
|
# System model update
|
||||||
V = 2.0 # in pratical we should calc from the state
|
V = 4.0 # in pratical we should calc from the state
|
||||||
lead_car_system_model.calc_predict_sytem_model(V, curvatures, PREDICT_STEP)
|
lead_car_system_model.calc_predict_sytem_model(V, curvatures, PREDICT_STEP)
|
||||||
follow_car_system_model.calc_predict_sytem_model(V, curvatures, PREDICT_STEP)
|
follow_car_system_model.calc_predict_sytem_model(V, curvatures, PREDICT_STEP)
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue