diff --git a/Localization/extended_kalman_filter/extended_kalman_filter.py b/Localization/extended_kalman_filter/extended_kalman_filter.py index bde58100..75385e7e 100644 --- a/Localization/extended_kalman_filter/extended_kalman_filter.py +++ b/Localization/extended_kalman_filter/extended_kalman_filter.py @@ -183,7 +183,7 @@ def main(): xTrue, z, xDR, ud = observation(xTrue, xDR, u) - xEst, PEst = ekf_estimation(xEst, PEst, z, u) + xEst, PEst = ekf_estimation(xEst, PEst, z, ud) # store data history hxEst = np.hstack((hxEst, xEst))