主要内容

COLLACACC.

恒定加速度运动模型

描述

例子

更新= constacc(状态的)返回更新状态,状态,恒定加速Kalman滤波器运动模型一秒的步进时间。

例子

更新= constacc(状态DT.的)指定时间步长,DT.

更新= constacc(状态W.DT.的)还指定了状态噪声,W.

例子

全部收缩

为2-D常规加速运动定义初始状态。

状态= [1;1;1;2;1;0];

预测稍后1秒钟。

State = COLLACC(州)
国家=6×12.5000 2.0000 1.0000 3.0000 1.0000 0

为2-D常规加速运动定义初始状态。

状态= [1;1;1;2;1;0];

预测0.5秒后的状态。

State = COLLACC(州,0.5)
国家=6×11.6250 1.5000 1.0000 2.5000 1.0000 0

输入参数

全部收缩

Kalman滤波器状态向量,用于恒定加速运动,指定为真实值3N.- 再生矢量。N.是运动自由度的数量。对于每个空间运动程度,状态矢量采用此表中所示的表格。

空间尺寸 状态矢量结构
1-D. [x; vx;斧头]
2-D. [x; vx;斧头; y; vy; ay]
3-D. [x; vx;斧头; y; vy; y; z; vz; az]

例如,X代表了X-协调,vx.代表了速度X- 和斧头代表加速度X-方向。如果运动模型是一维空间,则y- - -Z.-axes被认为是零。如果运动模型处于二维空间,则沿着Z.-AXIS被认为是零。位置坐标是米米的。速度坐标位于米/秒。加速坐标是米/秒2

例子:[5; 0.1; 0.01; 0; -0.2; -0.01; -3; 0.05; 0]

数据类型:双倍的

过滤器的时间步长间隔,指定为正标量。时间单位是几秒钟的。

例子:0.5

数据类型:单身的|双倍的

状态噪声,指定为标量或实值D.-经过-N.矩阵。D.是运动尺寸的数量和N.是国家向量的数量。如果指定为标量,则标量值将被扩展为aD.-经过-N.矩阵。

数据类型:单身的|双倍的

输出参数

全部收缩

更新状态向量,作为实值的向量或具有相同数量的元素和尺寸作为输入状态向量的实值矩阵返回。

算法

对于二维常数加速过程,达到时间的状态转换矩阵,T.,为块对角线:

[ X K. + 1 V. X K. + 1 一种 X K. + 1 y K. + 1 V. y K. + 1 一种 y K. + 1 ] = [ 1 T. 1 2 T. 2 0. 0. 0. 0. 1 T. 0. 0. 0. 0. 0. 1 0. 0. 0. 0. 0. 0. 1 T. 1 2 T. 2 0. 0. 0. 0. 1 T. 0. 0. 0. 0. 0. 1 ] [ X K. V. X K. 一种 X K. y K. V. y K. 一种 y K. ]

每个空间维度的块都有这样的形式:

[ 1 T. 1 2 T. 2 0. 1 T. 0. 0. 1 ]

对于每个额外的空间维度,添加一个相同的块。

扩展能力

C / C ++代码生成
使用MATLAB®Coder™生成C和C ++代码。

在R2017A介绍