diff --git a/kalman_filter/__main__.py b/kalman_filter/__main__.py index 5c3d8d1..5aea9e9 100644 --- a/kalman_filter/__main__.py +++ b/kalman_filter/__main__.py @@ -25,6 +25,17 @@ The reset of the parameters are empirically determined def main(): + # Simulation parameter definitions + + n_iterations = 500 + std_dist = [30, 0.5] + x0_actual = [50, 3] + + x_actual = np.zeros([n_iterations, 2]) + x_kalman = np.zeros([n_iterations, 2]) + x_measurement = np.zeros([n_iterations, 2]) + + # Kalman Filter parameter definition x0 = [100, 50] @@ -35,17 +46,6 @@ def main(): G = 0 R = [[std_dist[0]**2, 0], [0, std_dist[1]**2]] - - # Simulation parameter definitions / initialization - - n_iterations = 500 - std_dist = [30, 0.5] - x0_actual = [50, 3] - - x_actual = np.zeros([n_iterations, 2]) - x_kalman = np.zeros([n_iterations, 2]) - x_measurement = np.zeros([n_iterations, 2]) - x_actual[0] = x0_actual x_kalman[0] = x0