申请/专利权人：上海有个机器人有限公司

申请日：2021-04-02

公开（公告）日：2024-04-05

公开（公告）号：CN112989625B

主分类号：G06F30/20

分类号：G06F30/20;G06F17/16;G06F119/02

优先权：

专利状态码：有效-授权

法律状态：2024.04.05#授权;2021.07.16#实质审查的生效;2021.06.18#公开

摘要：本申请是关于一种UWB传感器异常值的剔除方法、电子设备及存储介质，通过平方根信息滤波器对电梯的状态预测进行优化，得到系统状态和系统不确定性的时序转移函数；读取UWB传感器以及惯性测量传感器的数据，得到电梯的状态测量函数；根据惯性测量传感器的数据，通过马氏距离优化UWB传感器的数据；根据系统状态的时序转移函数、系统确定性的时序转移函数以及状态测量函数，通过UWB传感器观测构建当前电梯的系统状态的代价项，得到电梯的下一系统状态的最优估计，以此使得平方根信息滤波器融合惯性测量传感器的加速度数据和UWB传感器的数据，以此来估计电梯的运动状态和运动状态的不确定性，实现实时地剔除UWB传感器数据的异常值。

主权项：1.一种UWB传感器异常值的剔除方法，用于电梯定位系统中，其特征在于，包括以下步骤：步骤1，设定电梯的初始状态，初始状态包括：电梯的位置以及电梯的速度；步骤2，根据电梯的初始状态预测电梯的下一个系统状态，得到电梯的状态预测；步骤3，通过平方根信息滤波器对电梯的状态预测进行优化，得到系统状态的时序转移函数和系统不确定性的时序转移函数；步骤4，读取UWB传感器以及惯性测量传感器的数据，得到电梯的状态测量函数；步骤5，根据惯性测量传感器的数据，通过马氏距离优化UWB传感器的数据；步骤6，根据系统状态的时序转移函数、系统确定性的时序转移函数以及状态测量函数，通过UWB传感器观测构建当前电梯的系统状态的代价项，得到电梯的下一系统状态的最优估计；所述方法还包括：步骤7，根据电梯的下一系统状态的最优估计，更新电梯的系统状态以及电梯的系统不确定性；电梯的初始状态为：xi＝{vi,pi}；x0＝{v0，p0}；P0＝R0-1R0-T；其中，xi表示电梯在i时刻的系统状态真实值，pi表示电梯在i时刻的位置真实值，vi表示电梯在i时刻的速度真实值，x0表示电梯在初始时刻的系统状态真实值，P0表示系统状态的初始协方差矩阵，R0表示初始状态的信息矩阵的平方根；系统状态的时序转移函数为： 其中Φ，G为系统参数，为电梯在i时刻的状态预测值；系统不确定性的时序转移函数为： 其中为i时刻的系统的协方差矩阵，Pa为加速度计噪声的方差；其中， 通过平方根信息滤波器对电梯的状态预测进行优化，得到系统状态的时序转移函数和系统不确定性的时序转移函数具体包括：通过cholesky分解将i时刻的系统的协方差矩阵转换为i时刻的系统信息矩阵的平方根Ri，其中读取UWB传感器以及惯性测量传感器的数据，得到电梯的状态测量函数具体包括：在i时刻使用惯性测量传感器的数据，得到电梯的系统状态测量值；根据电梯的系统状态测量值，联合电梯在i时刻的系统状态预测值建立代价项，得到电梯在i时刻的系统状态代价项；电梯在i时刻的系统状态代价项的函数为： 其中，表示电梯在i-1时刻的系统状态真实值xi-1与预测值之间的误差；表示惯性测量传感器的测量值与系统状态预测值之间的误差；Rwi-1表示惯性测量传感器的过程噪声在i-1时刻的信息矩阵的平方根。

全文数据：

权利要求：

百度查询： 上海有个机器人有限公司 UWB传感器异常值的剔除方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD