CN112731948B - 一种融合物联网技术的巡检机器人的控制方法及系统 - Google Patents
一种融合物联网技术的巡检机器人的控制方法及系统 Download PDFInfo
- Publication number
- CN112731948B CN112731948B CN202110353136.0A CN202110353136A CN112731948B CN 112731948 B CN112731948 B CN 112731948B CN 202110353136 A CN202110353136 A CN 202110353136A CN 112731948 B CN112731948 B CN 112731948B
- Authority
- CN
- China
- Prior art keywords
- inspection robot
- inspection
- control board
- communication
- safety control
- 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.)
- Active
Links
- 238000007689 inspection Methods 0.000 title claims abstract description 268
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000005516 engineering process Methods 0.000 title claims abstract description 24
- 230000004927 fusion Effects 0.000 title claims abstract description 19
- 230000006855 networking Effects 0.000 title claims abstract description 19
- 238000004891 communication Methods 0.000 claims abstract description 116
- 238000012544 monitoring process Methods 0.000 claims abstract description 68
- 238000013439 planning Methods 0.000 claims abstract description 11
- 230000002159 abnormal effect Effects 0.000 claims description 21
- 239000000203 mixture Substances 0.000 claims description 8
- 230000008569 process Effects 0.000 claims description 6
- 230000008054 signal transmission Effects 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 abstract description 12
- 238000012545 processing Methods 0.000 description 7
- 238000001228 spectrum Methods 0.000 description 6
- 239000003550 marker Substances 0.000 description 5
- 230000005540 biological transmission Effects 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000009529 body temperature measurement Methods 0.000 description 2
- 238000007726 management method Methods 0.000 description 2
- 230000002265 prevention Effects 0.000 description 2
- 238000012163 sequencing technique Methods 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 238000004378 air conditioning Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000003086 colorant Substances 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000007599 discharging Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
- 230000035807 sensation Effects 0.000 description 1
- 239000000779 smoke Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000001931 thermography Methods 0.000 description 1
- 238000012384 transportation and delivery Methods 0.000 description 1
- 238000004804 winding Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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/0242—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3407—Route searching; Route guidance specially adapted for specific applications
- G01C21/343—Calculating itineraries, i.e. routes leading from a starting point to a series of categorical destinations using a global route restraint, round trips, touristic trips
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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/0225—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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
- G05D1/0253—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 extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Electromagnetism (AREA)
- Acoustics & Sound (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种融合物联网技术的巡检机器人的控制方法及系统,该控制方法包括:巡检机器人上电建立通信、自检、规划巡检路径巡检和巡检完成后规划返航路线返航;执行该控制方法的系统包括:上位系统、下位系统、监控后台和充电库;巡检机器人与监控后台通信采用无线局域网和物联网联用的方式提高机器人的可用性;巡检机器人自检采用逻辑互锁的方式,提高巡检机器人系统的可靠性和可用性;在巡检路径规划中,通过在数据库中存储地图巡检点、关键路径点和路径的方式,得到一种计算简便,安全有效的路径规划方法,并采取边计算边存储的方式将得到的最短路径存储,方便以后相同巡检序列时可直接作为巡检路径,减少了计算量。
Description
技术领域
本发明属于巡检机器人领域,特别涉及一种融合物联网技术的巡检机器人的控制方法及系统。
背景技术
智能巡检技术是近年随着无人值守或少人值守的推广而逐步发展起来的,目前已广泛应用到国网变电站,越来越多的室外巡检机器人应用到变电所,代替人工对变电所区域进行自动巡检。室外巡检机器人系统是主要的巡检执行机构,既可以作为独立的巡检系统,也可以作为其他维护系统的一部分,例如辅助控制系统等。目前应用的巡检机器人普通存在可靠性不高,网络通信单一,通信异常后不能正常显示位置等问题。
物联网技术近几年新发展起来的网络技术,是指通过信息传感设备,按照约定的协议,将任何物体与网络相连接,物体通过信息传播媒介进行信息交换和通信,以实现智能化识别、定位、跟踪、监管等功能。物联网技术具有通信传输距离远,通信稳定等优点。
针对上述问题,本发明的巡检机器人搭载基于安全架构的安全控制板卡,在5G无线网络基础上,搭载辅助通信的物联网模块,在网络异常后,通过返航算法,让机器人从变电所高压区域回到安全区域,并将位置实时上传给监控后台。
发明内容
针对上述问题,本发明提供了一种融合物联网技术的巡检机器人的控制方法,
所述方法主要包括以下步骤:
S1:巡检机器人上电,建立通信,所述建立通信包括建立主通信和建立辅助通信;
S2:所述巡检机器人自检,若自检正常执行步骤S3;
S3:接收监控后台指令确认是否进行巡检;
S4:若接收到巡检指令,所述巡检机器人执行出库;
S5:出库完成后,所述巡检机器人进行巡检路径规划,所述巡检机器人根据巡检路径到达巡检点进行巡检;
S6:判断所述巡检机器人是否完成巡检,若完成执行步骤S7,若未完成返回步骤S5;
S7:所述巡检机器人进行返航路径的规划,所述巡检机器人按照所述返航路径返航;
S8:完成入库,所述巡检机器人关键部件断电,巡检结束。
进一步地,步骤S1中所述建立主通信指的是通过无线网络建立所述巡检机器人与监控后台和充电库之间的通信,设置所述主通信接收时间阈值T1;
步骤S1中所述建立辅助通信指的是通过物联网建立所述巡检机器人与所述监控后台和充电库之间的通信,设置所述辅助通信接收时间阈值T2;
所述T1<所述T2。
进一步地,在所述主通信正常通信的情况下,所述巡检机器人通过所述主通信完成整个巡检过程,此时所述辅助通信与监控后台进行独立的通信;在安全控制板自检完成后,所述辅助通信等待监控后台发送的心跳帧;
在所述主通信出现异常且连接时间超过T1时,所述辅助通信接收所述监控后台心跳帧并反馈此时所述巡检机器人位置信息,所述巡检机器人根据返航路径返回至充电库,通过所述辅助通信与所述充电库通信并打开卷闸门,所述巡检机器人完成入库,等待所述主通信连接。
进一步地,所述主通信出现异常时,在所述巡检机器人返航至入库期间,无论所述主通信是否恢复,所述巡检机器人不响应所述监控后台指令。
进一步地,步骤S3中所述巡检机器人若未接收到巡检指令,则进一步判断接收的指令是否是查询帧,如果是查询帧,所述巡检机器人进行状态查询,设置每一次查询时间间隔T,并向监控后台发送状态信息,如果不是查询帧,则是配置帧。
进一步地,步骤S2中,所述巡检机器人自检包括主控板自检和安全控制板自检,再通过所述主控板和所述安全控制板之间的信号传输状态确认巡检机器人自检状态。
进一步地,所述主控板自检和所述安全控制板自检结束后,通过所述主控板是否接收到反馈帧、所述安全控制板是否接收到连接帧、所述主控板接收到反馈帧的时间是否超时和所述安全控制板接收到连接帧的时间是否超时来判断所述主控板和所述安全控制板的连接状态;
通过所述安全控制板是否接收到查询帧、所述主控板是否接收到所述安全控制板反馈的查询帧、所述安全控制板接收到所述查询帧的时间是否超时、所述主控板接收到反馈的查询帧的时间是否超时和所述查询帧的具体状态信息来进一步判断连接在所述安全控制板和所述主控板的设备的连接状态。
进一步地,所述主控板和所述安全控制板连接完成后接收查询帧之前,所述安全控制板主动查询构图雷达、避障模块和防跌落模块的数据信息,查询完成后响应所述主控板的查询信息。
本发明还提供了一种融合物联网技术的巡检机器人的控制系统,
所述控制系统包括上位系统、下位系统、监控后台和充电库,所述上位系统包括主控板;所述下位系统包括安全控制板;
所述上位系统作为主控模块;
所述下位系统用于执行主控模块的指令及向主控模块反馈信息;
所述监控后台用于对所述巡检机器人的状态进行监控,并向巡检机器人发送指令;
所述充电库用于所述巡检机器人的充电以及作为所述巡检机器人等待信号连接时的存放区域,还用于与所述巡检机器人和监控后台的信号连通。
进一步地,所述主控板上连接交换机,所述交换机通过无线AP与所述监控后台和充电库实现通信;
所述主控板和所述安全控制板通过以太网口连接;
所述安全控制板通过物联网通信模块1和物联网通信模块2与监控后台和充电库实现通信。
进一步地,所述安全控制板采用PCB板卡,所述PCB板卡包含2路CAN接口,16路IO接口,4路RS485接口,2路以太网接口,所述安全控制板内部采用2取2 CPU架构,其中,1路CPU主要负责采集各个传感器信息;另一路CPU负责驱动。
本发明的有益效果:
本发明中巡检机器人系统中安全控制板采用基于安全架构的设计,并利用逻辑互锁的自检方式,对巡检机器人关键部件进行上电自检,提高巡检机器人系统的可靠性和可用性;
本发明采用无线局域网为主通信,物联网技术为辅助通信,提高机器人的可用性;并利用物联网通信距离远,通信稳定的特点,在出现5G wifi网络通信中断的情况下,监控后台通过物联网上传的位置信息也能够查看巡检机器人的实时位置;
本发明通过在数据库中存储地图巡检点、关键路径点和路径的方式,得到一种计算简便,安全有效的路径规划方法,并采取边计算边存储的方式将得到的最短路径存储,方便以后相同巡检序列时可直接作为巡检路径,减少了计算量。
本发明的其它特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本发明而了解。本发明的目的和其他优点可通过在说明书以及附图中所指出的结构来实现和获得。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1示出了本发明实施例的巡检机器人系统连接示意图;
图2示出了本发明实施例的巡检机器人控制方法流程图;
图3示出了本发明实施例的巡检机器人上电后建立主通信的流程图;
图4示出了本发明实施例的巡检机器人上电后建立辅助通信的流程图;
图5示出了本发明实施例的巡检机器人自检流程图;
图6示出了本发明实施例的巡检机器人巡检路径流程图;
图7示出了本发明实施例的巡检机器人返航时流程图;
图8示出了本发明实施例的巡检机器人道路配置示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地说明,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明公开了一种融合物联网技术的巡检机器人的控制系统;
巡检机器人控制系统包括上位系统、下位系统、监控后台和充电库,所述上位系统包括主控板;所述下位系统包括安全控制板和安全控制板上连接的模块;
主控板采用嵌入式工控机,包含4路以太网接口,通过两路以太网口分别与构图雷达和交换机连接,交换机连接无线AP和双光谱一体机。
下位系统用于执行主控板的指令及向主控模块反馈信息;
监控后台用于对巡检机器人的状态信息进行监控,并向巡检机器人发送指令;包括状态查询指令、巡检指令等;查询信息包括室外温湿度、风向、风速和卷闸门控制信息等。
充电库用于巡检机器人的充电以及作为巡检机器人等待信号连接时的存放区域;并向监控后台返回充电库内部温湿度、烟感状态,空调状态、室外温湿度,风向,风速状态,实时监控视频流,充电桩状态等信息;充电库向机器人返回开关门状态,充放电状态等信息。
请参照图1,对系统中各模块进行进一步阐述;
主控板通过以太网口与构图雷达和交换机实现信连通;
构图雷达用于执行巡检机器人构建电子地图,并通过电子地图实现巡检机器人的导航定位、路径规划、逻辑处理运算和接口通信功能;
交换机采用千兆网POE交换机,为无线AP(无线接入点)提供电源,以及为主控板、双光谱一体机、无线AP提供数据交互,机器人通过无线AP构建无线局域网络,作为与监控后台和充电库的主通信,主要实现机器人状态数据、图像数据的传输;双光谱一体机,包括红外可见光摄像头和测温型红外热成像,这两个摄像头固定到云台上,云台能够实现水平360°旋转,-45°-+70°俯仰。云台安装在升降杆上,对不同高度位置的仪表可以通过调节升降高度,获取仪表的平视高清照片,提高图像识别的准确性。
主控板的另外两个以太网口连接安全控制板,安全控制板采用安全架构的PCB板卡,包含2路CAN接口,16路IO接口,4路RS485接口,2路以太网接口,内部采用2取2 CPU架构,1路CPU主要负责采集各个传感器信息;另一路CPU负责驱动。
第一物联网模块和第二物联网模块均接入安全控制板的RS485接口,作为辅助通信,主要实现巡检机器人与监控后台和充电库的心跳连接以及位置通信。
温湿度采集模块和供电电源模块接入剩下的两个RS485接口,温湿度采集模块主要采集机器人内部温湿度信息。
供电电源模块包括电池和BMS电源管理单元,BMS电源管理单元对电池单芯和整机进行实时监控,出现过流、过压、欠压、过温、低温等报警,并根据严重等级切断电池输出,保障供电安全性。
运动模块和升降模块通过CAN接口与安全控制板连接,运动模块驱动电机、驱动器和编码器,主要实现巡检机器人差速运动。
升降模块包括升降电机、驱动器和编码器,主要实现双光谱一体机的升降功能。
风扇、状态指示灯、避障模块和防跌落模块通过IO接口与安全控制板连接;
风扇用于调节机器人内部温度;
状态指示灯用不同颜色的灯显示巡检机器人工作状态,状态指示灯采用多色LED灯;
避障模块包括越障雷达和避障超声波,可以根据配置,对设定的故障形状进行越障和避障;
防跌落模块主要功能是防止巡检机器人地面凹陷处摔到以及高处掉落功能。
请参照图2,一种融合物联网技术的巡检机器人的控制方法主要包括以下步骤:
S1:机器人上电,建立巡检机器人通信,在主通信无异常的情况下通过无线局域网络,作为巡检机器人与监控后台和充电库的通信信号,主通信异常则通过物联网通信作为巡检机器人与监控后台和充电库的辅助通信信号;
S2:巡检机器人自检,巡检机器人自检包括主控板自检和安全控制板自检,通过主控板和安全控制板之间的信号传输状态确认巡检机器人自检状态,自检正常进入步骤S3,自检异常进一步判断是安全控制板异常还是主控板异常;
S3:巡检机器人接收监控后台指令确认是否进行巡检,若未接收到巡检指令;则进一步判断接收的指令是否是查询帧,如果是查询帧,巡检机器人进行状态查询,设置每一次查询时间间隔T,并向监控后台发送状态信息;如果不是查询帧,则是配置帧,巡检机器人根据要求进行相关的配置,配置帧包括电量阈值、电量报警阈值、通信超时阈值、通信中断阈值、避障阈值、防跌落阈值和机器人舱体温湿度阈值;
S4:若接收到巡检指令,巡检机器人执行出库;
S5:出库完成后,巡检机器人进行路径规划并根据规划后的路径到达巡检点进行巡检;
S6:判断所述巡检机器人是否完成巡检,若完成执行步骤S7,若未完成返回步骤S5;
S7:巡检完成,巡检机器人进行返航路线的规划并按照返航路线返航;
S8:巡检机器人完成入库后,关键部件断电,巡检结束。
巡检机器人和监控后台以及充电库之间的通信由主通信和辅助通信共同构成。主通信通过无线AP构建无线网络,作为与监控后台和充电库的主通信,主要实现巡检机器人状态数据、图像数据的传输;辅助通信由第一物联网模块和第二物联网模块接入安全控制板的RS485接口来实现,主要实现巡检机器人与监控后台和充电库的心跳连接以及位置通信。
步骤S1中建立主通信指的是通过无线网络建立巡检机器人与监控后台和充电库之间的通信,并设置主通信接收时间阈值T1;
步骤S1中建立辅助通信指的是通过物联网建立巡检机器人与监控后台和充电库之间的通信,并设置辅助通信接收时间阈值T2;且满足T1<T2。
在主通信正常通信的情况下,巡检机器人通过主通信完成整个巡检过程;此时辅助通信与监控后台进行独立的通信,在安全控制板自检完成后,辅助通信等待监控后台发送的心跳帧;
在主通信出现异常且连接时间超过T1时,辅助通信接收监控后台心跳帧并反馈此时巡检机器人位置信息,巡检机器人根据返航路径返回至充电库,通过辅助通信与充电库通信并打开卷闸门,巡检机器人完成入库,等待所述主通信连接。
请参照图3和图4,对本发明实施例中主通信处理流程和辅助通信流程进一步说明。
S11:巡检机器人上电后通过无线网络通信接收监控后台连接帧,包括帧头,帧序号,设备ID,指令字节长度,指令类型,数据域,CRC校验位和帧尾;
S12:判断巡检机器人是否成功接收连接帧,若接收成功进入步骤S13,若接收失败执行步骤S121;
S13:巡检机器人返回连接状态信息,并接收监控后台配置帧,配置帧包括电量阈值、电量报警阈值、通信超时阈值、通信中断阈值、避障阈值、防跌落阈值和机器人舱体温湿度阈值;
S14:判断巡检机器人是否成功接收配置帧,若接收成功进入步骤S15,若接收失败进入步骤S121;
S15:巡检机器人返回配置信息和自检信息,并接收监控后台状态查询信息;
S16:判断巡检机器人是否成功接收查询信息,若接收成功进入步骤S17,若接收失败进入步骤S121;
S17:返回巡检机器人状态信息,并接收监控后台巡检指令;
S18:判断巡检机器人是否接收成功巡检指令,若接收成功进入步骤S19,若接受失败则进入步骤S121;
S19:巡检机器人执行巡检并返回巡检结果。
若步骤S12中信号接收失败,则进一步判断接收是否超时;
S121:判断巡检机器人接收连接帧时间是否超时,若超时进入步骤S122,若未超时返回步骤S11;
S122:巡检机器人通过物联网向监控后台发送主通信异常信息;
S123:监控后台判断主通信是否中断,若中断进入步骤S124,若未中断返回步骤S11;
S124:巡检机器人亮起红灯显示异常,并规划返航路径返航;
S125:巡检机器人回到原点,通过物联网通信打开充电库;
S126:巡检机器人入库,等待主通信连接;
S127:判断主通信连接是否恢复,若主通信连接恢复,进入步骤S128,若主通信未恢复,等待主通信连接;
S128:巡检机器人重新出库,重新规划巡检路线继续未完成的巡检,并返回巡检结果。
物联网通信作为辅助通信模块,图4是本发明实施例辅助通信处理流程。
巡检机器人上电通过物联网接收监控后台心跳帧;
判断巡检机器人是否成功接收心跳帧,若成功接收则向监控后台返回位置信息,若接收失败,判断连接是否超时,若连接超时报警后重启物联网模块;若连接未超时继续通过物联网接收监控后台心跳帧。
若主通信出现异常,在巡检机器人返航至自动入库期间,无论主通信是否恢复,巡检机器人不响应监控后台指令。
步骤S2中,巡检机器人自检包括主控板自检和安全控制板自检,再通过主控板和安全控制板之间的信号传输状态确认巡检机器人自检状态。
主控板自检和安全控制板自检结束后,通过主控板是否接收到反馈帧、安全控制板是否接收到连接帧、主控板接收到反馈帧的时间是否超时和安全控制板接收到连接帧的时间是否超时来判断主控板和安全控制板的连接状态;
安全控制板是否接收到查询帧、主控板是否接收到安全控制板反馈的查询帧、安全控制板接收到查询帧是否超时和所述主控板接收到反馈的查询帧的时间是否超时和查询的具体信息来进一步判断连接在安全控制板和主控板上的设备的连接状态。
请参照图5,对本发明实施例中巡检机器人自检进一步说明。
S21a:巡检机器人上电,主控板自检;
S22a:判断主控板自检结果是否正常,若自检正常进入步骤S23a,反之通过5Gwifi网络上传异常情况到监控后台;
S23a:主控板向安全控制板发送连接帧;
S24a:判断主控板是否接收反馈帧,若接收到反馈帧进入步骤S25a,若未接收到反馈帧,判断接收是否超时,若未超时返回步骤S23a,若超时通过5G wifi网络上传异常情况到监控后台;
S25a:主控板向安全控制板、双光谱一体机发送状态查询帧;
S26a:判断主控板是否接收到安全控制板反馈的状态查询帧,若接收到状态查询帧,进入步骤S27a,若未接收到状态查询帧,则进一步判断接收是否超时,若未超时返回S25a,若超时通过5G wifi网络上传异常情况到监控后台;
S27a:判断安全控制板和双光谱一体机是否无异常,若无异常进入S28a,若出现异常通过5G wifi网络上传异常情况到监控后台;
S28a:巡检机器人系统自检成功并将自检成功的信息通过5G wifi网络上传到监控后台。
安全控制板自检流程:
S21b:巡检机器人上电,安全控制板自检;
S22b:判断安全控制板自检是否正常,若是自检正常,进入步骤S23b,若自检异常,安全控制板直接宕机;
S23b:等待主控板连接帧;
S24b:判断安全控制板是否接收到连接帧,若接收到连接帧,进入步骤S25b,若未接收到连接帧,进一步判断接收是否超时,若未超时返回步骤S23b,若超时通过物联网上传异常情况到监控后台;
S25b:安全控制板向主控板返回反馈帧;
S26b:查询安全控制板状态信息,接收构图雷达、避障模块和防跌落模块的数据信息;
S27b:等待主控板查询帧;
S28b:判断安全控制板是否接收到查询帧,若接收到查询帧进入步骤S29b,若未接收到查询帧,进一步判断接收是否超时,若未超时返回步骤S27b,若超时通过物联网上传异常情况到监控后台;
S29b:发送自检信息至主控板。
通过安全控制板发送的自检信息和主控板自检信息进一步确认巡检机器人自检结果。
本发明还公开了一种融合物联网技术的巡检机器人的路径规划方法及系统
请参照图6,步骤S4中巡检机器人路径规划的方法包括以下步骤:
A1:对巡检机器人所要巡检的区域进行预先设置;
A1.1:通过构图雷达构建变电所内电子地图;
A1.2:对电子地图内的道路进行配置生成配置表,并将配置表存储在电子地图数据库单元;
A1.3:确定原点坐标、x轴和y轴方向,并存储所述配置表中每一个标志点的坐标信息(xn,yn)/(xm,ym),n、m表示相邻的标志点编号;
A1.4:利用坐标信息分别构建路径中所述标志点坐标计算方法和巡检机器人与所述标志点之间的距离计算方法,并将计算方法存储在数据处理单元;相邻标志点(即相邻巡检点或相邻关键路径点或巡检点和相邻关键路径点)之间的坐标计算方法为M=|(|xn|+|yn|)-(|xm|+|ym|)|;
主干路上相邻点距离L(k)=M
小路上相邻点距离L(k)=(q+1)*M
坡路上相邻点距离L(k)=(p+1)*M
巡检点或关键路径点与巡检机器人之间的距离L等于当前巡检点和巡检机器人之间所有相邻标志点距离之和。
q为小路权值;p为坡路权值;m、n表示相邻的标志点的编号,L巡检机器人与标志点之间的距离,xn 、yn分别表示标号为n处的标志点的横坐标和纵坐标数值,xm、ym分别表示标号为m处的标志点的横坐标和纵坐标数值,M为相邻标志点坐标的计算值,L(k)表示相邻标志点之间的距离,k为相邻标志点之间的路径距离编号。
p=sinθ+(1-cosθ)*ɥ,q为经验值,可根据实际经验得到,一般取值0.5;
θ表示坡度,0°<θ<20°;ɥ表示摩擦系数。
A2:通过电子地图数据库单元存储的电子地图和道路配置表搜索原点与巡检点之间最少关键路径点,并调取关键路径点坐标;
A3:根据A1.4中计算方法计算出最近巡检点,并进行第一次排序,存储第一次排序,到距离最近巡检点巡检,并上传巡检结果;
A4:搜索当前巡检点与未巡检点之间的关键路径点;计算当前巡检点与关键路径点之间的距离,计算出最近巡检点,根据比较结果更新第一次排序;
A5:到距离最近巡检点巡检,并上传巡检结果;若到达最后巡检点则记录并将最终的巡检路径存储在路径存储单元,执行A6;若未到达最后巡检点执行A4;
A6:巡检结束后根据所述巡检机器人是否在主干路确定返航路径。
巡检机器人路径规划系统包括电子地图数据库单元、数据处理单元和路径存储单元;
电子地图数据库单元,用于存储构图雷达构建的变电所内的电子地图和道路配置表;
数据处理单元,用于存储路径中所述标志点坐标算法和巡检机器人与所标志点之间的距离计算方法并执行计算;
路径存储单元,用于存储首次排序序列和路径筛选单元筛选出的最短巡检/返航路径。
巡检机器人到达巡检点后,执行拍摄或者测温动作,并直接通过网络将巡检结果上传至监控后台,监控后台进行图像识别以及数据处理。
配置表中包括道路的类型标记,巡检点和关键路径点的标记和编号,以及相邻巡检点或相邻关键路径点或关键路径点和巡检点之间的距离进行编号;道路类型包括主干路、小路、坡路。
原点以充电库为参照物,通过对充电库正面测距,校正x轴方向;通过对屋体两边沿扫描,校正机器人位姿角度确定y轴方向,这样保证了机器人每次出发位置基本一致。
请参照图7,所述步骤A6中返航路径的规划路径分为以下情况:
①若巡检机器人最后一个巡检点在主干路上,根据距离计算方法计算出最近关键路径点,到达最近关键路径点后搜索所述最近关键路径点与原点之间所有关键路径点;若最近路径关键点与原点之间的关键点数量大于等于1,则计算每一个关键路径点与最近关键路径点之间的距离,根据距离进行排序后,控制巡检机器人到达下一个最近的关键路径点,以此循环,直至搜索到关键路径点与原点之间没有关键路径点;
②若巡检机器人最后一个巡检点不在主干路上,搜索距离最近的关键路径点,到达该关键路径点后,搜索最近关键路径点与原点之间所有关键路径点;若最近关键路径点与原点之间的关键路径点数量大于等于1,则计算每一个关键路径点与所述最近关键路径点之间的距离,根据距离进行排序后,控制巡检机器人到达下一个最近的关键路径点,以此循环,直至搜索到关键路径点与原点之间没有关键路径点。
关键路径点设置在两个路径交叉的地方,返航时,为了防止巡检机器人重复走或者绕远路,以关键路径点为计算点,也就是巡检机器人返航时只走计算的关键路径点而不是巡检点,通过关键路径点能快速的找到零点位置。
以图8的配置图为例对计算方法进行阐述,巡检点为2,5,7,8。
图中:
0点:原点,巡检起点和终点
圆点(即图示圆圈):巡检点
方点(即图示方框):关键路径点
黑线:主干路
断线:小路
带斜杠线:坡路
巡检机器人巡检时,
1)计算距离起始点0点与巡检点2,5,7,8距离;
通过图上路径搜索最少关键路径点,并调取数据库中关键路径点的坐标。
0与巡检点2之间存在:关键路径点1;
0与巡检点5之间存在:关键路径点1,3,4;
0与巡检点7之间存在:关键路径点1,3,4,6或者1,11,10,9
0与巡检点8之间存在:关键路径点1,3,4,6或者1,11,10,9
根据查询的坐标通过标志点坐标计算方法计算出坐标值,再计算出原点和巡检点之间的距离:
0与巡检点2之间距离L = L(1)+L(2);
0与巡检点5之间距离L= L(1)+L(2)+L(3)+L(4)+1.5×L(5);
0与巡检点7之间距离
L=L(1)+L(2)+L(3)+L(4)+1.8×L(6)+L(7)/L=L(1)+L(12)+L(11)+1.8×L(10)+L(9)+L(8)
0与巡检点8之间距离
L=L(1)+L(2)+L(3)+L(4)+1.8×L(6)+L(7)+L(8) /L=L(1)+L(12)+L(11)+1.8×L(10)+L(9)
2)计算得到最近的巡检点为2;
3)到巡检点2后,计算巡检点2 与巡检点5,7,8距离,并重复上面的计算过程;
4)计算得到最近的巡检点为5;
5)依次类推,全部巡检点计算完毕后,最短巡检顺序为2->5->7->8。
6)将该路径存储到数据库,并作为下次巡检路径。
巡检机器人返航时,先确认巡检机器人当前所处位置是否在关键路径点,再进一步计算机器人在巡检点8回到0点的返航路径,8属于巡检点;
1)计算巡检点8距离最近关键路径点为9;
2)计算距离9最近关键路径点为10;
3)计算距离10最近关键路径点为12;
4)计算距离12最近关键路径点为10,出现该情况时,计算排除关键路径点12,重新计算距离10最近关键路径点为11;
5)依次类推,全部关键路径点计算完毕,最短返航顺序为:8->9->10->11->1->0;
6)将该路径存储到数据库,并作为下次返航路径。
尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (10)
1.一种融合物联网技术的巡检机器人的控制方法,其特征在于,
所述方法包括以下步骤:
S1:巡检机器人上电,建立通信,所述建立通信包括建立主通信和建立辅助通信;
S2:所述巡检机器人自检,若自检正常则执行下面步骤S3;
S3:所述巡检机器人接收监控后台指令确认是否进行巡检;
S4:若接收到巡检指令,所述巡检机器人执行出库;
S5:出库完成后,所述巡检机器人进行巡检路径规划,所述巡检机器人根据巡检路径到达巡检点进行巡检;
S6:判断所述巡检机器人是否完成巡检,若完成执行下面步骤S7,若未完成返回步骤S5;
S7:所述巡检机器人进行返航路径的规划,所述巡检机器人按照所述返航路径返航;
S8:完成入库,所述巡检机器人关键部件断电,巡检结束;
其中,在所述主通信正常通信的情况下,所述巡检机器人通过所述主通信完成整个巡检过程,此时所述辅助通信与监控后台进行独立的通信;在安全控制板自检完成后,所述辅助通信等待监控后台发送的心跳帧;
在所述主通信出现异常且连接时间超过主通信接收时间阈值时,所述辅助通信接收监控后台心跳帧并反馈此时所述巡检机器人位置信息,所述巡检机器人根据返航路径返回至充电库,通过所述辅助通信与充电库通信并打开卷闸门,所述巡检机器人完成入库,等待所述主通信连接。
2.根据权利要求1所述的一种融合物联网技术的巡检机器人的控制方法,其特征在于,
所述S1中,建立主通信指的是通过无线网络建立所述巡检机器人与所述监控后台和充电库之间的通信,并设置所述主通信接收时间阈值T1;
所述S1中,建立辅助通信指的是通过物联网建立所述巡检机器人与所述监控后台和充电库之间的通信,并设置所述辅助通信接收时间阈值T2,且满足T1<T2。
3.根据权利要求1所述的一种融合物联网技术的巡检机器人的控制方法,其特征在于,
所述主通信出现异常时,在所述巡检机器人返航至入库期间,无论所述主通信是否恢复,所述巡检机器人不响应所述监控后台指令。
4.根据权利要求1所述的一种融合物联网技术的巡检机器人的控制方法,其特征在于,
所述S3中,所述巡检机器人若未接收到巡检指令,则进一步判断接收的指令是否是查询帧,如果是查询帧,所述巡检机器人进行状态查询,设置每一次查询时间间隔T,并向所述监控后台发送状态信息,如果不是查询帧,则是配置帧。
5.根据权利要求1所述的一种融合物联网技术的巡检机器人的控制方法,其特征在于,
所述S2中,所述巡检机器人自检包括主控板自检和安全控制板自检,再通过所述主控板和所述安全控制板之间的信号传输状态确认巡检机器人自检状态。
6.根据权利要求5所述的一种融合物联网技术的巡检机器人的控制方法,其特征在于,
所述主控板自检和所述安全控制板自检结束后,通过所述主控板是否接收到反馈帧、所述安全控制板是否接收到连接帧、所述主控板接收到所述反馈帧的时间是否超时和所述安全控制板接收到所述连接帧的时间是否超时来判断所述主控板和所述安全控制板的连接状态;
通过所述安全控制板是否接收到查询帧、所述主控板是否接收到所述安全控制板反馈的查询帧、所述安全控制板接收到所述查询帧的时间是否超时、所述主控板接收到反馈的查询帧的时间是否超时和所述查询帧的具体状态信息来进一步判断连接在所述安全控制板和所述主控板的设备的连接状态。
7.根据权利要求6所述的一种融合物联网技术的巡检机器人的控制方法,其特征在于,
所述主控板和所述安全控制板连接完成后接收查询帧之前,所述安全控制板主动查询构图雷达、避障模块和防跌落模块的数据信息,查询完成后响应所述主控板的查询信息。
8.一种执行如权利要求1-7任一所述的一种融合物联网技术的巡检机器人的控制方法的系统,其特征在于,
所述系统包括上位系统、下位系统、监控后台和充电库,所述上位系统包括主控板;所述下位系统包括安全控制板;
所述上位系统作为主控模块;
所述下位系统用于执行所述主控模块的指令及向所述主控模块反馈信息;
所述监控后台用于对所述巡检机器人的状态进行监控,并向所述巡检机器人发送指令;
所述充电库用于所述巡检机器人的充电以及作为所述巡检机器人等待信号连接时的存放区域,还用于与所述巡检机器人和监控后台的信号连通。
9.根据权利要求8所述的一种融合物联网技术的巡检机器人的控制方法的系统,其特征在于,
所述主控板上连接交换机,所述交换机通过无线接入点与所述监控后台和充电库实现通信;
所述主控板和所述安全控制板通过以太网口连接;
所述安全控制板通过物联网通信模块1和物联网通信模块2与所述监控后台和充电库实现通信。
10.根据权利要求8所述的一种融合物联网技术的巡检机器人的控制方法的系统,其特征在于,
所述安全控制板采用PCB板卡,所述PCB板卡包含2路CAN接口,16路IO接口,4路RS485接口,2路以太网接口,所述安全控制板内部采用2取2 CPU架构,其中,一路CPU主要负责采集各个传感器信息,另一路CPU负责驱动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110353136.0A CN112731948B (zh) | 2021-04-01 | 2021-04-01 | 一种融合物联网技术的巡检机器人的控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110353136.0A CN112731948B (zh) | 2021-04-01 | 2021-04-01 | 一种融合物联网技术的巡检机器人的控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112731948A CN112731948A (zh) | 2021-04-30 |
CN112731948B true CN112731948B (zh) | 2021-06-22 |
Family
ID=75596374
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110353136.0A Active CN112731948B (zh) | 2021-04-01 | 2021-04-01 | 一种融合物联网技术的巡检机器人的控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112731948B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113324998B (zh) * | 2021-05-13 | 2022-02-08 | 常州博康特材科技有限公司 | 一种用于钛合金棒材的生产质检监管系统 |
CN113050661A (zh) * | 2021-06-02 | 2021-06-29 | 成都四方伟业软件股份有限公司 | 一种三维场景内自动巡检方法及装置 |
CN114918952A (zh) * | 2022-06-29 | 2022-08-19 | 苏州浪潮智能科技有限公司 | 一种机房巡检机器人 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102593739A (zh) * | 2012-03-27 | 2012-07-18 | 沈阳中兴电力通信有限公司 | 磁导航巡检机器人智能控制系统 |
CN104953709A (zh) * | 2015-06-15 | 2015-09-30 | 湖南机电职业技术学院 | 一种变电站智能巡视机器人 |
CN106292671A (zh) * | 2016-09-19 | 2017-01-04 | 上海永乾机电有限公司 | 一种多点分布集中控制巡检系统 |
CN106532946B (zh) * | 2016-11-30 | 2019-07-19 | 河海大学常州校区 | 一种机器人电站巡检系统及方法 |
CN106936218A (zh) * | 2017-05-15 | 2017-07-07 | 国家电网公司 | 基于物联网和智能巡检机器人的配电网综合监控系统 |
CN108052870A (zh) * | 2017-11-26 | 2018-05-18 | 西安立东行智能技术有限公司 | 一种高速巡检识别报修共享单车并标注的方法及智能设备 |
EP3934861A4 (en) * | 2019-03-08 | 2022-12-07 | Gecko Robotics, Inc. | INSPECTION ROBOT |
CN110587629A (zh) * | 2019-10-15 | 2019-12-20 | 云南电网有限责任公司电力科学研究院 | 变电站巡检机器人、巡检方法及巡检机器人控制方法 |
-
2021
- 2021-04-01 CN CN202110353136.0A patent/CN112731948B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN112731948A (zh) | 2021-04-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112729315B (zh) | 一种融合物联网技术的巡检机器人的路径规划方法及系统 | |
CN112731948B (zh) | 一种融合物联网技术的巡检机器人的控制方法及系统 | |
CN101625573B (zh) | 基于数字信号处理器的巡线机器人单目视觉导航系统 | |
CN112207846B (zh) | 一种可升降式机房智能巡检机器人系统及巡检方法 | |
CN102280826B (zh) | 变电站智能机器人巡检系统及巡检方法 | |
CN205193562U (zh) | 一种基于以太网交换总线的无人机飞行控制系统 | |
CN109412079B (zh) | 一种输电线无人机巡检系统 | |
CN112611386B (zh) | 一种基于优选路线规划的变电站智能巡检方法 | |
CN104977912A (zh) | 一种基于以太网交换总线的无人机飞行控制系统及方法 | |
CN106451201A (zh) | 一种变电站巡检系统 | |
CN110770600A (zh) | 分布式光检测和测距(lidar)管理系统 | |
CN102097860A (zh) | 一种变电站安全检测的智能机器人巡检系统 | |
CN106441428A (zh) | 一种变电站巡检方法 | |
CN110908380A (zh) | 一种电缆隧道机器人自主巡检方法及系统 | |
CN207643145U (zh) | 一种机器人控制系统 | |
CN207268846U (zh) | 电力巡检机器人 | |
CN114859972A (zh) | 空中无人机与地面巡检机器人协同作业的巡检系统及方法 | |
CN108806261A (zh) | 一种智慧式交通执勤机器人及其商业模式 | |
CN115202376A (zh) | 一种基于单兵移动的无人机巡检电力网格化管控平台 | |
CN106444839A (zh) | 无人机高压电缆自动巡线系统 | |
CN201975857U (zh) | 一种变电站安全检测的智能机器人巡检系统 | |
CN113081525B (zh) | 一种智能助行设备及智能助行设备的控制方法 | |
CN209963606U (zh) | 一种基于无线充电的变电站智能巡检机器人 | |
CN108417041A (zh) | 一种基于四旋翼和云服务器的乡村道路监控系统及方法 | |
CN111754647A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |