-
公开(公告)号:CN118033537A
公开(公告)日:2024-05-14
申请号:CN202410269473.5
申请日:2024-03-11
Applicant: 广州大学
Abstract: 本发明公开了一种基于协同定位的UWB三维动态目标定位方法,该方法包括下述步骤:设置基站三维布局作为固定基站组,建立空间直角坐标系,以定位区域的各几何边界中点进行区域划分;基于无人机搭载辅助节点,基于改进的TL‑LFL算法对定位目标和辅助节点进行定位,初步确定定位目标和辅助基站所在位置,保持辅助节点工作状态的切换,将辅助节点移动至定位目标附近并保持设定距离,辅助节点与固定基站组中的部分基站构成辅助基站组,基于辅助基站组对定位目标进行定位。本发明有效提高了UWB定位的精度和稳定性。
-
公开(公告)号:CN119584278A
公开(公告)日:2025-03-07
申请号:CN202411622596.9
申请日:2024-11-14
Applicant: 广州大学
Abstract: 本发明公开了一种基于UWB与IMU的多算法协同三维定位方法,该方法包括:基于多个UWB基站构建三维空间直角坐标系,通过双边双向测距测得标签与UWB基站的距离,得到对应的距离变量;通过三边定位算法建立非线性方程组,代入距离变量转化为线性误差方程组,通过牛顿迭代法得到标签的一组三维坐标;通过到达时间差得到非线性方程组,基于泰勒展开近似得到线性误差方程组,通过最小二乘法得到标签的另一组三维坐标;对两组三维坐标加权平均得到初始三维坐标;基于初始三维坐标、速度分量、加速度分量构建状态转移模型,基于卡尔曼滤波预测下一时刻的状态并更新标签的三维坐标,输出最终三维空间定位结果。本发明能实现高精度的三维定位。
-