一种轻型轨道机器人四驱运动控制系统及其方法技术方案

本发明专利技术公开了一种轻型轨道机器人四驱运动控制系统及其方法，包括：中央控制单元与动力能量管理单元、运动驱动单元和外围传感辅助单元分别通信；中央控制单元控制运动驱动单元和动力能量管理单元，同时接收外围传感辅助单元的反馈信息，实时调整运动驱动单元的控制参数，实现系统安全平稳运行；中央控制单元根据动力能量管理单元的电量控制与反馈，合理调整运动驱动单元的负载平衡。本发明专利技术有益效果：实现电力隧道内轻型轨道机器人四个独立步进伺服电机的驱动，以最佳能效比，实现四轮运转同步，解决单驱在轨运动重心不稳，驱动力不足、坡道驱动轮打滑，增加减速机后运动噪音大等问题。

【技术实现步骤摘要】
一种轻型轨道机器人四驱运动控制系统及其方法
本专利技术涉及电力隧道机器人监控
，尤其涉及一种轻型轨道机器人四驱优化控制系统及其方法。
技术介绍
随着电缆在城市电网的广泛应用，电力隧道成为电缆敷设的主要通道之一。电力电缆隧道一般空间比较狭小，而且地面不平，内部施工地面容易出现障碍物，不利于地面机器人应用。悬挂机器人比较适合隧道空间应用，但是国内的电力隧道质量等等不一，需要充分考虑轨道重量及巡检机器人行走的震动冲击对电力隧道造成的潜在威胁进行评估。目前国内电力电缆隧道经常存在纵横交错的情况，单一或环形轨道巡检机器人无法适应地形相对复杂的电缆隧道，而通常这些复杂的电缆隧道都是需要特别关注的。目前已经存在的电力隧道在轨巡检机器人，为单驱巡检机器人，能够实现电力隧道内的设备巡检，但是这种单驱吊轨电力巡检机器人通常带载能力不强，如果要增强带载能力必然要增加机械强度增加机械复杂度，而且容易出现重心不稳，驱动力不均衡，易出现驱动轮打滑动力丢失；常规伺服电机转速很高需要配备合适的减速机提升带载扭矩，通常减速机效率较低一般不超过80％，而且系统通常不具备电机刹车能量回收功能。而在狭小的隧道内吊轨上根本无法使用常规的汽车差速器4驱方式。
技术实现思路
本专利技术的目的就是为了解决上述问题，本专利技术提供一种轻型轨道机器人四驱运动控制系统及其方法，该系统及方法采用四路独立步进伺服电机驱动在轨4个小轮，不仅解决了驱动力不均衡，中心不稳，驱动力不足、机械结构复杂等问题，而且解决常规隧道巡检机器人能效利用率低等问题，极大提升了在轨机器人的巡航距离。使巡检机器人能够适应各种(坡度小于35°)复杂隧道吊轨路况。为了实现上述目的，本专利技术采用如下技术方案：一种轻型轨道机器人四驱运动控制系统，包括：中央控制单元、动力能量管理单元、运动驱动单元以及外围传感辅助单元；所述中央控制单元与动力能量管理单元、运动驱动单元和外围传感辅助单元分别通信；所述中央控制单元控制运动驱动单元和动力能量管理单元，同时接收外围传感辅助单元的反馈信息，实时调整运动驱动单元的控制参数，实现系统安全平稳运行；中央控制单元根据动力能量管理单元的电量控制与反馈，合理调整运动驱动单元的负载平衡；所述运动驱动单元包括驱动管理器以及与驱动管理器分别连接的步进伺服电机、制动控制部件以及机械驱动轮；所述驱动管理器接收中央控制单元的控制指令，同时参照实时轨道位置反馈信息，对步进伺服电机进行统一驱动管理，对弯道坡道进行软件差速补偿或扭矩补偿。进一步地，所述步进伺服电机直接通过连轴器与机械驱动轮连接，完全通过驱动管理器进行调速；驱动管理器接收到中央控制单元的制动指令后，根据当前机器人运行速度与质量及刹车紧急程度，分析所需要的制动力矩F1，如果电机再生电量产生的制动力矩F2>F1，则不需要机械驱动轮的机械制动器，否则需要启动机械驱动轮的机械制动器进行辅助刹车。进一步地，所述中央控制单元包括：CPU中央处理器以及与CPU中央处理器分别连接的网络通信模块、总线控制器、信号处理模块和故障防护模块。进一步地，所述动力能量管理单元包括电源管理模块、电池模组、受控制动能量回收模块以及法拉电容快速能量吸收模组；所述电源管理模块、受控制动能量回收模块以及法拉电容依次串联连接，所述电源管理模块和法拉电容分别与电池模组连接。进一步地，所述电源管理模块接收中央控制单元的指令，管理受控制动能量回收模块，启动能量回收保护，将电机制动产生的反向电流由法拉电容快速能量吸收模组吸收，之后再将回收的电能回馈到电池模组中，避免紧急刹车能量以摩擦力发热的形式流失。进一步地，所述外围传感辅助单元包括信号接口以及分别与信号接口连接的定位传感器、激光安全雷达、电机运行状态反馈信号、电源安全传感器和运行故障信号；所述信号接口与中央控制单元连接。一种如权利要求1所述的轻型轨道机器人四驱运动控制系统的控制方法，包括以下步骤：(1)设备上电自检，自检通过后进入下一步参数初始化阶段；自检超时后重新开始自检，若多次自检失败进入停止告警状态；(2)电机运动参数初始化，参数初始化后电机处于工作就绪状态；(3)等待中央控制单元控制运动驱动单元，驱动步进伺服电机运转；(5)中央控制单元进行广播启/停控制实现四个电机指令同步及运动同步，运行过程中如需要刹车，进行制动控制启动能量回收；(6)实时电机状态监测：实时监测每个电机的工作温度、工作电压、工作电流、电机轴的转速、电机输出扭矩以及电机位置反馈信息；分析每个电机的工作电流、输出扭矩、电机转速，确定机器人在运行过程中是否有某个电机运动打滑或某个电机负载过重；分析每个电机输出位置、输出转速和输出扭矩，判定是否到达设定目标；(7)电机驱动参数调整：运转过程中出现某个电机打滑，随时调整该电机和其他电机的转速及输出扭矩，保证机器人平衡稳定运行；(8)电机故障处理：实时检测电机故障标志，提取电机故障码，根据故障码对电机故障类型进行判定；若为可修复故障，则中央控制单元对故障电机初始化，清除故障；若为不可修复故障，则中央控制单元发出停机指令，同时上报故障信息；(9)停机控制：正常停止时，采用扭矩有效电机和速度有效电机的增量位置信息调整机器人位置及里程，到达设定的位置后，中央控制单元控制机器人停止运动；故障停止时，机器人自动控制停止。进一步地，进行制动控制启动能量回收的具体过程为：(1)启动制动，由于安全需要或工作巡检需要紧急刹车；(2)制动扭矩判断，驱动管理器判定电机能量回收制动扭矩F1是否大于停车需要扭矩F2，若F1>F2不需要启动机械制动，否则需要启动机械制动进行刹车辅助；(3)切断电机动力电源，保持电机逻辑供电，电机处于发电状态；(4)制动能量回收控制器，对电机反向产生的能量进行电压控制，对法拉电容进行快充；(5)制动能量回收完毕，将法拉电容电量回馈到电池中，提高能效利用率。本专利技术的有益效果：通过本专利技术的实施，可以实现电力隧道内轻型轨道机器人四个独立步进伺服电机的驱动，通过对电机转矩补偿和差速补偿，以最佳能效比，实现四轮运转同步，解决单驱在轨运动重心不稳，驱动力不足、坡道驱动轮打滑，增加减速机后运动噪音大等问题；同时本系统更佳节省功耗，因为没有采用常规减速机构而使用直驱模式，避免了机械摩擦导致的能量损失，同时具备电机刹车功能，带有能量回收装置，进一步降低了系统能耗，提升电池巡航能力。附图说明图1为本专利技术系统架构框图；图2为本专利技术中央控制单元结构示意图；图3为本专利技术动力能量管理单元结构示意图；图4为本专利技术外围传感辅助单元结构示意图；图5是本专利技术四驱运动控制流程框图。具体实施方式下面结合附图与实施例对本专利技术作进一步说明。如图1所示，一种轻型轨道机器人四驱运动控制系统，由中央控制单元、动力能量管理单元、运动驱动单元、外围传感辅助单元四部分组成。中央控制单元是系统的核心，管理控制运动驱动单元和动力能量管理单元，同时接收外围传感辅助单元的反馈信息，实时调整运动驱动单元控制参数，实现系统安全平稳运行；中央控制单元根据动力能量管理单元电量控制与反馈，合理调整运动驱动单元负载平衡。中央控制单元结构如图2所示，包括CPU中央处理器以及与CPU中央处理器分别连接的网络通信模块、总线控制器、信号处理模块和故障防护模块。CP本文档来自技高网...

