一种基于UWB定位的自动跟随露营载物车

背景技术：

0、(二)背景技术

1、随着现代生活质量的不断提高，智能轻便户外露营的市场逐渐扩大，专业露营者与普通家庭对于产品的多元化需求也逐渐增多。露营载物车作为一种方便用户携带户外露营用品的载物工具，其便利性、安全性、功能性往往成为家庭的关注点。目前市场上的露营载物车大多为人力驱动，长时间的推行十分困难，往往使操作者没到营地就感觉劳累。偶有露营载物车想要停靠或在路上休息时发生滑动，承载物体超过露营载物车载重上限导致车体损坏等情况。因此需要提出新的技术解决方案，减轻操作者体力负担的同时保证露营载物车的行驶及载重安全性。

2、目前市面上的自动跟随机器人等设备大多是定制化产品，大部分是基于gps、蓝牙、超声波、红外、视觉图像或者激光雷达等技术。尽管已有多种多样的定位跟随技术，但都有着明显的缺陷。gps技术易受建筑物的影响且在室内无法使用，在近距离跟随定位方面仍然存在定位精度差的问题；蓝牙技术作用距离有限，通信能力差，整合到其他系统难度较大；超声波技术会出现在传输过程中其信号不断衰减的现象，将导致无法锁定目标从而产生偏离而失去定位，红外技术受墙体或障碍物阻隔时信号强度低、实用性差；视觉图像技术的计算量往往过于庞大且对于具有相似特征的图像往往难以准确判断。

3、本发明利用uwb定位技术不受环境、遮挡影响，抗干扰能力强，精度高，部署成本低等特点，通过uwb定位技术及马达驱动转向实现露营载物车对目标的自动跟随。uwb技术占用从hz到ghz的较宽频谱范围，与上述定位跟随技术相比有着更强的抗外界干扰能力，还保持着功耗低、精度高的优势。

4、本发明采用将uwb定位技术和超声波雷达、红外线传感器相结合的感知跟随避障方案，具有定位范围大、跟随效果好、避障功能灵敏的特点；用户在使用时可通过可穿戴式人机交互界面设定跟随距离，查看跟随载物车的实时续航里程、电量、跟随速度、载重重量等值；露营载物车在检测到不安全行驶环境或车体超载时都将发出警报；本发明设计适应不同人群使用，解放人们的双手，比传统设计提高了人机交互体验，在提高劳动效率的同时增添了趣味性；

技术实现思路

0、(三)
技术实现要素：

1、本发明提出一种基于uwb定位的自动跟随露营载物车，能利用uwb定位技术不受环境、遮挡影响，抗干扰能力强，精度高，部署成本低等特点，通过uwb定位技术及马达驱动转向实现露营载物车对目标的自动跟随和智能避障。

2、本发明采用以下技术方案。

3、一种基于uwb定位的自动跟随露营载物车，其特征在于包括车体、中央控制单元、跟随模块、避障模块、制动模块、驱动模块、载重感应模块、警报模块和可穿戴式人机交互界面；所述中央控制单元、跟随模块、避障模块、制动模块、驱动模块、载重感应模块、警报模块分别安装在所述车体上，所述可穿戴式人机交互界面安装在被跟随用户端上并通过蓝牙与中央控制单元进行数据交换；

4、所述的避障模块内置有超声波雷达和红外感应雷达，以多传感器信息融合的方式对露营载物车行进路径上的障碍物进行监测，当检测到露营载物车周围有障碍物时，所述的避障模块将检测信息传送给所述的中央控制单元，中央控制单元计算出与障碍物的相对时速并判断是否为活体障碍，进而向驱动模块和制动模块发送相应信号，中央控制单元同时判断是否控制警报模块进行工作；所述警报模块与中央控制单元相连，内置蜂鸣器，在避障或超重时用于提醒用户。

5、所述的中央控制单元分别与所述的跟随模块、避障模块、制动模块、驱动模块、载重感应模块、警报模块连接，所述的中央控制单元用于接收、定期保存并处理数据，并将处理后的数据发送给相应的执行机构。

6、所述的跟随模块用于与所述的子uwb标签进行实时通信，获取所述的uwb标签相对于露营载物车坐标系原点的实时xy坐标数据，并将所述的实时xy坐标数据以can信号形式传递给所述的中央控制单元；

7、所述载重感应模块与中央控制单元相连，用于将质量信号转化为电信号，并实时报告给中央控制单元，当检测到载重超过车体载重极限时中央控制单元控制警报模块工作；

8、所述避障模块与中央控制单元相连，内置超声波雷达与红外线传感器，以多传感器信息融合的方式对露营载物车行进路径上的障碍物进行监测，所获取信息经由中央控制单元处理，并进一步控制避障模块和警报模块进行工作。

