欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2023105782023
申请人: 吉林大学
专利类型:发明专利
专利状态:已下证
专利领域: 医学或兽医学;卫生学
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种基于UWB的骨科手术导航的芯片级定位方法,其特征在于,包括以下步骤:S1,铺设定位基站,并在手术器械上布置UWB无线定位模块,定位基站以及手术器械上布置的UWB无线定位模块采用相同的UWB模块单元;

S2,实时定位,首先将原始TDOA值代入Chan算法,计算获取UWB定位标签的初步定位坐标,然后计算其残差平方和,并设置阈值,剔除误差高于阈值的TDOA测量值,将筛选出的符合要求的TDOA测量值重新带入标准EKF滤波算法中,即可得到最终手术器械的位置坐标;

所述步骤S2中的具体步骤为:

S21,TDOA定位;

TDOA到达时间差算法,该算法是通过测量两个参考基站接收到目标节点发出的广播信号的时间差,用波速乘时间求出目标节点到两个参考基站的距离差值,以两个参考基站作为曲线焦点,以信号到达两个基站距离差为2a得到双曲线方程,一个双曲线方程无法求出目标节点,因此至少要用三个基站,求出两个双曲线方程,该双曲线的交点即为目标节点;

S22,基于TDOA技术定位的Chan算法;

利用两步加权最小二乘法对目标的位置进行定位解算,在小范围和大范围的定位系统中都适用,求解过程中,先对非线性的TDOA方程组处理换算成线性方程,然后通过WLS估计初始解;再对其结果第二次使用WLS计算,进一步估计定位标签的坐标;

S23,基于TDOA技术定位的EKF算法;

基于TDOA技术的UWB定位系统中,TDOA方程组是非线性方程,所以采用拓展卡尔曼滤波解决非线性问题,扩展卡尔曼滤波的思想是,对于一种非线性系统,可利用数值解析手段将这个系统离散化,在计算点邻域泰勒展开,将超过二次的项删去,仅保留一次项,使卡尔曼滤波运用于非线性系统;

S24,定位标签位置坐标估计;

将筛选出的较小误差的TDOA测量值重新带入标准EKF滤波算法中,即可得到最终手术器械的位置坐标;

所述的步骤S21,TDOA定位的具体线性方程为:

各基站坐标从BS1开始顺时针分别设为(x1,y1)、(x2,y2)、(x3,y3),所以,需要求解的标签坐标为(x,y),待测节点测量信号的到达BS1时间为ti(i=2,3),以BS1、BSi为焦点,以Di,1=di-d1=2a画双曲线方程,待测节点到基站i的距离关系用两点间的距离公式得出:待测节点到主要定位基站BS1的距离与到其他基站之间的距离Di之间的距离与时间差的关系如下所示:c表示目标发出的电磁波在介质中的传播速度,除了主基站还要两个以上的基站才可以完成对目标节点的确定,由此可得到如下双曲线非线性方程组:通过Chan算法求解x,y即得到标签坐标;

所述的步骤S23,基于TDOA技术定位的EKF算法的具体线性方程为:设非线性系统为:

时间更新方程:

更新测量方程:

上述流程中,φ是状态转移矩阵;H是h函数对状态所求的雅可比矩阵;

T为采样时间,有

φ=I+F×T

式中,f为状态方程;h为观测方程;x为状态量;u为输入量;w、v为过程噪声和观测噪声;P为误差协方差矩阵;K为卡尔曼增益。

2.根据权利要求1所述的一种基于UWB的骨科手术导航的芯片级定位方法,其特征在于:所述的步骤S24,定位标签位置坐标估计的具体线性方程为:首先,首先将原始TDOA值代入Chan氏算法,计算获取UWB定位标签的初步定位坐标,然后计算其残差平方和,计算公式为:然后进行误差剔除,残差的作用是衡量一组TDOA值和对应定位结果两者间的接近程度,在UWB定位系统误差的主要来源是NLOS误差的情况下,NLOS误差对一组测量值影响越大,其计算得到的残差值越大;

因此,设置门限值为Rws≤Δ,与残差值进行比较,剔除包含较大NLOS误差的TDOA测量值;

当残差值大于门限值时,说明Chan氏算法计算获得的估计坐标到基站的距离差值与传感器测量获得的标签到基站之间的TDOA测量值存在较大偏差,在NLOS误差作为定位系统的主要误差时,表明TDOA测量值含有较大的NLOS误差,则将对应的一组TDOA测量值剔除;

若残差值小于等于门限值,则视为测量值的误差较小;

最后,定位标签位置坐标估计,将筛选出的较小误差的TDOA测量值重新带入标准EKF滤波算法中,即可得到最终手术器械的位置坐标。

3.根据权利要求2所述的一种基于UWB的骨科手术导航的芯片级定位方法,其特征在于:所述的UWB模块单元包括依次电连接的主控芯片、信号处理芯片、射频功放电路和供电单元,所述的射频功放电路还电连接有三态电源缓冲器。

4.根据权利要求3所述的一种基于UWB的骨科手术导航的芯片级定位方法,其特征在于:所述的主控芯片和信号处理芯片间的电连接方式为双向电连接。

5.根据权利要求4所述的一种基于UWB的骨科手术导航的芯片级定位方法,其特征在于:所述主控芯片的型号为STM32F407,所述信号处理芯片的型号为DW100,所述供电单元的型号为TPS61240,所述三态电源缓冲器的型号为SN74LV1T125。