[发明专利]用于利用传感器融合来确定机器状态的系统和方法

摘要

公开了一种确定机器的实时状态的方法，包括：利用至少一个处理器从安装在机器的不同部件上的多个惯性测量单元(IMU)中的每一个接收信号的时间序列，该信号指示多个IMU中一个或多个安装在其上的机器的部件中每一个的运动测量值的加速度和角速率。针对机器的单独部件上IMU中的每一个，通过合并来自IMU的加速度测量值以及运动测量值的角速率，利用单独卡尔曼滤波模块融合从IMU接收的信号，以估计IMU安装在其上的机器的部件的输出联合角度。合并连续时间步中部件的输出联合角度的估计值和测量值，求解运动学方程以在连续时间步下确定机器部件的位置、速度和加速度中至少一个的实时值，以及将确定的实时值在机器部件的受控操作移动的实施中应用。

主权项

1.一种确定机器的实时状态方法，包括：利用至少一个处理器从安装在所述机器的不同部件上的多个惯性测量单元(IMU)中的每一个接收信号的时间序列，所述信号指示所述多个IMU中一个或多个安装在其上的所述机器的所述部件中每一个的运动测量值的加速度和角速率；针对所述机器的单独部件上所述IMU中的每一个，利用所述至少一个处理器的单独卡尔曼滤波器模块融合从所述IMU接收的所述信号，对来自所述多个IMU中每一个的所述信号的融合包括：合并来自所述IMU的加速度测量值以及运动测量值的角速率，以在一系列时间步的某时间步期间估计所述IMU安装在其上的所述机器的所述部件的输出联合角度；基于来自先前时间步的所述输出联合角度的估计，在后续时间步中生成对所述部件的所述输出联合角度的先验估计；将所述输出联合角度的所述先验估计与所述先验估计的准确度的估计和从所述IMU接收的当前测量值合并以产生所述输出联合角度的精确后验估计；将所述机器的多个部件的所述输出联合角度的所述精确后验估计彼此相互并参考机器参考框架进行融合，以参考所述机器参考框架确定所述机器的所述多个部件中每一个的当前输出联合角度的最佳估计；利用所述机器的所述部件的当前输出联合角度的所述最佳估计以及表征所述机器的结构设计信息来求解运动学方程；在所述一系列时间步的连续时间步下，通过所述运动学方程的解确定感兴趣的每个机器部件的位置、速度和加速度中至少一个的实时值；以及在每个感兴趣机器部件的受控操作移动的实施中应用所述确定的实时值。