9、所述驱动模块与中央控制单元、转向电机、伺服电机相连，转向电机输出的动力带动助力泵，由助力泵将液压助力油加压，再通过横、直拉杆实现动力转向。私服电机用于精确控制露营载物车的增减速。

10、所述制动模块包括舵机和制动液压缸，所述的舵机用于拉动所述的制动液压缸，向所述的制动液压缸提供制动力，并将制动力传递至制动卡钳，所述的制动卡钳安装在所述的前轮上；

11、所述中央控制单元通过测量脉冲信号在子uwb标签与跟随模块间的往返飞行时间进行定位；具体为子uwb标签向跟随模块发送测距请求，跟随模块在接收到子uwb标签发送的信号后，向子uwb标签回复确认信息。利用tof飞行时间法分别记录请求端信号发送和接收之间的时间间隔与接收端信号发送和接收之间的时间间隔，那么信号在空中的单向飞行时间t可以表示为：

12、

13、根据信号在空中的单向飞行时间t与电磁波传播速度c的乘积可以得到子uwb标签到跟随模块之间的距离d为：d＝c×t；

14、本发明的有益效果是通过高精度uwb定位技术实时定位被跟随用户所在的目标位置，从而计算出露营载物车相对目标位置的方向，通过电机驱动，实现露营载物车对用户的自动跟随功能。并通过避障模块和载重感应模块、警报模块增加了露营载物车的行驶安全性和车体自身承重的安全性，用户通过可穿戴式人机交互界面查看和设置露营载物车参数的设计则增加了人机交互的娱乐性。

15、本发明在被跟随目标减速或停止运动期间，露营载物车减速缓慢地向被跟随目标前进，当被跟随目标重新运动时，露营载物车重新对被跟随目标进行跟随。即使被跟随目标出现了由于某些原因中途停顿的情况，露营载物车也能继续行驶，这样不仅提高了跟随效率，还使得露营载物车的制动次数大大减少，从而提高了露营载物车的续航里程，节约能源，在提高跟随过程中安全性的同时，又增强露营载物车与被跟随目标的交互性。

技术特征：

1.一种基于uwb定位的自动跟随露营载物车，其特征在于：包括车体9及安装在车体9上的中央控制单元1、超声波传感器2和红外线传感器3组成的避障模块、驱动模块4、制动模块5、警报模块6、跟随模块7、载重感应模块8、和安装在被跟随用户端上的可穿戴式人机交互界面10。

2.根据权利要求1所述的一种基于uwb定位的自动跟随露营载物车，其特征在于：用于在室内户外场景实现帮助用户运送货物并智能跟随。所述跟随模块为设置于车体处的三个母uwb基站，被跟随端为设于人机交互界面内的子uwb标签；所述中央控制单元根据定位信息计算所述子母uwb标签间的相对位置，进而控制各执行机构实现露营载物车的移动，使露营载物车与所述被跟随用户端的距离保持在设定阈值范围内；所述可穿戴式人机交互界面设置于被跟随用户端，通过蓝牙与中央控制单元进行数据交换，所述可穿戴式人机交互界面用于设置跟随距离阈值并可实时展示露营载物车的实时续航里程、电量、跟随速度、载重重量等值。

3.根据权利要求1所述的一种基于uwb定位的自动跟随露营载物车，其特征在于：所述的避障模块内置有超声波雷达和红外线传感器，以多传感器信息融合的方式对露营载物车行进路径上的障碍物进行监测，当检测到露营载物车行进路径上有障碍物时，所述的避障模块将检测信息实时传送给所述的中央控制单元，由所述的中央控制单元判断是否为活体障碍后向各执行机构发送命令。

技术总结
本发明公开了一种基于UWB定位的自动跟随露营载物车，其特征是：它由中央控制单元1、超声波传感器2和红外线传感器3组成的避障模块、驱动模块4、制动模块5、警报模块6、跟随模块7、载重感应模块8、车体9以及可穿戴式人机交互界面(被跟随用户端)10组成。跟随模块搭载有三个母UWB基站，将子UWB标签安装在被跟随用户端上；避障模块采用超声波雷达与红外线传感器相结合，以多传感器信息融合的方式对露营载物车行进路径上的障碍物进行监测；载重感应模块用于防止露营载物车超过核定载重上限。本发明可适用于不同人群，用于解放人们的双手，提高生活乐趣和劳动效率，可广泛用于户外露营及日常搬运等生活场景。

技术研发人员：张文涛,戴腾辉,莫波,熊显名,杜浩,余茄禾,梁思创,丁澳
受保护的技术使用者：桂林电子科技大学
技术研发日：
技术公布日：2024/1/14