Python kalman_predict示例

示例#1

def main(args):
    dt = sp.Symbol('dt')
    A_d = (A*dt).exp()
    G_d = A_d*G

    (x_pre, P_pre) = ctrl.kalman_predict(A_d, None, G_d, Q)
    (x_cor, P_cor) = ctrl.kalman_correct(C, None, R)

    kalman_sys_export(x_pre, P_pre, x_cor, P_cor, args.outfile)

示例#2

文件： vertical_dynamics_kalman_filter.py 项目： rckTom/alturia-firmware

def predict():
    dt = sp.Symbol('dt')
    A_d = (A * dt).exp()
    G_d = A_d * G

    return ctrl.kalman_predict(A_d, None, G_d, Q)