1.一种基于动态时延的卡尔曼滤波补偿方法,其特征在于,包含如下步骤:S1、利用数据采集器采集任意一组数据后,控制数据采集器自身输出一脉冲给控制器作为一组数据获取结束的标志,控制器记录此时的时刻ti;
S2、控制器在获得该组数据后,对数据进行解析,在控制器自身完成对于该组数据的解析后,会根据解析后的数据进入定时器中断修改控制量,记录进入定时器的时间tn;其中,控制器会按照固定的控制周期T'控制一受控模块;
S3、计算时延:Δt=tn-ti;
S4、计算Δt/T'后进行取整处理得到补偿步数N;
S5、利用补偿步数N进行卡尔曼滤波时后续时延期间观测量的拟合估计,进而对当前时刻状态量进行补偿估计。
2.根据权利要求1所述的基于动态时延的卡尔曼滤波补偿方法,其特征在于,数据采集器包括:摄像头、声音传感器、红外传感器、浓度传感器、温度传感器、陀螺仪。
3.根据权利要求1所述的基于动态时延的卡尔曼滤波补偿方法,其特征在于,取整处理为下述取整方式中的任意一种:四舍五入、去掉小数位保留整数、向上取整以及向下取整。
4.根据权利要求1所述的基于动态时延的卡尔曼滤波补偿方法,其特征在于,步骤S5中,卡尔曼滤波包括:Step1:将系统状态和过程噪声一起作为新过程方程的状态,进行一次过程方程重构,重构后得过程噪声为ξk-1;
Step2:通过观测差分,进行一次观测方程重构,根据重构后的观测方程获得系统的相关参数并达到噪声分离,其中获得的观测噪声记为Step3:根据ξk、 的统计特性,得到它们之间的相关性;
Step4:结合Step2新得到的观测方程,对一次重构后的过程方程进行二次重构,获得系统的相关参数并达到噪声分离,其中获得的新过程噪声记为 包含了ξk及Step5:结合Step 3的噪声统计特性分析,获取二次重构后的新过程噪声 及新观测噪声 满足Kalman滤波噪声数学特性所涉及到的参数,实现噪声相关性消除;
Step6:利用噪声相关性消除后的数据进行新卡尔曼滤波器的构建。
5.一种基于动态时延的卡尔曼滤波补偿系统,其特征在于,包含如下模块:数据采集模器,用于利用数据采集器采集任意一组数据后,控制数据采集器自身输出一脉冲给控制器作为一组数据获取结束的标志,控制器记录此时的时刻ti;
数据处理模块,控制器在获得该组数据后,对数据进行解析,在控制器自身完成对于该组数据的解析后,会根据解析后的数据进入定时器中断修改控制量,记录进入定时器的时间tn;其中,控制器会按照固定的控制周期T'控制一受控模块;
时延计算模块,用于计算时延:Δt=tn-ti;
补偿步数计算模块,用于计算Δt/T'后进行取整处理得到补偿步数N;
补偿步数处理模块,用于利用补偿步数N进行卡尔曼滤波时后续时延期间观测量的拟合估计,进而对当前时刻状态量进行补偿估计。
6.根据权利要求5所述的基于动态时延的卡尔曼滤波补偿方法,其特征在于,数据采集器包括:摄像头、声音传感器、红外传感器、浓度传感器、温度传感器、陀螺仪。
7.根据权利要求5所述的基于动态时延的卡尔曼滤波补偿方法,其特征在于,取整处理为下述取整方式中的任意一种:四舍五入、去掉小数位保留整数、向上取整以及向下取整。
8.根据权利要求5所述的基于动态时延的卡尔曼滤波补偿方法,其特征在于,补偿步数处理模块中,卡尔曼滤波包括:依次重构单元,用于将系统状态和过程噪声一起作为新过程方程的状态,进行一次过程方程重构,重构后得过程噪声为ξk-1;
噪声分离单元,用于通过观测差分,进行一次观测方程重构,根据重构后的观测方程获得系统的相关参数并达到噪声分离,其中获得的观测噪声记为相关性获取单元,用于根据ξk、 的统计特性,得到它们之间的相关性;
二次重构及噪声分离单元,用于结合噪声分离单元新得到的观测方程,对一次重构后的过程方程进行二次重构,获得系统的相关参数并达到噪声分离,其中获得的新过程噪声记为 包含了ξk及相关性消除单元,用于结合相关性获取单元的噪声统计特性分析,获取二次重构后的新过程噪声 及新观测噪声 满足Kalman滤波噪声数学特性所涉及到的参数,实现噪声相关性消除;
卡尔曼滤波单元,用于利用噪声相关性消除后的数据进行新卡尔曼滤波器的构建。