CN113510694B - 轨道交通智能巡检机器人系统 - Google Patents

轨道交通智能巡检机器人系统 Download PDF

Info

Publication number
CN113510694B
CN113510694B CN202110399043.1A CN202110399043A CN113510694B CN 113510694 B CN113510694 B CN 113510694B CN 202110399043 A CN202110399043 A CN 202110399043A CN 113510694 B CN113510694 B CN 113510694B
Authority
CN
China
Prior art keywords
inspection robot
power
inspection
control
module
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
Application number
CN202110399043.1A
Other languages
English (en)
Other versions
CN113510694A (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.)
CRRC Qingdao Sifang Rolling Stock Research Institute Co Ltd
Original Assignee
CRRC Qingdao Sifang Rolling Stock Research Institute 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 CRRC Qingdao Sifang Rolling Stock Research Institute Co Ltd filed Critical CRRC Qingdao Sifang Rolling Stock Research Institute Co Ltd
Priority to CN202110399043.1A priority Critical patent/CN113510694B/zh
Publication of CN113510694A publication Critical patent/CN113510694A/zh
Application granted granted Critical
Publication of CN113510694B publication Critical patent/CN113510694B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00—Manipulators mounted on wheels or on carriages
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00—Manipulators mounted on wheels or on carriages
    • B25J5/007—Manipulators mounted on wheels or on carriages mounted on wheels
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1602—Programme controls characterised by the control system, structure, architecture
    • B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676—Avoiding collision or forbidden zones
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1679—Programme controls characterised by the tasks executed
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • B25J9/1697—Vision controlled systems
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Fuzzy Systems (AREA)
  • Mathematical Physics (AREA)
  • Software Systems (AREA)
  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及一种轨道交通智能巡检机器人系统，包括巡检机器人、云控制平台；巡检机器人配置有巡检机器人控制系统；云控制平台根据预设的巡检计划向巡检机器人下发巡检作业任务信息；巡检机器人控制系统接收巡检作业任务信息，根据巡检作业任务信息确定所述巡检机器人的线路期望行驶速度，并控制巡检机器人移动平台根据线路期望行驶速度行驶并启动机器人检测设备进行病害检测；并将巡检机器人的行驶状态信息与病害检测信息实时反馈至所述云控制平台。本发明通过设置云控制平台与巡检机器人控制系统，实现巡检机器人的远程集群控制，并使巡检机器人可以实现自动驾驶，进行自动速度规划、速度控制、自主定位、障碍物检测等。

Description

轨道交通智能巡检机器人系统
技术领域
本发明属于轨道交通巡检机器人技术领域，尤其涉及一种轨道交通智能巡检机器人系统。
背景技术
现有的地铁巡检机器人虽然可以进行自主巡检，但是一般需要专门铺设机器人行驶轨道，成本高，且易造成原隧道结构的破坏。而且现有的自主巡检机器人系统主要采用WiFi通信，由于WIFI通信距离较短，需要沿隧道内间隔设置无线通信单元，铺设专用通信电缆，存在无线电干扰的风险。例如，专利CN107433952A一种智能巡检机器人中该巡检机器人系统需要在地铁隧道壁上单独敷设行驶轨道，容易对地铁隧道的结构产生破坏，并且存在投资大，施工周期长的缺点。专利CN109343538A地铁巡检机器人巡检系统采用wifi通信，需要沿地铁隧道内每隔50米布置无线通信单元，需要沿轨道敷设供电电缆，因此存在无线电干扰的风险，供电电缆侵入铁路限界的风险，另外同样存在投资大，施工难的问题。
因此，本发明针对上述隧道巡检机器人存在的问题，对巡检机器人控制进行改进。
发明内容
本发明在上述现有巡检机器人控制系统不足的基础上提供了一种轨道交通智能巡检机器人系统，通过设置云控制平台与巡检机器人控制系统，实现巡检机器人的远程集群控制，并使巡检机器人可以实现自动驾驶，进行自动速度规划、速度控制、自主定位、障碍物检测等。
为了实现上述目的，本发明提供了一种轨道交通智能巡检机器人系统，包括巡检机器人、云控制平台；所述巡检机器人包括巡检机器人移动平台，巡检机器人移动平台上搭载有机器人检测设备，所述巡检机器人配置有巡检机器人控制系统；
所述云控制平台根据预设的巡检计划向所述巡检机器人下发巡检作业任务信息；
所述巡检机器人控制系统接收巡检作业任务信息，根据巡检作业任务信息确定所述巡检机器人的线路期望行驶速度，并控制所述巡检机器人移动平台根据线路期望行驶速度行驶并启动所述机器人检测设备进行病害检测；将所述巡检机器人的行驶状态信息与病害检测信息实时反馈至所述云控制平台。
优选的，所述云控制平台通过物联网网关与所述巡检机器人控制系统交互通信，包括边缘侧数据采集层、数据传输层、巡检机器人状态监控中心层；
所述边缘侧数据采集层通过物联网网关采集所述巡检机器人控制系统的监测数据，计算所需的边缘侧数据；
所述数据传输层采用5G网络传输与双向加密技术，将所需的边缘侧数据汇聚至所述巡检机器人状态监控中心层；
所述巡检机器人状态监控中心层设置有监控组态界面，用于实现显示待检测隧道故障图像、巡检机器人运动轨迹、巡检机器人核心系统数据。
优选的，所述数据传输层制定规范的数据传输协议，将实时数据及实验数据采用不同消息队列存储，通过数字化机理引导的数据驱动进行设备状态预测，同时考虑设备机理和行驶历史数据，通过数据关联性进行设备故障智能预测及诊断。
优选的，所述巡检机器人控制系统包括ACU自动驾驶控制单元，所述ACU自动驾驶控制单元包括云平台数据通信模块；
所述云平台数据通信模块用于通过物联网网关与所述云控制平台进行数据转发，上传所述巡检机器人的行驶状态信息与病害检测信息至所述云控制平台，并接收所述云控制平台下发的巡检作业任务指令。
优选的，所述ACU自动驾驶控制单元还包括巡检作业任务解析模块，所述巡检作业任务解析模块用于根据所述云控制平台下发的巡检作业任务信息确定所述巡检机器人的线路期望行驶速度，所述巡检作业任务信息包括行驶区间段和检测作业区间段的任务信息。
优选的，所述ACU自动驾驶控制单元还包括自动驾驶流程控制模块、上下电使能模块、速度控制模块、制动控制模块、定位计算模块、障碍物检测模块，所述自动驾驶流程控制模块用于控制巡检机器人根据线路期望行驶速度自动行驶，并协调所述上下电使能模块、速度控制模块、制动控制模块、定位计算模块、障碍物检测模块工作，实现巡检机器人自动驾驶。
优选的，所述上下电使能模块包括电池系统预充电上电控制模块，所述电池系统预充电上电控制模块的工作过程为：
蓄电池闭合供电，VCU上电，VCU控制BMS上电自检，并在BMS自检无故障状态下，控制BMS进入待机状态；
在判断接收到VCU高压指令后，BMS控制供电系统的主负接触器、预充电接触器闭合，BMS接收VCU发送的电机控制器端电压，并在判断电机控制器端电压满足预设电机控制器端电压阈值条件时，BMS控制供电系统主正接触器闭合、预充接触器断开，预充电上电成功。
优选的，所述上下电使能模块还包括电池系统高压正常下电控制模块，所述电池系统高压正常下电控制模块的工作过程为：
BMS接收VCU的高压下电指令，BMS检测供电系统总电流，并在供电系统总电流满足预设供电系统总电流阈值条件时，BMS控制切断供电系统主正接触器，进行高压下电。
优选的，所述上下电使能模块还包括电池系统低压正常下电控制模块，所述电池系统低压下电控制模块的工作过程为：
VCU发送低压下电指令，并在满足预设的VCU下计时时间阈值条件时，VCU切断BMS低压供电；
BMS接收VCU的低压下电指令，并将需要备份的数据存储备份，进行低压下电。
优选的，所述上下电使能模块还包括电池系统高压异常下电控制模块，所述电池系统高压异常下电控制模块的工作过程为：
BMS检测到存在需要立即下电的故障，并将故障信息发送至VCU；
BMS接收到VCU下电指令后，控制供电系统的主正接触器断开，进行高压下电。
优选的，所述上下电使能模块还包括电池系统充电控制模块，所述电池系统充电控制模块的工作过程为：
整车高压全部下电，充电枪物理连接完成，并在判断BMS检测到CC2充电级别需求信息时，BMS进入充电流程，与充电桩通信；
在判断BMS与充电桩通信完成时，控制闭合充电开关；
BMS检测电池箱温度，并在满足预设温度阈值条件时，BMS根据功率需求表向充电机发送充电需求电流；
BMS与充电机通信，控制充电过程，并在接收到充电机发送的充电停止信号或检测到电池已充满电，控制停止充电过程。
优选的，所述速度控制模块用于将当前巡检机器人的线路期望行驶速度和前一辆巡检机器人的行驶状态信息与病害检测信息，经过上位控制器判断后得到当前巡检机器人的线路期望行驶加速度信息，并经过下位控制器控制后，得到当前巡检机器人的期望制动压力与电机扭矩信息，确定线路实际行驶速度。
优选的，所述定位计算模块用于将获取的巡检机器人线路实际行驶速度、线路实际行驶加速度信息，进行融合滤波处理，获取相对定位信息；并根据预设的定位标准参照物获取绝对定位信息以对相对定位信息进行校准，得到实际位置估计值。
优选的，所述障碍物检测模块用于进行障碍物检测，并在检测到障碍物时，控制巡检机器人进入紧急制动状态。
优选的，所述巡检机器人控制系统还包括VCU硬件控制单元，所述VCU硬件控制单元通过CAN总线与所述ACU自动驾驶控制单元进行数据交互；所述VCU硬件控制单元用于控制巡检机器人硬件及采集车辆控制总线的设备状态信息，包括电池能源管理系统、DC/DC变换器，DC/AC变换器，电机控制器、IMU惯性测量单元、液压制动器的状态信息。
与现有技术相比，本发明的优点和积极效果在于：
本发明提供了一种轨道交通智能巡检机器人系统，设置了远程云控制平台与巡检机器人控制系统，远程云控制平台与巡检机器人控制系统通过5G公共网络交互通信，云控制平台根据预设的巡检计划向巡检机器人下发巡检作业任务信息；巡检机器人控制系统根据巡检作业任务信息确定巡检机器人的线路期望行驶速度，并控制巡检机器人移动平台根据线路期望行驶速度行驶并启动机器人检测设备进行病害检测；巡检机器人控制系统同时将巡检机器人的行驶状态信息与病害检测信息实时反馈至云控制平台。本发明中云控制平台具体采用边缘侧数据采集层、数据传输层、巡检机器人状态监控中心层的三层服务模式设置，巡检机器人控制系统包括ACU自动驾驶控制单元、VCU硬件控制单元，VCU硬件控制单元通过CAN总线与ACU自动驾驶控制单元进行数据交互，VCU硬件控制单元用于控制巡检机器人硬件及采集车辆控制总线的设备状态信息；ACU自动驾驶控制单元主要完成与云控制平台5G通信、任务解析、自动驾驶流程控制、远程遥控、上下电管理、速度控制制动控制、定位计算、障碍物检测、故障与警报处理、IMU数据处理、视觉分析等功能。本发明通过设置以现有5G公共网络为基础的云控制平台，解决了巡检机器人的远程控制，集群控制等问题。同时，设置巡检机器人控制系统，使巡检机器人可以在隧道内实现自动驾驶，进行自动速度规划、运行速度控制、自主定位、障碍物检测、检测设备自动启动等问题。
附图说明
图1为云控制平台架构图；
图2为巡检机器人移动平台基本结构原理图；
图3为巡检机器人移动平台电控系统原理图；
图4为巡检机器人控制系统的ACU自动驾驶控制单元原理图；
图5为电池系统预充电上电控制模块控制流程图；
图6为电池系统高压正常下电控制模块控制流程图；
图7为电池系统低压正常下电控制模块控制流程图；
图8为电池系统高压异常下电控制模块控制流程图；
图9为电池系统充电控制模块控制流程；
图10为对于速度控制模块控制原理图；
图11为定位计算模块原理图。
具体实施方式
以下结合附图对本发明的具体实施方式进行进一步的描述。
本发明实施例提供了一种轨道交通智能巡检机器人系统，包括巡检机器人、云控制平台，巡检机器人配置有巡检机器人控制系统，巡检机器人包括巡检机器人移动平台，巡检机器人移动平台上搭载有机器人检测设备。本实施例中机器人检测设备的主要功能为检测隧道的裂缝、衬砌剥落、接缝错台、渗漏水、接缝张开、变形、限界、轨道扣件等病害。巡检机器人移动平台可以搭载任意的检测设备，对于巡检机器人的具体结构，本发明不做限定。
远程云控制平台与巡检机器人控制系统交互通信，云控制平台根据预设的巡检计划向巡检机器人下发巡检作业任务信息；巡检机器人控制系统接收巡检作业任务信息，根据巡检作业任务信息确定巡检机器人的线路期望行驶速度，并控制巡检机器人移动平台根据线路期望行驶速度行驶并启动机器人检测设备进行病害检测；将巡检机器人的行驶状态信息与病害检测信息实时反馈至云控制平台。
对于巡检机器人的远程云控制平台，其通过物联网网关与巡检机器人控制系统交互通信，本发明中云控制平台采用三层服务模式，云平台架构如图1所示，包括边缘侧数据采集层、数据传输层、巡检机器人状态监控中心层；
其中，边缘侧数据采集层通过物联网网关采集巡检机器人控制系统的监测数据，计算所需的边缘侧数据，利用专用的数据驱动，如图像采集驱动、TCP数据通讯驱动实现数据汇聚、清洗及上报等数据处理过程。
数据传输层采用5G网络传输与双向加密技术，通过制定规范的数据传输协议，将所需的边缘侧数据汇聚至巡检机器人状态监控中心层；并通过数字化机理引导的数据驱动进行设备状态预测，同时考虑设备机理和行驶历史数据，通过数据关联性进行设备故障智能预测及诊断。
巡检机器人状态监控中心层实现机器人状态监控，隧道故障情况实时监控，机器人故障监控，从设备运行-隧道状态监测-远程指令控制的管理，其设置有监控组态界面，用于实现显示待检测隧道故障图像、巡检机器人运动轨迹、巡检机器人核心系统数据。对于巡检机器人运动轨迹可以通过绘制隧道地图，通过机器人经纬度位置实时显示。巡检机器人核心系统主要包含制动系统、电池监控系统、传感器系统、检测系统、驱动系统、制动系统、通讯系统等。
对于巡检机器人，其巡检机器人移动平台基本结构原理如图2所示，包括机械结构与电控结构两部分组成，机械系统结构主要包括车架、悬架、驱动电机、轮轴和制动器等部件，电控系统结构主要包括动力电池、高压配电箱、电源变换设备、低压电池、车辆控制器、传感器等电气元件，如图3所示。电控系统分为：高压配电系统、低压配电系统、巡检机器人控制系统。
其中，对于高压配电系统，其由动力电池、高压配电箱，电机控制器，DC/AC逆变器，DC/DC变换器组成。动力电池是整个车辆的动力来源，高压电能由高压配电盒分配给两个电机控制器、DC/AC、DC/DC，电能的分配控制由整车控制器决定。电机控制器将直流电逆变为可控的交流电，驱动电机按照设定的转速或转矩运行。DC/AC逆变器将高压直流电逆变成AC220交流电，为隧道病害检测系统提供供电电源电源。DC/DC直流变换器将高压直流电变换成DC12V直流电，DC12V直流电经过低压蓄电池缓冲后为车辆的低压系统提供电源。
对于低压配电系统，其通过蓄电池给巡检机器人移动平台控制器和传感器等低压设备供电，启动时，控制器、雷达等低压设备首先启动，并进行自检工作。自检完成后，控制器控制高压动力电池系统上电，替代低压电池对巡检机器人移动平台设备进行供电，并对低压电池充电。
对于巡检机器人控制系统，其包括ACU自动驾驶控制单元、VCU硬件控制单元，VCU硬件控制单元通过CAN总线与ACU自动驾驶控制单元进行数据交互，VCU硬件控制单元用于控制巡检机器人硬件及采集车辆控制总线的设备状态信息，包括电池能源管理系统、DC/DC变换器，DC/AC变换器，电机控制器、IMU惯性测量单元、液压制动器的状态信息等。ACU自动驾驶控制单元主要完成与云控制平台5G通信、任务解析、自动驾驶流程控制、远程遥控、上下电管理、速度控制制动控制、定位计算、障碍物检测、故障与警报处理、IMU数据处理、视觉分析等功能，其软件架构如图4所示，ACU自动驾驶控制单元主要包括云平台数据通信模块、巡检作业任务解析模块、自动驾驶流程控制模块、上下电使能模块、速度控制模块、制动控制模块、定位计算模块、障碍物检测模块等，下面将详细介绍各模块设置。
对于云平台数据通信模块，其主要用于通过物联网网关与云控制平台进行数据转发，上传巡检机器人的行驶状态信息与病害检测信息至云控制平台，并接收云控制平台下发的巡检作业任务指令。
对于巡检作业任务解析模块，其主要用于根据云控制平台下发的巡检作业任务信息确定巡检机器人的线路期望行驶速度，巡检作业任务信息包括行驶区间段和检测作业区间段的任务信息。
对于自动驾驶流程控制模块，其主要用于控制巡检机器人根据线路期望行驶速度自动行驶，并协调上下电使能模块、速度控制模块、制动控制模块、定位计算模块、障碍物检测模块工作，实现巡检机器人自动驾驶。
对于上下电使能模块，其包括电池系统预充电上电控制模块、电池系统高压正常下电控制模块、电池系统低压正常下电控制模块、电池系统高压异常下电控制模块、电池系统充电控制模块。
对于电池系统预充电上电控制模块，其控制流程参考图5所示，电池系统预充电上电控制模块的工作过程为：
蓄电池闭合供电，VCU上电，VCU控制BMS上电自检，并在BMS自检无故障状态下，控制BMS进入待机状态；
在判断接收到VCU高压指令后，BMS控制供电系统的主负接触器、预充电接触器闭合，BMS接收VCU发送的电机控制器端电压，并在判断电机控制器端电压满足预设电机控制器端电压阈值条件时，BMS控制供电系统主正接触器闭合、预充接触器断开，预充电上电成功。
对于电池系统高压正常下电控制模块，其控制流程参考图6所示，电池系统高压正常下电控制模块的工作过程为：
BMS接收VCU的高压下电指令，BMS检测供电系统总电流，并在供电系统总电流满足预设供电系统总电流阈值条件时，BMS控制切断供电系统主正接触器，进行高压下电。
对于电池系统低压正常下电控制模块，其控制流程参考图7所示，电池系统低压下电控制模块的工作过程为：
VCU发送低压下电指令，并在满足预设的VCU下计时时间阈值条件时，VCU切断BMS低压供电；
BMS接收VCU的低压下电指令，并将需要备份的数据存储备份，进行低压下电。
对于电池系统高压异常下电控制模块，其控制流程参考图8所示，电池系统高压异常下电控制模块的工作过程为：
BMS检测到存在需要立即下电的故障，并将故障信息发送至VCU；
BMS接收到VCU下电指令后，控制供电系统的主正接触器断开，进行高压下电。
对于电池系统充电控制模块，其控制流程参考图9所示，电池系统充电控制模块的工作过程为：
整车高压全部下电，充电枪物理连接完成，并在判断BMS检测到CC2充电级别需求信息时(CC2充电模式为充电过程中，若给定时间内非车载充电设备没有接收到BMS系统周期发送的充电级别需求报文，非车载充电设备也响应关闭直流电源输出功能)，BMS进入充电流程，与充电桩通信；
在判断BMS与充电桩通信完成时，控制闭合充电开关；
BMS检测电池箱温度，并在满足预设温度阈值条件时，BMS根据功率需求表向充电机发送充电需求电流；
BMS与充电机通信，控制充电过程，并在接收到充电机发送的充电停止信号或检测到电池已充满电，控制停止充电过程。
对于速度控制模块，控制原理如图10所示，其主要用于将当前巡检机器人的线路期望行驶速度和前一辆巡检机器人的行驶状态信息与病害检测信息，经过上位控制器判断后得到当前巡检机器人的线路期望行驶加速度信息，并经过下位控制器控制后，得到当前巡检机器人的期望制动压力与电机扭矩信息，确定线路实际行驶速度。
对于定位计算模块，其原理如图11所示，用于将获取的巡检机器人线路实际行驶速度、线路实际行驶加速度信息，进行融合滤波处理，获取相对定位信息；并根据预设的定位标准参照物获取绝对定位信息以对相对定位信息进行校准，得到实际位置估计值。
对于障碍物检测模块，其主要用于进行障碍物检测，并在检测到障碍物时，控制巡检机器人进入紧急制动状态。
综上，本发明提供的巡检机器人系统，巡检机器人以锂电池为动力，解决了巡检机器人需要敷设单独供电线缆的问题。同时，设置了远程云控制平台与巡检机器人控制系统，远程云控制平台与巡检机器人控制系统通过5G公共网络交互通信，云控制平台根据预设的巡检计划向巡检机器人下发巡检作业任务信息；巡检机器人控制系统根据巡检作业任务信息确定巡检机器人的线路期望行驶速度，并控制巡检机器人移动平台根据线路期望行驶速度行驶并启动机器人检测设备进行病害检测；巡检机器人控制系统同时将巡检机器人的行驶状态信息与病害检测信息实时反馈至云控制平台。本发明中云控制平台具体采用边缘侧数据采集层、数据传输层、巡检机器人状态监控中心层的三层服务模式设置，巡检机器人控制系统包括ACU自动驾驶控制单元、VCU硬件控制单元，VCU硬件控制单元通过CAN总线与ACU自动驾驶控制单元进行数据交互，VCU硬件控制单元用于控制巡检机器人硬件及采集车辆控制总线的设备状态信息；ACU自动驾驶控制单元主要完成与云控制平台5G通信、任务解析、自动驾驶流程控制、远程遥控、上下电管理、速度控制制动控制、定位计算、障碍物检测、故障与警报处理、IMU数据处理、视觉分析等功能。本发明通过设置以现有5G公共网络为基础的云控制平台，解决了巡检机器人的远程控制，集群控制等问题。同时，设置巡检机器人控制系统，使巡检机器人可以在隧道内实现自动驾驶，进行自动速度规划、运行速度控制、自主定位、障碍物检测、检测设备自动启动等问题。
以上所述，仅是本发明的较佳实施例而已，并非是对本发明作其它形式的限制，任何熟悉本专业的技术人员可能利用上述揭示的技术内容加以变更或改型为等同变化的等效实施例应用于其它领域，但是凡是未脱离本发明技术方案内容，依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化与改型，仍属于本发明技术方案的保护范围。

