摘要: CKF计算流程梳理 # 3:t-1时刻容积点计算 #分解成AT*A(下三角*上三角)取下三角 S1 = np.linalg.cholesky(Pk) #计算容积点,repmat()把元素复制m行n列 # t-1时刻的2n个容积点 # 4:传播容积点,把每一个容积点带入非线性运动状态转移方程,计算出状 阅读全文
posted @ 2022-03-12 18:46 西北逍遥 阅读(467) 评论(0) 推荐(0) 编辑