CN106802657B - 一种基于光强检测的自动跟随系统 - Google Patents

一种基于光强检测的自动跟随系统 Download PDF

Info

Publication number
CN106802657B
CN106802657B CN201710123735.7A CN201710123735A CN106802657B CN 106802657 B CN106802657 B CN 106802657B CN 201710123735 A CN201710123735 A CN 201710123735A CN 106802657 B CN106802657 B CN 106802657B
Authority
CN
China
Prior art keywords
moving trolley
light intensity
light
mcu
guide rail
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
CN201710123735.7A
Other languages
English (en)
Other versions
CN106802657A (zh
Inventor
程文云
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu Shifeng Enterprise Management Consulting Co ltd
Original Assignee
Fujian New Creation Nylon Industry Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fujian New Creation Nylon Industry Co Ltd filed Critical Fujian New Creation Nylon Industry Co Ltd
Priority to CN201710123735.7A priority Critical patent/CN106802657B/zh
Publication of CN106802657A publication Critical patent/CN106802657A/zh
Application granted granted Critical
Publication of CN106802657B publication Critical patent/CN106802657B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • A—HUMAN NECESSITIES
    • A63—SPORTS; GAMES; AMUSEMENTS
    • A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
    • A63B69/00—Training appliances or apparatus for special sports
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas

Abstract

本发明公开了一种基于光强检测的自动跟随系统，包括安全头盔(13)、导轨(3)和设置在导轨上的行走车(1)；安全头盔上设有发光模块(14)；行走车底部设有光强检测装置(11)；光强检测装置的圆弧面上设有多个光强传感器(5)；光强检测装置用于检测各光强传感器从发光模块获得的光强量；行走车上设有电池(8)、电路板(9)和用于驱动行走车的电机(10)；电路板上集成有MCU和电机驱动电路；MCU能根据光强检测装置检测的光强信号确定目标物相对行走车的角度，并基于该角度控制行走车的行走，实现行走车对目标物的自动跟随；该基于光强检测的自动跟随系统结构巧妙，能自动跟随，自动化程度高。

Description

一种基于光强检测的自动跟随系统
技术领域
本发明涉及一种基于光强检测的自动跟随系统。
背景技术
户外拓展运动中，缅甸桥为常用的一个项目，在该项目中，设置有3条平行布置的主钢索，其中1条在下，用于行走，另两条在上，用于学员的两手抓住；该项目能锻炼学员的胆略、身体协调能力，而且集刺激、惊险和趣味性等于一体；为安全起见，在高空设置一条保险用的钢索，钢索上垂下安全带系在学员腰部，但是，这种安全带较重，且安全带与顶部的钢索之间摩擦较大，因此，这种安全保护装置给学员带来极大的负担和不便。
另外，在某些装配车间中，也需要设置跟随系统，为装配人员提供最便捷的服务。
因此，有必要设计一种新的基于光强检测的自动跟随系统。
发明内容
本发明所要解决的技术问题是提供一种基于光强检测的自动跟随系统，该基于光强检测的自动跟随系统结构巧妙，能自动跟随，自动化程度高。
发明的技术解决方案如下：
一种基于光强检测的自动跟随系统，包括安全头盔、导轨和设置在导轨上的行走车；
安全头盔上设有发光模块；
行走车底部设有连接杆；连接杆的下端设有光强检测装置；
光强检测装置具有一个圆弧面；所述的圆弧面上设有多个光强传感器；光强检测装置用于检测各光强传感器从发光模块获得的光强量；
行走车上设有电池、电路板和用于驱动行走车的电机；电路板上集成有MCU和电机驱动电路；电池为电路板及电机供电；
MCU能根据光强检测装置检测的光强信号确定目标物相对行走车的角度，并基于该角度控制行走车的行走，实现行走车对目标物的自动跟随；
所述的目标物为佩戴安全头盔的人体。
多个光强传感器沿圆弧面的周向等间距布置。
导轨为2条，且平行布置，行走车设置在导轨上，行走车底部设有至少4个行走轮；行走车能沿导轨运动。
行走车底部与目标物之间设有起安全作用的绳索；绳索的上端连接行走车，绳索的下端用于连接目标物，一般是接人体的安全背心的腰部或肩背部或胸腹部。
电路板上设有检测电路；所述的检测电路包括多选一切换开关和A/D转换器；
多个光强传感器分别接多选一切换开关的多个输入端；多选一切换开关的输出端接A/D转换器的输入端；A/D转换器的输出端接MCU的信号输入端口；多选一切换开关的通道选择端接MCU的IO端。
多选一切换开关为16选一的切换开关；多选一切换开关的通道选择端为4个。
所述的MCU为单片机、DSP或ARM处理器。
行走车的前端或底部设有监控摄像头。
行走轮为4个；2条导轨之间设有多根横梁，横梁与导轨垂直；多根横梁等间距均匀布置；所述的行走车底部设有吊环，绳索的上端与吊环铰接。
所述电机为步进电机。
另外，行走车上还设有太阳能电池板以及充电电路，能通过太阳能为电池充电，节能环保。
绳索为弹性伸缩的绳索。
弧面的角度为A，A优选为90°或180°，即四分之一圆形或半圆；控制方法如下：
步骤1：光强检测：
MCU通过多选一切换开关和A/D转换器，轮询(依次循环)检测每一个光强传感器获得的光强信号；找出最强光强信号对应的光强传感器i；
步骤2：计算目标物相对于行走车的角度；
所述的角度为
a＝(i-1)*A/(N-1)；其中N为光强传感器的总个数；角度单位为度；
以水平方向为零度；以图3中最左边的一个光强传感器为第1个；最右的为第N个；且第一个设置在0度位置上，第N个设置在最大角度位置上。
步骤3：计算需要行走的距离S；
S＝L*tan(a)；其中tan(.)为正切函数，L为导轨到目标物的垂直距离；一般L是恒定的，为常数。
步骤4：MCU驱动行走车向前行走S；再返回步骤1，进行下一轮控制。
行走轮上设有码盘，从而能记录行走车的行走距离。或者行走路上设有定位模块(如GPS模块而后北斗模块)，可以计算行走距离。
另外，飞行器也可以采用这种自动跟随系统。
本发明的检测原理：
发光模块为向四周均匀发出光线，因此，距离发光模块最近，且方向正对的那个光强传感器获得的光强最大；由此可以检测到目标物相对于检测模块的角度。
绳索的上设有倾角传感器；倾角传感器与电路板上的MCU连接；倾角传感器为数字式传感器，倾角传感器输出倾角数据到MCU的输入接口；所述的电池为动力锂电池。
另一种实施方式如下：
一种基于机器视觉的位置检测模组，包括机器视觉检测装置和设置在目标物上的发光模块；
机器视觉检测装置包括安装平台、云台和相机；
云台通过连接杆设置在安装平台的底部或前端；相机安装在云台上；
安装平台上设有电池和电路板；在电路板上设有MCU和存储器；MCU与存储器相连；电池为电路板供电；
相机用于获取图像并将该图像传输到存储器中；发光模块即目标点的成像位于该图像中；
MCU对存储器中存储的图像进行处理，并计算目标点与安装平台的水平距离。
所述的安装平台为设置在导轨上的行走车。
发光模块设置在目标物佩戴的安全头盔上。
MCU对存储器中存储的图像进行处理的步骤如下：
步骤1：分离目标点；
通过边缘检测技术或阈值分割技术实现目标点P的分离；因为目标点的亮度远远高于其他像素的亮度，因此，优选阈值分割技术；阈值的选择为基于经验选择。
步骤2：确定目标点图像坐标；
分离出的目标点位于一个包含多个像素的连通区域，对该连通区域的边缘像素进行圆拟合，获得的圆心即为目标点的图像坐标；
步骤3：计算发光模块与安装平台的水平距离；
以O为图像的中心点；该中心点对应安装平台的位置；
计算目标点P与O点之间的水平像素个数N；
发光模块距离安装平台的水平距离S＝k*N；k为比例系数。由于导轨与目标物之间的高度基本上是不变的，则k为常数。
一种基于机器视觉的实时防护系统，包括导轨、绳索以及前述的位置检测模组；
在行走车上还设有驱动安装平台平移的电机；电机由电池驱动；电路板中设有电机驱动电路；
绳索的上端连接行走车，绳索的下端用于连接作为目标物的人体。一般是接人体的安全背心的腰部或肩背部或胸腹部。
导轨为2条，且平行布置，行走车设置在导轨上，行走车底部设有至少4个行走轮；行走车能沿导轨运动。
所述的MCU为单片机、DSP或ARM处理器。
行走车的前端或底部设有监控摄像单元(用于获取实时监控图像，该摄像单元为普通的摄像单元，不用于确定目标物位置)。
行走轮为4个；2条导轨之间设有多根横梁(7)，横梁与导轨垂直；多根横梁等间距均匀布置；所述的行走车底部设有吊环(4)，绳索的上端与吊环铰接。
所述电机为步进电机。
总体步骤：
步骤A：基于图像处理计算发光模块到安装平台的水平距离S；
步骤B：MCU驱动行走车向前行走S；再返回步骤A，进行下一轮控制。
有益效果：
本发明的基于光强检测的自动跟随系统，具有以下功能：
(1)行走车由电机驱动，且沿着轨道行走，运行顺畅，不会为学员带来负担；
(2)行走车具备智能性，能基于光强传感器检测的数据判断目标物位置，从而自动行走，自动化程度高。
具体来讲，若角度(相对于水平方向)较小，说明学员在行走车前方较远，则起动电机，驱动行走车向前行走，紧跟学员。
(3)可靠性高。
即使电池故障，不能驱动行走车，学员较小的拉力也能带动行走车行走。
(4)采用双导轨，多轮行走，稳定性好。
(5)行走车底部设有吊环，专门用于与绳索铰接，连接方便。
(6)头盔不能能保护人体的头部，还能发送光讯号。
综上所述，这种基于光强检测的自动跟随系统构思巧妙，安全性高，使用方便，自动化程度高。
附图说明
图1为基于光强检测的自动跟随系统的总体结构示意图；
图2为行走车与导轨配合示意图；
图3为光强检测示意图；
图4为控制系统的电原理框图。
标号说明：1-行走车，2-行走轮，3-导轨，4-吊环，5-光强传感器，6-绳索，7-横梁，8-电池，9-电路板，10-电机，11-光强检测装置，12-连接杆，13-安全头盔，14-发光模块。
具体实施方式
以下将结合附图和具体实施例对本发明做进一步详细说明：
实施例1：如图1～4，一种基于光强检测的自动跟随系统，包括安全头盔13、导轨3和设置在导轨上的行走车1；
安全头盔上设有发光模块14；
行走车底部设有连接杆12；连接杆的下端设有光强检测装置11；
光强检测装置具有一个圆弧面；所述的圆弧面上设有16个光强传感器5；光强检测装置用于检测各光强传感器从发光模块获得的光强量；
行走车上设有电池8、电路板9和用于驱动行走车的电机10；电路板上集成有MCU和电机驱动电路；电池为电路板及电机供电；
MCU能根据光强检测装置检测的光强信号确定目标物相对行走车的角度，并基于该角度控制行走车的行走，实现行走车对目标物的自动跟随；
所述的目标物为佩戴安全头盔的人体。
多个光强传感器沿圆弧面的周向等间距布置。
导轨为2条，且平行布置，行走车设置在导轨上，行走车底部设有4个行走轮2；行走车能沿导轨运动。
行走车底部与目标物之间设有起安全作用的绳索6；绳索的上端连接行走车，绳索的下端用于连接目标物，一般是接人体的安全背心的腰部或肩背部或胸腹部。
电路板上设有检测电路；所述的检测电路包括多选一切换开关和A/D转换器；
多个光强传感器分别接多选一切换开关的多个输入端；多选一切换开关的输出端接A/D转换器的输入端；A/D转换器的输出端接MCU的信号输入端口；多选一切换开关的通道选择端接MCU的IO端。
多选一切换开关为16选一的切换开关；多选一切换开关的通道选择端为4个。
所述的MCU为单片机、DSP或ARM处理器。
行走车的前端或底部设有监控摄像头。
2条导轨之间设有多根横梁7，横梁与导轨垂直；多根横梁等间距均匀布置；所述的行走车底部设有吊环4，绳索的上端与吊环铰接。
所述电机为步进电机。
另外，行走车上还设有太阳能电池板以及充电电路，能通过太阳能为电池充电，节能环保。
绳索为弹性伸缩的绳索。
弧面的角度为A，A为180°，即半圆；控制方法如下：
步骤1：光强检测：
MCU通过多选一切换开关和A/D转换器，轮询(依次循环)检测每一个光强传感器获得的光强信号；找出最强光强信号对应的光强传感器i；
步骤2：计算目标物相对于行走车的角度；
所述的角度为
a＝(i-1)*180°/15；；角度单位为度；
以水平方向为零度；以图3中最左边的一个光强传感器为第1个；最右的为第16个；
步骤3：计算需要行走的距离S；
S＝L*tan(a)；其中tan(.)为正切函数，L为导轨到目标物的垂直距离；一般L是恒定的，作为常数。
步骤4：MCU驱动行走车向前行走S；再返回步骤1，进行下一轮控制。
行走轮上设有码盘，从而能记录行走车的行走距离。或者行走路上设有定位模块(如GPS模块而后北斗模块)，可以计算行走距离。

Claims (1)

1.一种基于光强检测的自动跟随系统，其特征在于，包括安全头盔（13）、导轨（3）和设置在导轨上的行走车（1）；
安全头盔上设有发光模块（14）；
行走车底部设有连接杆（12）；连接杆的下端设有光强检测装置（11）；
光强检测装置具有一个圆弧面；所述的圆弧面上设有多个光强传感器（5）；光强检测装置用于检测各光强传感器从发光模块获得的光强量；
行走车上设有电池（8）、电路板（9）和用于驱动行走车的电机（10）；电路板上集成有MCU和电机驱动电路；电池为电路板及电机供电；
MCU能根据光强检测装置检测的光强信号确定目标物相对行走车的角度，并基于该角度控制行走车的行走，实现行走车对目标物的自动跟随；
所述的目标物为佩戴安全头盔的人体；
多个光强传感器沿圆弧面的周向等间距布置；
导轨为2条，且平行布置，行走车设置在导轨上，行走车底部设有至少4个行走轮；行走车能沿导轨运动；
行走车底部与目标物之间设有起安全作用的绳索（6）；绳索的上端连接行走车，绳索的下端用于连接目标物；
电路板上设有检测电路；所述的检测电路包括多选一切换开关和A/D转换器；
多个光强传感器分别接多选一切换开关的多个输入端；多选一切换开关的输出端接A/D转换器的输入端；A/D转换器的输出端接MCU的信号输入端口；多选一切换开关的通道选择端接MCU的IO端；
多选一切换开关为16选一的切换开关；多选一切换开关的通道选择端为4个；
所述的MCU为单片机、DSP或ARM处理器；
行走车的前端或底部设有监控摄像头；
2条导轨之间设有多根横梁，横梁与导轨垂直；多根横梁等间距均匀布置；所述的行走车底部设有吊环（4），绳索的上端与吊环铰接；
所述电机为步进电机；
控制方法如下：
步骤1：光强检测：
MCU通过多选一切换开关和A/D转换器，轮询检测每一个光强传感器获得的光强信号；找出最强光强信号对应的光强传感器i；
步骤2：计算目标物相对于行走车的角度；
所述的角度为a=(i-1)*A/（N-1）;其中N为光强传感器的总个数；角度单位为度；
以水平方向为零度；以最左边的一个光强传感器为第1个；最右的为第N个；且第一个设置在0度位置上，第N个设置在最大角度位置上；
步骤3：计算需要行走的距离S；
S=L*tan（a）；其中tan（.）为正切函数，L为导轨到目标物的垂直距离； L是恒定的，为常数；
步骤4：MCU驱动行走车向前行走S;再返回步骤1，进行下一轮控制；
行走轮上设有码盘，从而能记录行走车的行走距离。
CN201710123735.7A 2017-03-05 2017-03-05 一种基于光强检测的自动跟随系统 Expired - Fee Related CN106802657B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710123735.7A CN106802657B (zh) 2017-03-05 2017-03-05 一种基于光强检测的自动跟随系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710123735.7A CN106802657B (zh) 2017-03-05 2017-03-05 一种基于光强检测的自动跟随系统

Publications (2)

Publication Number Publication Date
CN106802657A CN106802657A (zh) 2017-06-06
CN106802657B true CN106802657B (zh) 2019-12-03

Family

ID=58987888

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710123735.7A Expired - Fee Related CN106802657B (zh) 2017-03-05 2017-03-05 一种基于光强检测的自动跟随系统

Country Status (1)

Country Link
CN (1) CN106802657B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113671864A (zh) * 2021-07-27 2021-11-19 滚志安 一种基于pd控制的自动跟随装置及其方法

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3197412B2 (ja) * 1993-12-10 2001-08-13 大成建設株式会社 吊荷下の警戒範囲設定装置
CN202358644U (zh) * 2011-12-14 2012-08-01 湖北三丰智能输送装备股份有限公司 带自动跟踪系统的轨道式自行引导小车
CN102692929A (zh) * 2012-06-18 2012-09-26 南京工业职业技术学院 运动物体自动跟踪系统及应用该系统的小车和升降晾衣架
JP2014092861A (ja) * 2012-11-01 2014-05-19 Symtec Hozumi:Kk 追従台車システム
CN202854616U (zh) * 2012-11-13 2013-04-03 李良杰 太阳方向获取装置
CN108042218A (zh) * 2017-12-05 2018-05-18 北京军秀咨询有限公司 一种神经外科手术病人头部标记自动视觉定位装置及方法

Also Published As

Publication number Publication date
CN106802657A (zh) 2017-06-06

Similar Documents

Publication Publication Date Title
CN103825338B (zh) 高压线巡线机器人自主定位对接充电的控制装置及方法
CN105056457B (zh) 一种用于电力隧道的移动式消防灭火方法
CN106907993A (zh) 一种基于机器视觉的位置检测模组及实时防护系统
CN206059830U (zh) 一种agv小车自动充电电刷接口
CN107175668A (zh) 一种皮带运输机智能巡检机器人
CN106864619B (zh) 一种鸟巢挑落装置
CN208521185U (zh) 一种轨道式智能巡检机器人
CN104283153B (zh) 旋翼式跨越障碍的输电线路巡检行走机构
CN211373512U (zh) 一种基于激光雷达的接触网自动检测装置
CN110977973A (zh) 架空输电线路巡检机器人自主越障装置
CN111413353A (zh) 一种隧道衬砌病害综合检测车
CN106802657B (zh) 一种基于光强检测的自动跟随系统
CN109292027A (zh) 一种防摔倒自行车自动起落支架和自行车
CN204542069U (zh) 用于往返跑的体能测试系统
CN109229136A (zh) 一种轨道车辆底部自动化检测系统
CN106774437B (zh) 一种基于光强检测的自动跟随方法
CN209007562U (zh) 一种变电站室内巡视机器人
CN209570523U (zh) 一种便携式接触网悬状态检测监测装置
CN106886218A (zh) 一种基于机器视觉的自动追踪防护方法
CN104742941B (zh) 索道缆车目标控制速度设置系统
CN109079823A (zh) 一种变电站室内巡视机器人
CN207280395U (zh) 一种基于激光测距技术的测绘仪器
CN202650030U (zh) 一种车载交通手势识别装置
CN207842840U (zh) 车辆及防儿童遗留装置
CN202641482U (zh) 应用于道路巡视中道路数据快速获取检查车

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
TA01 Transfer of patent application right

Effective date of registration: 20191111

Address after: No. 68-1 Zhangwen Road, Menlou village, Zhanggang street, Changle City, Fuzhou City, Fujian Province

Applicant after: Fujian new creation nylon Industry Co.,Ltd.

Address before: 410000 Hunan city high tech Development Zone Changsha Changsha Lulong Road No. 199 A Lugu business center building 307 room -1066

Applicant before: CHANGSHA XIUHENG INFORMATION TECHNOLOGY Co.,Ltd.

TA01 Transfer of patent application right
GR01 Patent grant
GR01 Patent grant
CP02 Change in the address of a patent holder

Address after: 221000 Shimao Square Inner Commercial Street 2, Office 1, Office 2, Building 1-910, Yunlong District, Xuzhou City, Jiangsu Province

Patentee after: Fujian new creation nylon Industry Co.,Ltd.

Address before: No.68-1 Zhangwen Road, Menlou village, Zhanggang street, Changle City, Fuzhou City, Fujian Province, 350200

Patentee before: Fujian new creation nylon Industry Co.,Ltd.

CP02 Change in the address of a patent holder
TR01 Transfer of patent right

Effective date of registration: 20210107

Address after: 221000 1-913, building 2, Shimao Square commercial street and office 1, office 2, Yunlong District, Xuzhou City, Jiangsu Province

Patentee after: Jiangsu Shifeng Enterprise Management Consulting Co.,Ltd.

Address before: 221000 Shimao Square Inner Commercial Street 2, Office 1, Office 2, Building 1-910, Yunlong District, Xuzhou City, Jiangsu Province

Patentee before: Fujian new creation nylon Industry Co.,Ltd.

TR01 Transfer of patent right
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20191203

CF01 Termination of patent right due to non-payment of annual fee