【技术保护点】
一种轻型轨道机器人四驱运动控制系统，其特征是，包括：中央控制单元、动力能量管理单元、运动驱动单元以及外围传感辅助单元；所述中央控制单元与动力能量管理单元、运动驱动单元和外围传感辅助单元分别通信；所述中央控制单元控制运动驱动单元和动力能量管理单元，同时接收外围传感辅助单元的反馈信息，实时调整运动驱动单元的控制参数，实现系统安全平稳运行；中央控制单元根据动力能量管理单元的电量控制与反馈，合理调整运动驱动单元的负载平衡；所述运动驱动单元包括驱动管理器以及与驱动管理器分别连接的步进伺服电机、制动控制部件以及机械驱动轮；所述驱动管理器接收中央控制单元的控制指令，同时参照实时轨道位置反馈信息，对步进伺服电机进行统一驱动管理，对弯道坡道进行软件差速补偿或扭矩补偿。

【技术特征摘要】
1.一种轻型轨道机器人四驱运动控制系统，其特征是，包括：中央控制单元、动力能量管理单元、运动驱动单元以及外围传感辅助单元；所述中央控制单元与动力能量管理单元、运动驱动单元和外围传感辅助单元分别通信；所述中央控制单元控制运动驱动单元和动力能量管理单元，同时接收外围传感辅助单元的反馈信息，实时调整运动驱动单元的控制参数，实现系统安全平稳运行；中央控制单元根据动力能量管理单元的电量控制与反馈，合理调整运动驱动单元的负载平衡；所述运动驱动单元包括驱动管理器以及与驱动管理器分别连接的步进伺服电机、制动控制部件以及机械驱动轮；所述驱动管理器接收中央控制单元的控制指令，同时参照实时轨道位置反馈信息，对步进伺服电机进行统一驱动管理，对弯道坡道进行软件差速补偿或扭矩补偿。2.如权利要求1所述的一种轻型轨道机器人四驱运动控制系统，其特征是，所述步进伺服电机直接通过连轴器与机械驱动轮连接，完全通过驱动管理器进行调速；驱动管理器接收到中央控制单元的制动指令后，根据当前机器人运行速度与质量及刹车紧急程度，分析所需要的制动力矩F1，如果电机再生电量产生的制动力矩F2>F1，则不需要机械驱动轮的机械制动器，否则需要启动机械驱动轮的机械制动器进行辅助刹车。3.如权利要求1所述的一种轻型轨道机器人四驱运动控制系统，其特征是，所述中央控制单元包括：CPU中央处理器以及与CPU中央处理器分别连接的网络通信模块、总线控制器、信号处理模块和故障防护模块。4.如权利要求1所述的一种轻型轨道机器人四驱运动控制系统，其特征是，所述动力能量管理单元包括电源管理模块、电池模组、受控制动能量回收模块以及法拉电容快速能量吸收模组；所述电源管理模块、受控制动能量回收模块以及法拉电容依次串联连接，所述电源管理模块和法拉电容分别与电池模组连接。5.如权利要求4所述的一种轻型轨道机器人四驱运动控制系统，其特征是，所述电源管理模块接收中央控制单元的指令，管理受控制动能量回收模块，启动能量回收保护，将电机制动产生的反向电流由法拉电容快速能量吸收模组吸收，之后再将回收的电能回馈到电池模组中，避免紧急刹车能量以摩擦力发热的形式流失。6.如权利要求1所述的一种轻型轨道机器人四驱运动控制系统，其特征是，所述外围传感辅助单元包括信号接口以及...

【专利技术属性】
技术研发人员：崔伟，张明广，杨震威，
申请(专利权)人：山东康威通信技术股份有限公司，
类型：发明
国别省市：山东,37