Robotics, Kalman Filter, Robot Operating System, State Estimation, Artificial Intelligence.
def linear_velocity_motion_model(): def state_transition_matrix_A(): A = np.eye(3) return A def control_input_matrix_B(mu, delta_t): theta = mu[2] print(theta, delta_t) B = np.array([ [np.cos(theta) * delta_t, 0], [np.sin(theta) * delta_t, 0], [0, delta_t] ]) return B return