欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2019106529543
申请人: 仲恺农业工程学院
专利类型:发明专利
专利状态:未下证
专利领域: 测量;测试
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种基于UWB通信技术的牛室内定位系统,其特征在于:包括定位处理器,在该定位处理器上连接有U个UWB接收装置,U个所述UWB接收装置用于安装在牛圈顶部,U个所述UWB接收装置均用于接收G个UWB发射装置发出的位置数据,从而得到测量数据,G个所述UWB发射装置分别佩戴在G头牛上,在所述定位处理器内设置有数据优化模块,用于根据测量数据和跳变滤波器获取牛的运动状态,并结合运动状态选择扩展卡尔曼滤波算法或者中值滤波算法对测量数据进行优化处理。

2.根据权利要求1所述的基于UWB通信技术的牛室内定位系统,其特征在于:所述UWB接收装置为UbiseUse系列7100IP传感器;

所述UWB发射装置为UbiseUse系列7100工业标签。

3.根据权利要求2所述的基于UWB通信技术的牛室内定位系统,其特征在于:所述位置数据至少包括当前牛坐标、数据发出时间;

所述UWB接收装置根据获取到的位置数据,确定数据接收时间;

所述UWB接收装置结合所述数据发出时间和数据接收时间得到数据到达时间差;

所述UWB接收装置结合当前牛坐标和UWB接收装置的安装坐标,得到数据到达角度;

所述UWB接收装置结合当前时刻牛坐标和前一时刻牛的坐标,得到牛运动的角度、速度;对时间求导得到转速和加速度。

4.一种基于UWB通信技术的牛室内启发式跳变滤波定位方法,其特征在于按照以下步骤进行:S1:采集牛活动牛圈尺寸,安装U个UWB接收装置,并向G头牛分别佩戴一个UWB发射装置,并建立所有UWB发射装置与U个UWB接收装置的通信连接,U个UWB接收装置与定位处理器的通讯连接;

S2:根据牛圈尺寸,建立牛圈坐标系,并获取U个UWB接收装置的安装坐标;

S3:定位处理器设定UWB接收装置的数据接收间隔时间和数据采集时间段,并获取G个UWB发射装置的位置数据;

S4:定位处理器根据UWB发射装置发送的位置数据、UWB接收装置的数据接收时间、U个UWB接收装置的安装坐标,得到测量数据;

S5:定位处理器采用跳变滤波器对测量数据进行去噪,并对牛在该数据采集时间段的运动状态进行判定,并根据运动状态选择数据处理方法,对测量数据进行处理,得到优化测量数据;

S6:定位处理器根据该数据采集时间段内的优化测量数据,得出牛当前的生长状态。

5.根据权利要求4所述的基于UWB通信技术的牛室内启发式跳变滤波定位方法,其特征在于:在步骤S3中,所述位置数据至少包括当前牛坐标以及数据发出时间;

在步骤S4中,所述测量数据至少包括数据到达时间差、数据到达角度、牛运动的角度、速度、转速和加速度;

所述数据到达时间差等于所述数据发出时间与所述数据接收时间的差值;

所述数据到达角度为当前牛坐标与UWB接收装置的安装坐标的相对角度;

所述角度、速度根据当前时刻牛坐标和前一时刻牛的坐标计算得到;

所述转速和加速度根据时间求导得到。

6.根据权利要求5所述的基于UWB通信技术的牛室内启发式跳变滤波定位方法,其特征在于:在步骤S5中,若任意一点pt满足噪音标准公式,则从测量数据删除该店,实现去噪;

其中,噪音标准公式为:

t表示数据采集时间段内的第t个时间点;

pt-1表示UWB发射装置p在第t-1个时间点的坐标;

pt表示UWB发射装置p在第t个时间点的坐标;

pt+1表示UWB发射装置p在第t+1个时间点的坐标;

d(pt,pt-1)表示UWB发射装置p在第t个时间点的坐标与UWB发射装置p在第t-1个时间点的坐标的欧几里德距离;

d(pt,pt+1)表示UWB发射装置p在第t+1个时间点的坐标与UWB发射装置p在第t个时间点的坐标的欧几里德距离;

d(pt-1,pt+1)表示UWB发射装置p在第t+1个时间点的坐标与UWB发射装置p在第t-1个时间点的坐标的欧几里德距离。

所述运动状态包括静止状态和移动状态,若满足连续T个点相邻两点之间的距离均大于g米,则判定牛处于移动状态;否则,判定为牛处于静止状态。

7.根据权利要求6所述的基于UWB通信技术的牛室内启发式跳变滤波定位方法,其特征在于:在步骤S5中,当牛处于移动状态时,采用扩展卡尔曼滤波算法对测量数据进行估算处理,具体内容为:SA1:令牛的运动模型为:M=[x y z θ v ω a];

SA2:假设牛的运动方向和速度是随机的,则采用改进的维纳过程对运动模型进行改进,得到连续时间模型f(M):其中,Dω为转速ω的阻尼系数,当转速值减小到原始转速值的十分之一时所用给的时间是Tω,则Da为加速度a的阻尼系数;当加速度值减小到原始加速度值的十分之一时所用给的时间是Ta,则Dv为速度v的阻尼系数;当速度值减小到原始速度值的十分之一时所用给的时间是Tv,则SA3:将步骤SA2得到的连续时间模型转换成离散时间模型,得到离散时间模型Mk为:其中,

SA4:根据步骤SA3得到离散时间模型Mk,求取离散状态传递函数的雅可比行列式Fk-1;采用直接测量方式得到测量函数的雅可比行列式H;

其中,u为控制增益;

SA5:根据离散状态传递函数的雅可比行列式Fk-1和测量函数的雅可比行列式H,得到位置方程,该位置方程包括位置状态向量和位置观测向量,从而得到移动状态下的优化测量数据;

其中,位置状态向量:Mk=Fk-1Mk-1+qk;qkN(0,Qk);

位置观测向量:

其中,Qk=diag[0.1hk 0.1hk 0.1hk 0.01hk 0.01hk 0.005hk 0.005hk];

R=diag[0.5 0.5 0.5];

Qk、R均为方差矩阵;qk是过程激励噪声;r是观测噪声。

qkN(0,Qk)表示过程激励噪声qk均值为0,方差为Qk;

rN(0,R)表示观测噪声r均值为0,方差为R。

8.根据权利要求7所述的基于UWB通信技术的牛室内启发式跳变滤波定位方法,其特征在于:在步骤SA3,假设对当前时刻k的位置方程mk和nk进行离散化时,前一时刻k-1的速度vk-1和方向θk-1是恒定的。

9.根据权利要求6所述的基于UWB通信技术的牛室内启发式跳变滤波定位方法,其特征在于:在步骤S5中,当牛处于静止状态时,采用中值滤波算法,用过滤点和相邻点的移动中值替换数据中的值,对测量数据进行处理,从而得到优化测量数据。

10.根据权利要求6所述的基于UWB通信技术的牛室内启发式跳变滤波定位方法,其特征在于:对于丢失的数据,采用线性分段插值法进行插值填补操作。