Claims (13)

1.一种轨道交通智能巡检机器人系统，其特征在于，包括巡检机器人、云控制平台；所述巡检机器人包括巡检机器人移动平台，巡检机器人移动平台上搭载有机器人检测设备，所述巡检机器人配置有巡检机器人控制系统；
所述云控制平台根据预设的巡检计划向所述巡检机器人下发巡检作业任务信息；所述云控制平台通过物联网网关与所述巡检机器人控制系统交互通信，包括边缘侧数据采集层、数据传输层、巡检机器人状态监控中心层；
所述边缘侧数据采集层通过物联网网关采集所述巡检机器人控制系统的监测数据，计算所需的边缘侧数据；
所述数据传输层采用5G网络传输与双向加密技术，将所需的边缘侧数据汇聚至所述巡检机器人状态监控中心层；所述数据传输层制定规范的数据传输协议，将实时数据及实验数据采用不同消息队列存储，通过数字化机理引导的数据驱动进行设备状态预测，同时考虑设备机理和行驶历史数据，通过数据关联性进行设备故障智能预测及诊断；
所述巡检机器人状态监控中心层设置有监控组态界面，用于实现显示待检测隧道故障图像、巡检机器人运动轨迹、巡检机器人核心系统数据；
所述巡检机器人控制系统接收巡检作业任务信息，根据巡检作业任务信息确定所述巡检机器人的线路期望行驶速度，并控制所述巡检机器人移动平台根据线路期望行驶速度行驶并启动所述机器人检测设备进行病害检测；将所述巡检机器人的行驶状态信息与病害检测信息实时反馈至所述云控制平台。
2.根据权利要求1所述的轨道交通智能巡检机器人系统，其特征在于，所述巡检机器人控制系统包括ACU自动驾驶控制单元，所述ACU自动驾驶控制单元包括云平台数据通信模块；
所述云平台数据通信模块用于通过物联网网关与所述云控制平台进行数据转发，上传所述巡检机器人的行驶状态信息与病害检测信息至所述云控制平台，并接收所述云控制平台下发的巡检作业任务指令。
3.根据权利要求2所述的轨道交通智能巡检机器人系统，其特征在于，所述ACU自动驾驶控制单元还包括巡检作业任务解析模块，所述巡检作业任务解析模块用于根据所述云控制平台下发的巡检作业任务信息确定所述巡检机器人的线路期望行驶速度，所述巡检作业任务信息包括行驶区间段和检测作业区间段的任务信息。
4.根据权利要求3所述的轨道交通智能巡检机器人系统，其特征在于，所述ACU自动驾驶控制单元还包括自动驾驶流程控制模块、上下电使能模块、速度控制模块、制动控制模块、定位计算模块、障碍物检测模块，所述自动驾驶流程控制模块用于控制巡检机器人根据线路期望行驶速度自动行驶，并协调所述上下电使能模块、速度控制模块、制动控制模块、定位计算模块、障碍物检测模块工作，实现巡检机器人自动驾驶。
5.根据权利要求4所述的轨道交通智能巡检机器人系统，其特征在于，所述上下电使能模块包括电池系统预充电上电控制模块，所述电池系统预充电上电控制模块的工作过程为：
蓄电池闭合供电，VCU上电，VCU控制BMS上电自检，并在BMS自检无故障状态下，控制BMS进入待机状态；
在判断接收到VCU高压指令后，BMS控制供电系统的主负接触器、预充电接触器闭合，BMS接收VCU发送的电机控制器端电压，并在判断电机控制器端电压满足预设电机控制器端电压阈值条件时，BMS控制供电系统主正接触器闭合、预充接触器断开，预充电上电成功。
6.根据权利要求4所述的轨道交通智能巡检机器人系统，其特征在于，所述上下电使能模块还包括电池系统高压正常下电控制模块，所述电池系统高压正常下电控制模块的工作过程为：
BMS接收VCU的高压下电指令，BMS检测供电系统总电流，并在供电系统总电流满足预设供电系统总电流阈值条件时，BMS控制切断供电系统主正接触器，进行高压下电。
7.根据权利要求4所述的轨道交通智能巡检机器人系统，其特征在于，所述上下电使能模块还包括电池系统低压正常下电控制模块，所述电池系统低压正常 下电控制模块的工作过程为：
VCU发送低压下电指令，并在满足预设的VCU下计时时间阈值条件时，VCU切断BMS低压供电；
BMS接收VCU的低压下电指令，并将需要备份的数据存储备份，进行低压下电。
8.根据权利要求4所述的轨道交通智能巡检机器人系统，其特征在于，所述上下电使能模块还包括电池系统高压异常下电控制模块，所述电池系统高压异常下电控制模块的工作过程为：
BMS检测到存在需要立即下电的故障，并将故障信息发送至VCU；
BMS接收到VCU下电指令后，控制供电系统的主正接触器断开，进行高压下电。
9.根据权利要求4所述的轨道交通智能巡检机器人系统，其特征在于，所述上下电使能模块还包括电池系统充电控制模块，所述电池系统充电控制模块的工作过程为：
整车高压全部下电，充电枪物理连接完成，并在判断BMS检测到CC2充电级别需求信息时，BMS进入充电流程，与充电桩通信；
在判断BMS与充电桩通信完成时，控制闭合充电开关；
BMS检测电池箱温度，并在满足预设温度阈值条件时，BMS根据功率需求表向充电机发送充电需求电流；
BMS与充电机通信，控制充电过程，并在接收到充电机发送的充电停止信号或检测到电池已充满电，控制停止充电过程。
10.根据权利要求4所述的轨道交通智能巡检机器人系统，其特征在于，所述速度控制模块用于将当前巡检机器人的线路期望行驶速度和前一辆巡检机器人的行驶状态信息与病害检测信息，经过上位控制器判断后得到当前巡检机器人的线路期望行驶加速度信息，并经过下位控制器控制后，得到当前巡检机器人的期望制动压力与电机扭矩信息，确定线路实际行驶速度。
11.根据权利要求4所述的轨道交通智能巡检机器人系统，其特征在于，所述定位计算模块用于将获取的巡检机器人线路实际行驶速度、线路实际行驶加速度信息，进行融合滤波处理，获取相对定位信息；并根据预设的定位标准参照物获取绝对定位信息以对相对定位信息进行校准，得到实际位置估计值。
12.根据权利要求4所述的轨道交通智能巡检机器人系统，其特征在于，所述障碍物检测模块用于进行障碍物检测，并在检测到障碍物时，控制巡检机器人进入紧急制动状态。
13.根据权利要求2所述的轨道交通智能巡检机器人系统，其特征在于，所述巡检机器人控制系统还包括VCU硬件控制单元，所述VCU硬件控制单元通过CAN总线与所述ACU自动驾驶控制单元进行数据交互；所述VCU硬件控制单元用于控制巡检机器人硬件及采集车辆控制总线的设备状态信息，包括电池能源管理系统、DC/DC变换器，DC/AC变换器，电机控制器、IMU惯性测量单元、液压制动器的状态信息。
CN202110399043.1A 2021-04-14 2021-04-14 轨道交通智能巡检机器人系统 Active CN113510694B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110399043.1A CN113510694B (zh) 2021-04-14 2021-04-14 轨道交通智能巡检机器人系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110399043.1A CN113510694B (zh) 2021-04-14 2021-04-14 轨道交通智能巡检机器人系统

Publications (2)

Publication Number Publication Date
CN113510694A CN113510694A (zh) 2021-10-19
CN113510694B true CN113510694B (zh) 2022-12-23

Family

ID=78062388

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110399043.1A Active CN113510694B (zh) 2021-04-14 2021-04-14 轨道交通智能巡检机器人系统

Country Status (1)

Country Link
CN (1) CN113510694B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114147696A (zh) * 2021-12-13 2022-03-08 国网福建省电力有限公司经济技术研究院 基于5g及北斗的电网巡检机器人定位系统及方法
CN114434496A (zh) * 2022-01-19 2022-05-06 山东新一代信息产业技术研究院有限公司 一种用于检测机器人性能的助理机器人

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104122843A (zh) * 2013-04-24 2014-10-29 山东轻工业学院 城市地下轨道智能检测机器人集中控制系统及实现方法
CN106379188A (zh) * 2016-09-30 2017-02-08 华南理工大学 一种电动汽车动力电池能量管理系统及安全防护方法
CN106625555A (zh) * 2016-11-24 2017-05-10 东台市苏中电工机械有限公司 一种铁路送料机器人
CN108663090A (zh) * 2018-06-29 2018-10-16 国网福建省电力有限公司厦门供电公司 一种电缆隧道智能检测系统

Also Published As

Publication number Publication date
CN113510694A (zh) 2021-10-19

Similar Documents

Publication Publication Date Title
CN113510694B (zh) 轨道交通智能巡检机器人系统
CN110908380B (zh) 一种电缆隧道机器人自主巡检方法及系统
CN104638694B (zh) 用于电动汽车对电动汽车的无线充电系统及方法
CN107390676B (zh) 隧道巡检机器人及隧道巡检系统
CN104638696B (zh) 用于移动式储能电站对新能源汽车的无线充电系统及方法
CN214490573U (zh) 一种基于光储供电的变电站智能巡检机器人
CN205453241U (zh) 视频巡视系统充电装置
CN108608399A (zh) 一种主从分布式控制的巡检机器人
CN107329466A (zh) 一种自动驾驶小型车
CN109861387B (zh) 一种变电站智能巡检系统
CN105449876A (zh) 一种电力巡线多旋翼飞行器的自主无线充电系统
CN108819775A (zh) 一种电力巡线无人机无线充电中继系统及充电方法
CN203476049U (zh) 一种基于门磁开关的变电站巡检机器人自动门控制系统
MX2012012454A (es) Metodos y sistemas para la coleccion y carga automatica de un vehiculo electrico en una estacion de carga.
CN205614641U (zh) 一种变电站巡检机器人
CN104953709A (zh) 一种变电站智能巡视机器人
CN108032743A (zh) 智能快速充电系统和方法
CN104122892A (zh) 大型电机型式试验台智能巡检小车系统
CN207067800U (zh) 纯电动环卫清扫车及其自动驾驶系统
CN110516983A (zh) 基于物联网的机场用电设备智能管理平台和机场智能系统
CN110071582A (zh) 用于输电线路巡检机器人的充电机构及其方法
CN109308070A (zh) 一种纯电动环卫清扫车及其自动驾驶系统
CN109383513A (zh) 环卫清扫车自动驾驶控制方法和控制系统
CN209963606U (zh) 一种基于无线充电的变电站智能巡检机器人
CN111352423A (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