发明内容
本发明提供一种基于UWB定位技术的自动跟随产品,能够解决背景技术中提及的问题,达到两个点精准定位与跟随的目的。
本发明解决其技术问题的技术方案是:设计一种独特的移动基站控制器装置在跟随产品上,并且配套一个遥控标签,只需将遥控标签与移动基站控制器对码后,即可实现跟随产品跟踪遥控标签行走的目的;所述移动基站控制器设有A基站、B基站与方向调整装置,所述A基站与B基站设置在方向调整装置的左右臂架两端,使A基站与B基站相互之间的距离固定在20-50cm,所述两个基站能多面同步转动调整方向,所述A基站为主基站,B基站为附基站;所述A基站设有与遥控标签通信计算的载波测距定位***A,所述B基站设有与遥控标签通信计算的载波测距定位***B,所述载波测距定位***A能调整A基站、B基站与遥控标签方向的三点方位对称,为了解决跟随产品在跟踪行走时遇到障碍物的问题,还在A基站设有红外线障碍探测器A;在B基站设有红外线障碍探测器B。
本发明通过移动基站控制器的A基站、B基站与遥控标签进行通讯,记录三点的通讯时间,计算三点的距离,运算遥控标签相对于A基站、B基站的位置;控制跟随产品始终跟随遥控标签位置行走。
所述A基站、B基站的载波测距定位***A、载波测距定位***B、遥控标签分别为DW1000芯片以及天线;通过TOF双向测距获得遥控标签相对于基站的距离信息,如图27所示,遥控标签发送poll信息至基站,记录当前时刻为遥控标签发送poll信息时间戳,基站接受到遥控标签发来的poll信息,记录当前时刻为基站接受poll信息时间戳,一定时间的延迟后发送应答信息返回给遥控标签,遥控标签接受到应答信息时记录当前时刻为基站应答poll信息时间戳,遥控标签经过一定延迟后发送final信息至基站,基站在接受到final信息时,记录当前时刻为基站接受final信息时间戳。图27中Ta1,Ta2,Tb1和Tb2这些时间段无需同步遥控标签与基站的时间就可计算得出:
Ta1=2*t+Tb1;
Tb2=2*t+Ta2。
计算可得:
Ta1*Tb2=4*t^2+2*t*(Ta2+Tb1)+Ta2Tb1;
t=(Ta1*Tb2-Ta2*Tb1)/(Ta1+Ta2+Tb1+Tb2)。
获得消息从遥控标签发送至基站所用的时间t,根据光速c求得遥控标签至基站的距离。
通过PDOA(到达相位差)获得遥控标签信号到达两天线的相位差φ。遥控标签上的DW1000芯片在开机后会周期性地发送Blink信息,直至接收到基站的RangingConfig消息响应;根据RangingConfig消息中携带的参数配置DW1000后进入测距阶段,发送Poll消息至基站进行数据交互,交互完成后发送Final消息至基站;基站在接受到遥控标签的Blink信息后会发送RangingConfig消息至遥控标签,然后进行数据交互,可计算出传输时间,获得基站与遥控标签的距离。之后通过两块主从DW1000接受到的Final信息获得相位差φ。
在图25中:
sinθ=b/d,b/λ=φ/2Π,
由此计算可得:
θ=arcsin(φλ/(2Πd))。
其中d应小于λ/2,选用DW1000通道5即带宽分布在6.5GHz左右,λ约等于4.62cm。由以上公式可以算出遥控标签相对于基站的距离以及信号入射的角度,基站通过串口的形式将获得的数据以一定格式传输至控制***,从而控制购物车的运动,也可以将该信息转换成json格式通过串口与上位机通讯,通过上位机程序绘制遥控标签运动轨迹。
图25是PDOA(到达相位差)方式角度测量的理论图。
图26是基站PCB的天线位置图。
图27是TOF(双向测距)方式的数据传输流程图。
表1(表中的角度以天线朝向为起始边)。
|
|
|
|
|
|
|
|
|
|
|
|
实际测量距离(CM) |
20 |
40 |
60 |
80 |
100 |
120 |
140 |
160 |
180 |
200 |
220 |
串口打印距离(CM) |
22 |
41 |
58 |
79 |
102 |
124 |
145 |
165 |
187 |
205 |
226 |
实际测量角度 |
-80 |
-60 |
-45 |
-30 |
-15 |
0 |
15 |
20 |
45 |
60 |
80 |
串口打印角度 |
-84 |
-62 |
-46 |
-28 |
-14 |
0 |
16 |
22 |
47 |
65 |
87 |
所述遥控标签,包括UWB定位模块、电源模块、报警模块、控制模块。
所述报警模块连接有发光器、蜂鸣器、振动器。
所述控制模块连接有控制按钮。
本发明的特征在于:无需建设固定基站,也不需要另外设置辅助移动基站,只需在可行走的跟随产品上设置移动基站控制器,将移动基站控制器与跟随产品的驱动***连接,并且与遥控标签对码后,即可使跟随产品跟踪遥控标签行走。
所述移动基站控制器能调整A基站、B基站与遥控标签的方向始终保持对应;即A基站、B基站装置在可转动的平台上,可任意转动方向,自动调整使两个微型基站与遥控标签的位置距离始终保持成等腰三角点线;并且A基站、B基站可同步竖向任意转动调整红外线障碍探测器A、红外线障碍探测器B与地面的角度。
本发明的有益效果是:跟随产品与遥控标签直接通信、测距、定位、控制与跟踪,无需基站与外网,因此方便简洁,成本低,定位准确,避障灵敏,跟踪稳定;给人们的工作与生活带来便捷。
具体实施方式
下面结合附图与实施例对本发明进一步说明。
在图1、图2中,一种基于UWB定位技术的自动跟随产品,包括跟随产品本体、遥控标签(12),所述跟随产品本体上至少设有移动基站控制器(5)、车轮(6)、舵机(7)、驱动电机(8)、电池(9),所述移动基站控制器(5)装置在跟随产品本体上。
在图3、图4中,所述移动基站控制器(5),包括A基站(501)、A臂架(502)、顶壳(503)、皮带(504)、传动轮(505)、基站转向电机Y(506);还包括Y同步轴(507)、B臂架(508)、B基站(509)、固定盘架(510)、中壳体(511);还包括Z传动轴
(512)、齿轮(513)、基站转向电机Z(514)、同步轴皮带轮(515)、同步轴支架(516)。
在图5、图6、图7中,所述移动基站控制器(5)的中壳体(511)、A臂架(502)、B臂架(508),包括托轴孔A(5021)、A臂架孔(5022)、A臂架加强座(5023)、A臂架加强柱(5024);还包括中壳壁(5111)、中壳筒(5112)、下支撑壁环(5113)、扣槽(5114)、上支撑壁环齿条(5115);还包括托轴孔B(5081)、B臂架孔(5082)、B臂架加强座(5083)、B臂架加强柱(5084)。
在图8、图9、图10中,所述移动基站控制器(5)的A基站(501),包括透明罩(5091)、基站壳(5092)、天线(5093)、屏蔽连接器(5094)、连接孔
(5095)、电路板A(5096)。
所述移动基站控制器(5)的B基站(509)与A基站
(501)结构相同对称的装置在中壳体(511)的A臂架(502)、B臂架(508)的两端,所述的B基站(509)包括透明罩(5091)、基站壳(5092)、天线(5093)、屏蔽连接器(5094)、连接孔(5095)、电路板B(5097);与所述基站A(501)的区别在于A基站(501)的电路板为电路板A(5096),B基站(509)的电路板为电路板B(5097)。
在图11、图22中,所述电路板A(5096),包括UWB定位模块A(50951)、电源模块(50952)、报警模块(50953)、控制模块(50954)、红外模块(50955)、驱动模块(50956)、PCB板A(50957)、红外发射接收管(50958)、蜂鸣器(50959)。
在图12、图23中,所述电路板B(5097),包括UWB定位模块B(50961)、电源模块(50962);PCB板B(50967)、红外发射接收管(50968)。
所述UWB定位模块A(50951)、UWB定位模块B(50961)为DW1000芯片。
在图2、图24中,所述遥控标签(12)包括UWB定位模块、电源模块、控制模块、报警模块;所述报警模块附设有发光器、蜂鸣器、振动器;所述电源模块与电池连接;所述控制模块设有按钮。
所述遥控标签(12)的UWB定位模块为DW1000芯片。
将遥控标签(12)与移动基站控制器(5)对码后,即可持遥控标签(12)带领跟随产品行走。
实施例一。
在图1、图2中,一种基于UWB定位技术的跟随RC车,包括前灯(1)、前壳(2)、车架(3)、中壳(4)、移动基站控制器(5)、车轮(6)、舵机(7)、驱动电机(8)、电池(9)、尾壳(10)、后灯(11)、遥控标签(12)。
在图2、图23中,所述遥控标签(12),包括UWB定位模块、电源模块、报警模块、控制模块;所述报警模块连接有发光器、蜂鸣器、振动器;所述控制模块连接有控制按钮。
在图3、图4中,所述移动基站控制器(5),包括A基站(501)、A臂架(502)、顶壳(503)、皮带(504)、传动轮(505)、基站转向电机Y(506);还包括Y同步轴(507)、B臂架(508)、B基站(509)、固定盘架(510)、中壳体(511);还包括Z传动轴
(512)、齿轮(513)、基站转向电机Z(514)、同步轴皮带轮(515)、同步轴支架(516)。
在图5、图6、图7中,移动基站控制器(5)的中壳体(511)、A臂架(502)、B臂架
(508),包括托轴孔A(5021)、A臂架孔(5022)、A臂架加强座
(5023)、A臂架加强柱(5024);还包括中壳壁(5111)、中壳筒(5112)、下支撑壁环(5113)、扣槽(5114)、上支撑壁环齿条(5115);还包括托轴孔B(5081)、B臂架孔(5082)、B臂架加强座(5083)、B臂架加强柱(5084)。
在图8、图9、图10中,所述移动基站控制器(5)的A基站(501),包括透明罩(5091)、基站壳(5092)、天线(5093)、屏蔽连接器(5094)、连接孔
(5095)、电路板A(5096)。
所述移动基站控制器(5)的B基站(509)与A基站
(501)结构相同对称的装置在中壳体(511)的A臂架(502)、B臂架(508)的两端,所述的B基站(509)包括透明罩(5091)、基站壳(5092)、天线(5093)、屏蔽连接器(5094)、连接孔(5095)、电路板B(5097);与所述A基站(501)的区别在于A基站(501)的电路板为电路板A(5096),B基站(509)的电路板为电路板B(5097)。
在图11、图22中,所述电路板A(5096),包括UWB定位模块A(50951)、电源模块(50952)、报警模块(50953)、控制模块(50954)、红外模块(50955)、驱动模块(50956)、PCB板A(50957)、红外发射接收管(50958)、蜂鸣器(50959)。
在图12、图23中,所述电路板B(5097),包括UWB定位模块B(50961)、电源模块(50962);PCB板B(50967)、红外发射接收管(50968)。
所述UWB定位模块A(50951)、UWB定位模块B(50961)为DW1000芯片。
在图2、图24中,所述遥控标签(12)包括UWB定位模块、电源模块、控制模块、报警模块;所述报警模块附设有发光器、蜂鸣器、振动器;所述电源模块与电池连接;所述控制模块设有按钮。
所述遥控标签(12)的UWB定位模块为DW1000芯片。
将遥控标签(12)与移动基站控制器(5)对码后,即可持遥控标签(12)带领跟随RC车行走。
实施例二。
在图13、图14、图15、图2中,一种基于UWB定位技术的跟随浇水车,包括移动基站控制器(5)、高压水泵(201)、水枪(202)、水箱(203)、JS移动车(204)、遥控标签(12)。
在图16中,所述JS移动车(204)包括车架(2041)、从动轮支架(2042)、从动轮(2043)、驱动轮(2044)、驱动轮支架(2045)、方向转动电机(2046)、方向传动齿轮(2047)、驱动电机(2048)、环形齿条(2049)、驱动轴(20410)、传动带(20411)、从动轴(20412)。
在图2、图23中,所述遥控标签(12),包括UWB定位模块、电源模块、报警模块、控制模块;所述报警模块连接有发光器、蜂鸣器、振动器;所述控制模块连接有控制按钮。
在图3、图4中,所述移动基站控制器(5),包括A基站(501)、A臂架(502)、顶壳
(503)、皮带(504)、传动轮(505)、基站转向电机Y(506);还包括Y同步轴(507)、B臂架(508)、B基站(509)、固定盘架(510)、中壳体(511);还包括Z传动轴
(512)、齿轮(513)、基站转向电机Z(514)、同步轴皮带轮(515)、同步轴支架(516)。
在图5、图6、图7中,所述移动基站控制器(5)的中壳体(511)、A臂架(502)、B臂架
(508),包括托轴孔A(5021)、A臂架孔(5022)、A臂架加强座
(5023)、A臂架加强柱(5024);还包括中壳壁(5111)、中壳筒(5112)、下支撑壁环(5113)、扣槽(5114)、上支撑壁环齿条(5115);还包括托轴孔B(5081)、B臂架孔(5082)、B臂架加强座(5083)、B臂架加强柱(5084)。
在图8、图9、图10中,所述移动基站控制器(5)的A基站(501),包括透明罩(5091)、基站壳(5092)、天线(5093)、屏蔽连接器(5094)、连接孔
(5095)、电路板A(5096)。
所述移动基站控制器(5)的B基站(509)与A基站
(501)结构相同对称的装置在中壳体(511)的A臂架(502)、B臂架(508)的两端,所述的B基站(509)包括透明罩(5091)、基站壳(5092)、天线(5093)、屏蔽连接器(5094)、连接孔(5095)、电路板B(5097);与所述基站A(501)的区别在于A基站(501)的电路板为电路板A(5096),B基站(509)的电路板为电路板B(5097)。
在图11、图22中,所述电路板A(5096),包括UWB定位模块A(50951)、电源模块(50952)、报警模块(50953)、控制模块(50954)、红外模块(50955)、驱动模块(50956)、PCB板A(50957)、红外发射接收管(50958)、蜂鸣器(50959)。
在图12、图23中,所述电路板B(5097),包括UWB定位模块B(50961)、电源模块(50962);PCB板B(50967)、红外发射接收管(50968)。
所述UWB定位模块A(50951)、UWB定位模块B(50961)为DW1000芯片。
在图2、图24中,所述遥控标签(12)包括UWB定位模块、电源模块、控制模块、报警模块;所述报警模块附设有发光器、蜂鸣器、振动器;所述电源模块与电池连接;所述控制模块设有按钮。
所述遥控标签(12)的UWB定位模块为DW1000芯片。
将遥控标签(12)与移动基站控制器(5)对码后,即可持遥控标签(12)带领一种基于UWB定位技术的跟随浇水车的行走。
实施例三。
在图17、图18、图19、图20、图2中,一种基于UWB定位技术的跟随婴儿车,包括移动基站控制器(5)、婴儿车架(301)、侧门(302)、前窗(303)、座椅(304、缓冲气圈(305)、驱动***(306)、遥控标签(12)。
在图21中,所述一种基于UWB定位技术的跟随婴儿车的驱动***(306),包括圆板车架(3061)、从动轮3(3062)、转向齿轮3(3063)、蓄电池(3064)、透气孔(3065)、驱动轮3(3066)、皮带3(3067)、驱动电机3(3068)、驱动轴3(3069)、驱动轴架(30610)、转向电机3(30611)、转向齿条圈3(30612)。
在图2、图23中,所述遥控标签(12),包括UWB定位模块、电源模块、报警模块、控制模块;所述报警模块连接有发光器、蜂鸣器、振动器;所述控制模块连接有控制按钮。
在图3、图4中,所述移动基站控制器(5),包括A基站(501)、A臂架(502)、顶壳
(503)、皮带(504)、传动轮(505)、基站转向电机Y(506);还包括Y同步轴(507)、B臂架(508)、B基站(509)、固定盘架(510)、中壳体(511);还包括Z传动轴
(512)、齿轮(513)、基站转向电机Z(514)、同步轴皮带轮(515)、同步轴支架(516)。
在图5、图6、图7中,所述移动基站控制器(5)的中壳体(511)、A臂架(502)、B臂架
(508),包括托轴孔A(5021)、A臂架孔(5022)、A臂架加强座
(5023)、A臂架加强柱(5024);还包括中壳壁(5111)、中壳筒(5112)、下支撑壁环(5113)、扣槽(5114)、上支撑壁环齿条(5115);还包括托轴孔B(5081)、B臂架孔(5082)、B臂架加强座(5083)、B臂架加强柱(5084)。
在图8、图9、图10中,所述移动基站控制器(5)的A基站(501),包括透明罩(5091)、基站壳(5092)、天线(5093)、屏蔽连接器(5094)、连接孔
(5095)、电路板A(5096)。
所述移动基站控制器(5)的B基站(509)与A基站
(501)结构相同对称的装置在中壳体(511)的A臂架(502)、B臂架(508)的两端,所述的B基站(509)包括透明罩(5091)、基站壳(5092)、天线(5093)、屏蔽连接器(5094)、连接孔(5095)、电路板B(5097);与所述基站A(501)的区别在于A基站(501)的电路板为电路板A(5096),B基站(509)的电路板为电路板B(5097)。
在图11、图22中,所述电路板A(5096),包括UWB定位模块A(50951)、电源模块(50952)、报警模块(50953)、控制模块(50954)、红外模块(50955)、驱动模块(50956)、PCB板A(50957)、红外发射接收管(50958)、蜂鸣器(50959)。
在图12、图23中,所述电路板B(5097),包括UWB定位模块B(50961)、电源模块(50962);PCB板B(50967)、红外发射接收管(50968)。
所述UWB定位模块A(50951)、UWB定位模块B(50961)为DW1000芯片。
在图2、图24中,所述遥控标签(12)包括UWB定位模块、电源模块、控制模块、报警模块;所述报警模块附设有发光器、蜂鸣器、振动器;所述电源模块与电池连接;所述控制模块设有按钮。
所述遥控标签(12)的UWB定位模块为DW1000芯片。
将遥控标签(12)与一种基于UWB定位技术的跟随婴儿车的移动基站控制器(5)对码后,即可持遥控标签(12)带领跟随婴儿车行走。