基于UWBLOC的自主跟随机器人定位方法
和其它定位相比较,UWBLOC技术优点在于低功耗、低成本、抗多径能力和穿透能力强,另外,UWBLOC的无线通信空间容量达1Mbit/(s·m2),远优于其它技术,适用于室外和室内定位。本文提出一种基于UWBLOC的定位方法和系统,可实现自主跟随机器人相对于人的定位,从而实现机器人跟随人的目的。
UWBLOC技术
超宽带(UWBLOC)技术是一种传输速率高(最高可达1 000Mbps以上)、发射功率较低、穿透能力较强,并且基于极窄脉冲的无线定位技术,无载波。无线定位算法可分为基于距离的定位算法和与距离无关的定位算法两类。与距离无关的定位算法节点硬件要求较低,但精度低。UWBLOC一般采用基于距离的定位算法。目前,最常用的定位算法主要有:信号到达角度定位(AOA)、信号强度分析法(RSS)、到达时间定位(TOA)、到达时间差定位(TDOA)等。
(1)到达角度定位(AOA)和信号强度分析法(RSS)。
基于信号到达角度的定位算法是一种典型的基于测距的定位算法,通过硬件设备感知发射节点信号的到达方向,计算接收节点和锚节点之间的相对方位或角度,再利用三角测量法或其它方式计算出未知节点的位置。RSS根据信号的传播模型,利用信号接收强度与信号传播距离的关系,对目标进行定位,此方法对信道环境十分敏感。
(2)到达时间定位(TOA)。
到达时间定位(TOA)计算测量信号从发射端传至接收端所需的时间,再根据信号传播的速度计算出发射端与接收端之间的距离。以每一个发射端作为圆心,以发射端与接收端的距离为半径作圆或球(二维平面作圆,三维平面作球),圆或者球的交点即为被测点的位置。TOA要求接收端与发射端的时间同步。
(3)到达时间差定位(TDOA)。
到达时间差定位(TDOA)是根据发射端发出信号到达不同基站的时间差,计算出移动台到基站间的距离。由移动台到两个基站的距离差得到一条双曲线,要求解目标点的坐标至少需要3个基站双曲线方程组。TDOA方法不需要基站与移动台时钟同步,只需要基站之间的时钟同步即可。
通过UWBLOC技术中的到达时间(TOA)定位算法,计算出人对于机器人的相对位置,实现机器人对人的跟随。
如图下图所示,移动机器人在室内或室外环境中移动时,机器人上安装有3个UWBLOC跟随模块传感器作为基站,人和机器人处在同样环境中,身上穿戴有一个UWBLOC跟随模块传感器作为标签,假设人初始时刻已被机器人锁定。3个基站按等边三角形三个顶点位置固定在移动机器人上,用来发射UWB信号,标签接收到信号后,通过TOA算法可算出标签分别距3个基站的距离,并通过几何运算得到人相对于机器人的位置。
坐标模型及定位算法
机器人和人所处的环境是三维空间,以机器人本身为参考系建立一个局部坐标系统。如图下图所示,定义3个基站位置距离AB、BC、AC均为a;定义BC边上的高所在延长线为y轴,y轴正向与机器人自身的方向一致;3个基站构成的等边三角形AB边的中点为O(0,0,0);标签坐标为M(x,y,z),其中z为标签到基站所在水平面的高度;等边三角形的中心为H。
根据3个基站到标签的距离,通过解析几何可以算出标签M在等边三角形所在平面的投影M点到等边三角形中心的距离:
L=MH=(d14+d24+d34-d12d22-d12d32-d22d32)÷(3a2)(1)
标签M在等边三角形所在平面的投影M′点与等边三角形中心H点的连线,即MH与y轴的夹角即方位角:
θ=∠MHA=arctan(3(d32-d22)÷(-2d12+d22+d32))(2)
由此,人的位置坐标可以表示为(L,θ),即确定出人相对于机器人的位置信息,所得位置误差范围在±100mm以内,位置信息基于机器人和人直接计算,不存在累积误差。
跟随方案
利用人相对于机器人的坐标,机器人实现跟随的步骤为:①机器人根据人的位置坐标,解算出人在以机器人本身为参考坐标系中x,y方向的偏移量;②机器人在x方向上移动,最终使人在坐标系中x方向的偏移量为零;③机器人在y方向上移动,最终使人在坐标系中y方向的偏移量为零;④当人在坐标系中x,y方向的偏移量都为零时,即机器人此时到达人的位置,从而实现跟随。
小车跟随人腾讯视频播放地址https://v.qq.com/x/page/j0508hm8tg2.html
-
化工、石化、炼油厂人员及车辆定位方案
化工厂人员、车辆定位管理系统具有如下的特点:华星智控化工厂人员定位管理系统融合LORA、4G/5G通信技术,基于自研的室内外高精度定位物联网算法,实现对化工厂人员、车辆的实时精确定位,系统具有高精度,免布线,高实时性,高可靠稳定性的核心优势特点。
-
行车、天车防碰撞方案
通过在行车上安装精准测距基站,基站之间实时互相测距,设定一个危险距离R,当行车2和行车1或者行车3的距离小于R时,就会触发继电器工作启动声光报警器提醒司机或者切断电源让天车停止工作。
-
矿山人员车辆定位管理解决方案
矿山人员车辆定位方案是一种设计用于跟踪矿区内运载矿山人员的车辆位置的系统。 该系统通过提供车辆的实时位置信息,对于确保人员安全至关重要。 以下是矿山人员车辆定位方案的一些关键组成部分:GPS跟踪:该方案利用GPS(全球定位系统)跟踪矿山人员车辆的位置。 GPS 跟踪提供准确的位置数据,可用于监控车辆的速度和方向。车辆跟踪软件:从车辆收集的 GPS 数据被发送到中央系统,该系统使用车辆跟踪软件在地图上显示车辆的实时位置。通讯设备:该方案还需要无线电或手机等通讯设备,让车上人员能够与控制室和应急服务部门进行通讯。地理围栏:地理围栏是一项允许该方案在矿区内设置虚拟边界的功能。 如果车辆进入或离开地理围栏区域,该方案将向控制室发出警报。应急响应:该方案应制定应急响应协议,以防发生事故。 这可能涉及应急小组、疏散计划和急救设备。总体而言,矿山人员车辆定位方案是矿山安全的重要组成部分。 通过提供实时位置数据,该方案可以帮助预防事故并对紧急情况做出快速反应。
-
叉车防碰撞方案
车与人防碰撞:叉车上安装精准测距模块和声光报警器,预先设定好安全距离R,测距模块与人员携带的标签测距L,当距离小于预先设定的安全距离R时就触发测距模块的继电器接通声光报警器工作提醒驾驶员注意。
-
工业智能制造,电力电厂,钢铁治金定位方案
高精度人员、物资、车辆精准定位系统基于多维技术融合方案,可以实现10~30厘米的精准位置数据采集,可用于工业智能智能制,造汽车装配,电力电厂,钢铁治金等行业实现对工厂内的人、车、物、料等的精确定位、无缝追踪、智能调配与高效协同,大幅提升工厂的精益生产及精细化管理水平。
-
数据机房人员定位方案
通过在机房内布设有限数量微基站,实时精确地定位巡检人员上的微标签位置,零延时地将巡检人员位置信息显示在机房控制中心,进行安全区域管控、人员在岗监控等。精度达到10厘米级,精确管控以优化流程、合理调度安排、提高数据机房的巡检效率。
-
北斗储油罐、滑坡、采空区位移变形监测方案
北斗位移监测可实现水平±2.5毫米,垂直±5.0毫米的位置变化监测,可以用于滑坡,道路边坡,采空区,尾矿库,水库大坝,铁塔,储油罐等的形变监测,通过长期的连续监测,掌握被监测体的位置变化趋势,避免灾害事故发生。
-
隧道错车智慧调度方案
铁路隧道施工过程中,由于隧道宽度比较窄,只在固定的距离处有错车位置,当车辆交汇位置距离错车位置比较远的时候车辆需要倒车到错车位置才能错车,这就会导致花费很多时间来错车,大大的降低了工作效率。