compute Kalman gain
D = Dh@B@Dh.T + R
K = B @ Dh @ np.linalg.inv(D)