|
|
@ -88,6 +88,9 @@ class CarKalman(KalmanFilter): |
|
|
|
dim_state = CarKalman.initial_x.shape[0] |
|
|
|
dim_state = CarKalman.initial_x.shape[0] |
|
|
|
name = CarKalman.name |
|
|
|
name = CarKalman.name |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
# vehicle models comes from The Science of Vehicle Dynamics: Handling, Braking, and Ride of Road and Race Cars |
|
|
|
|
|
|
|
# Model used is in 6.15 with formula from 6.198 |
|
|
|
|
|
|
|
|
|
|
|
# globals |
|
|
|
# globals |
|
|
|
global_vars = [sp.Symbol(name) for name in CarKalman.global_vars] |
|
|
|
global_vars = [sp.Symbol(name) for name in CarKalman.global_vars] |
|
|
|
m, j, aF, aR, cF_orig, cR_orig = global_vars |
|
|
|
m, j, aF, aR, cF_orig, cR_orig = global_vars |
|
|
|