[0005] 本发明所要解决的技术问题是提供一种基于光强检测的自动跟随系统,该基于光强检测的自动跟随系统结构巧妙,能自动跟随,自动化程度高。
[0006] 发明的技术解决方案如下:
[0007] 一种基于光强检测的自动跟随系统,包括安全头盔、导轨和设置在导轨上的行走车;
[0008] 安全头盔上设有发光模块;
[0009] 行走车底部设有连接杆;连接杆的下端设有光强检测装置;
[0010] 光强检测装置具有一个圆弧面;所述的圆弧面上设有多个光强传感器;光强检测装置用于检测各光强传感器从发光模块获得的光强量;
[0011] 行走车上设有电池、电路板和用于驱动行走车的电机;电路板上集成有MCU和电机驱动电路;电池为电路板及电机供电;
[0012] MCU能根据光强检测装置检测的光强信号确定目标物相对行走车的角度,并基于该角度控制行走车的行走,实现行走车对目标物的自动跟随;
[0013] 所述的目标物为佩戴安全头盔的人体。
[0014] 多个光强传感器沿圆弧面的周向等间距布置。
[0015] 导轨为2条,且平行布置,行走车设置在导轨上,行走车底部设有至少4个行走轮;行走车能沿导轨运动。
[0016] 行走车底部与目标物之间设有起安全作用的绳索;绳索的上端连接行走车,绳索的下端用于连接目标物,一般是接人体的安全背心的腰部或肩背部或胸腹部。
[0017] 电路板上设有检测电路;所述的检测电路包括多选一切换开关和A/D转换器;
[0018] 多个光强传感器分别接多选一切换开关的多个输入端;多选一切换开关的输出端接A/D转换器的输入端;A/D转换器的输出端接MCU的信号输入端口;多选一切换开关的通道选择端接MCU的IO端。
[0019] 多选一切换开关为16选一的切换开关;多选一切换开关的通道选择端为4个。
[0020] 所述的MCU为单片机、DSP或ARM处理器。
[0021] 行走车的前端或底部设有监控摄像头。
[0022] 行走轮为4个;2条导轨之间设有多根横梁,横梁与导轨垂直;多根横梁等间距均匀布置;所述的行走车底部设有吊环,绳索的上端与吊环铰接。
[0023] 所述电机为步进电机。
[0024] 另外,行走车上还设有太阳能电池板以及充电电路,能通过太阳能为电池充电,节能环保。
[0025] 绳索为弹性伸缩的绳索。
[0026] 弧面的角度为A,A优选为90°或180°,即四分之一圆形或半圆;控制方法如下:
[0027] 步骤1:光强检测:
[0028] MCU通过多选一切换开关和A/D转换器,轮询(依次循环)检测每一个光强传感器获得的光强信号;找出最强光强信号对应的光强传感器i;
[0029] 步骤2:计算目标物相对于行走车的角度;
[0030] 所述的角度为
[0031] a=(i-1)*A/(N-1);其中N为光强传感器的总个数;角度单位为度;
[0032] 以水平方向为零度;以图3中最左边的一个光强传感器为第1个;最右的为第N个;且第一个设置在0度位置上,第N个设置在最大角度位置上。
[0033] 步骤3:计算需要行走的距离S;
[0034] S=L*tan(a);其中tan(.)为正切函数,L为导轨到目标物的垂直距离;一般L是恒定的,为常数。
[0035] 步骤4:MCU驱动行走车向前行走S;再返回步骤1,进行下一轮控制。
[0036] 行走轮上设有码盘,从而能记录行走车的行走距离。或者行走路上设有定位模块(如GPS模块而后北斗模块),可以计算行走距离。
[0037] 另外,飞行器也可以采用这种自动跟随系统。
[0038] 本发明的检测原理:
[0039] 发光模块为向四周均匀发出光线,因此,距离发光模块最近,且方向正对的那个光强传感器获得的光强最大;由此可以检测到目标物相对于检测模块的角度。
[0040] 绳索的上设有倾角传感器;倾角传感器与电路板上的MCU连接;倾角传感器为数字式传感器,倾角传感器输出倾角数据到MCU的输入接口;所述的电池为动力锂电池。
[0041] 另一种实施方式如下:
[0042] 一种基于机器视觉的位置检测模组,包括机器视觉检测装置和设置在目标物上的发光模块;
[0043] 机器视觉检测装置包括安装平台、云台和相机;
[0044] 云台通过连接杆设置在安装平台的底部或前端;相机安装在云台上;
[0045] 安装平台上设有电池和电路板;在电路板上设有MCU和存储器;MCU与存储器相连;电池为电路板供电;
[0046] 相机用于获取图像并将该图像传输到存储器中;发光模块即目标点的成像位于该图像中;
[0047] MCU对存储器中存储的图像进行处理,并计算目标点与安装平台的水平距离。
[0048] 所述的安装平台为设置在导轨上的行走车。
[0049] 发光模块设置在目标物佩戴的安全头盔上。
[0050] MCU对存储器中存储的图像进行处理的步骤如下:
[0051] 步骤1:分离目标点;
[0052] 通过边缘检测技术或阈值分割技术实现目标点P的分离;因为目标点的亮度远远高于其他像素的亮度,因此,优选阈值分割技术;阈值的选择为基于经验选择。
[0053] 步骤2:确定目标点图像坐标;
[0054] 分离出的目标点位于一个包含多个像素的连通区域,对该连通区域的边缘像素进行圆拟合,获得的圆心即为目标点的图像坐标;
[0055] 步骤3:计算发光模块与安装平台的水平距离;
[0056] 以O为图像的中心点;该中心点对应安装平台的位置;
[0057] 计算目标点P与O点之间的水平像素个数N;
[0058] 发光模块距离安装平台的水平距离S=k*N;k为比例系数。由于导轨与目标物之间的高度基本上是不变的,则k为常数。
[0059] 一种基于机器视觉的实时防护系统,包括导轨、绳索以及前述的位置检测模组;
[0060] 在行走车上还设有驱动安装平台平移的电机;电机由电池驱动;电路板中设有电机驱动电路;
[0061] 绳索的上端连接行走车,绳索的下端用于连接作为目标物的人体。一般是接人体的安全背心的腰部或肩背部或胸腹部。
[0062] 导轨为2条,且平行布置,行走车设置在导轨上,行走车底部设有至少4个行走轮;行走车能沿导轨运动。
[0063] 所述的MCU为单片机、DSP或ARM处理器。
[0064] 行走车的前端或底部设有监控摄像单元(用于获取实时监控图像,该摄像单元为普通的摄像单元,不用于确定目标物位置)。
[0065] 行走轮为4个;2条导轨之间设有多根横梁(7),横梁与导轨垂直;多根横梁等间距均匀布置;所述的行走车底部设有吊环(4),绳索的上端与吊环铰接。
[0066] 所述电机为步进电机。
[0067] 总体步骤:
[0068] 步骤A:基于图像处理计算发光模块到安装平台的水平距离S;
[0069] 步骤B:MCU驱动行走车向前行走S;再返回步骤A,进行下一轮控制。
[0070] 有益效果:
[0071] 本发明的基于光强检测的自动跟随系统,具有以下功能:
[0072] (1)行走车由电机驱动,且沿着轨道行走,运行顺畅,不会为学员带来负担;
[0073] (2)行走车具备智能性,能基于光强传感器检测的数据判断目标物位置,从而自动行走,自动化程度高。
[0074] 具体来讲,若角度(相对于水平方向)较小,说明学员在行走车前方较远,则起动电机,驱动行走车向前行走,紧跟学员。
[0075] (3)可靠性高。
[0076] 即使电池故障,不能驱动行走车,学员较小的拉力也能带动行走车行走。
[0077] (4)采用双导轨,多轮行走,稳定性好。
[0078] (5)行走车底部设有吊环,专门用于与绳索铰接,连接方便。
[0079] (6)头盔不能能保护人体的头部,还能发送光讯号。
[0080] 综上所述,这种基于光强检测的自动跟随系统构思巧妙,安全性高,使用方便,自动化程度高。