一种六履带四摆臂救援机器人及其自主行走控制方法与流程

文档序号:12336340阅读:1011来源:国知局
一种六履带四摆臂救援机器人及其自主行走控制方法与流程

本发明属于机器人技术领域,具体涉及一种六履带四摆臂救援机器人及其自主行走控制方法。



背景技术:

我国是世界上灾害,事故发生最多的国家之一,如煤矿井下瓦斯爆炸、塌方事故,地面上的火灾、地震塌方,以及相似类型的人为事故,给人民生命财产安全造成极大的危害。在煤矿井下发生瓦斯爆炸、塌方等事故后或是其它灾难环境下,周围环境到严重破坏,受灾环境信息无法直接传送到救援指挥中心,救援人员无法从事救援行动,严重影响救援效率,救援人员承受巨大生命风险。那么迫切需要救援机器人在复杂环境下探索灾难环境信息,并把灾难环境信息传送给救援指挥中心。

但同时,灾难环境十分复杂,救援机器人为无线通信方式进行环境探测,往往会受到环境干扰,导致机器人信号丢失,使救援机器人被困于灾难环境,这时需要机器人根据环境信息,进行自主控制,寻找信号源,并把灾难环境信息传送给救援指挥人员。但是,现有技术中,还缺乏结构紧凑、设计合理、工作可靠性高的能够实现这样的功能的救援机器人。



技术实现要素:

本发明所要解决的技术问题在于针对上述现有技术中的不足,提供一种六履带四摆臂救援机器人,其结构紧凑,设计新颖合理,智能化程度高,工作稳定性和可靠性高,实用性强,使用效果好,便于推广使用。

为解决上述技术问题,本发明采用的技术方案是:一种六履带四摆臂救援机器人,其特征在于:包括机器人本体、两个行走履带组件和四个摆臂履带组件,所述机器人本体包括下箱腔体、上箱腔体、传感器腔体、三个齿轮腔体和两个支撑轮腔体,所述上箱腔体设置在下箱腔体的上部,所述传感器腔体设置在上箱腔体的上部前侧,三个所述齿轮腔体分别为前齿轮腔体、左后齿轮腔体和右后齿轮腔体,所述前齿轮腔体设置在下箱腔体的前侧,所述左后齿轮腔体设置在下箱腔体的后方左侧,所述右后齿轮腔体设置在下箱腔体的后方右侧,两个所述支撑轮腔体分别为左支撑轮腔体和右支撑轮腔体,所述左支撑轮腔体设置在下箱腔体的左侧,所述右支撑轮腔体设置在下箱腔体的右侧;两个行走履带组件分别为设置在左支撑轮腔体上的左行走履带组件和设置在右支撑轮腔体上的右行走履带组件,四个摆臂履带组件分别为设置在左支撑轮腔体前侧的左前摆臂履带组件、设置在左支撑轮腔体后侧的左后摆臂履带组件、设置在右支撑轮腔体前侧的右前摆臂履带组件和设置在右支撑轮腔体后侧的右后摆臂履带组件;

所述下箱腔体内设置有用于驱动左行走履带组件的左行走电机和用于驱动右行走履带组件的右行走电机;以及用于驱动左前摆臂履带组件的左前摆臂电机、用于驱动左后摆臂履带组件的左后摆臂电机、用于驱动右前摆臂履带组件的右前摆臂电机和用于驱动右后摆臂履带组件的右后摆臂电机;所述下箱腔体的外部前侧设置有用于对救援机器人前方的障碍物进行检测的超声波传感器;

所述上箱腔体内设置有控制计算机、电池、变压器、电机驱动器组和三维数字罗盘;所述电机驱动器组包括左行走电机驱动器、右行走电机驱动器、左前摆臂电机驱动器、右前摆臂电机驱动器、左后摆臂电机驱动器和右后摆臂电机驱动器,所述左行走电机驱动器、右行走电机驱动器、左前摆臂电机驱动器、右前摆臂电机驱动器、左后摆臂电机驱动器和右后摆臂电机驱动器均与控制计算机的输出端连接,所述左行走电机与左行走电机驱动器的输出端连接,所述右行走电机与右行走电机驱动器的输出端连接,所述左前摆臂电机与左前摆臂电机驱动器的输出端连接,所述右前摆臂电机与右前摆臂电机驱动器的输出端连接,所述左后摆臂电机与左后摆臂电机驱动器的输出端连接,所述右后摆臂电机与右后摆臂电机驱动器的输出端连接;所述超声波传感器与控制计算机的输入端连接;所述控制计算机上接有用于与远程监控计算机进行无线连接并通信的无线通信模块,所述无线通信模块上接有伸出上箱腔体外部的天线;

所述传感器腔体内设置有环境信息传感器、双目视觉传感器、激光雷达传感器和照明灯;所述环境信息传感器的输出端、双目视觉传感器的输出端和激光雷达传感器的输出端均与控制计算机的输入端连接;

所述前齿轮腔体内设置有用于将左前摆臂电机的动力传递给左前摆臂履带组件的左前摆臂齿轮传动组件、用于将右前摆臂电机的动力传递给右前摆臂履带组件的右前摆臂齿轮传动组件、用于将左行走电机的动力传递给左行走履带组件的左行走齿轮传动组件和用于将右行走电机的动力传递给右行走履带组件的右行走齿轮传动组件;所述左后齿轮腔体内设置有用于将左后摆臂电机的动力传递给左后摆臂履带组件的左后摆臂齿轮传动组件,所述右后齿轮腔体内设置有用于将右后摆臂电机的动力传递给右后摆臂履带组件的右后摆臂齿轮传动组件;

所述左支撑轮腔体内设置有左减震支架和安装在左减震支架上的左减震支撑轮组件,所述左支撑轮腔体外部设置有用于对救援机器人左侧的障碍物进行检测的左红外传感器;所述右支撑轮腔体内设置有右减震支架和安装在右减震支架上的右减震支撑轮组件,所述右支撑轮腔体外部设置有用于对救援机器人右侧的障碍物进行检测的右红外传感器;所述左红外传感器和右红外传感器均与控制计算机的输入端连接。

上述的一种六履带四摆臂救援机器人,其特征在于:所述环境信息传感器包括温度传感器、氧气传感器、甲烷传感器和一氧化碳传感器。

上述的一种六履带四摆臂救援机器人,其特征在于:所述左前摆臂履带组件、右前摆臂履带组件、左后摆臂履带组件和右后摆臂履带组件的结构相同且均包括摆臂轴、摆臂支架以及转动连接在摆臂支架前端的摆臂前轮和转动连接在摆臂支架后端的摆臂驱动轮,所述摆臂轴通过花键与摆臂支架连接,所述摆臂支架的中部转动连接有上下相对设置的摆臂上支撑轮和摆臂下支撑轮,所述摆臂前轮的直径小于摆臂驱动轮的直径,所述摆臂前轮、摆臂上支撑轮、摆臂驱动轮和摆臂下支撑轮上跨接有摆臂橡胶履带,所述摆臂轴上通过轴承转动连接有摆臂套筒轴,所述摆臂驱动轮固定连接在摆臂套筒轴上。

上述的一种六履带四摆臂救援机器人,其特征在于:所述左前摆臂齿轮传动组件、右前摆臂齿轮传动组件、左后摆臂齿轮传动组件和右后摆臂齿轮传动组件的结构相同且均包括摆臂电机锥齿轮和与摆臂电机锥齿轮啮合的摆臂轴锥齿轮,所述摆臂电机锥齿轮固定连接在左前摆臂电机、右前摆臂电机、左后摆臂电机或右后摆臂电机的输出轴上,所述摆臂轴锥齿轮与摆臂轴固定连接。

上述的一种六履带四摆臂救援机器人,其特征在于:所述左行走履带组件和右行走履带组件的结构相同且均包括主动行走轮和从动行走轮,以及跨接在所述主动行走轮和所述从动行走轮上的行走橡胶履带,所述右行走履带组件中的主动行走轮固定连接在右前摆臂履带组件中的摆臂套筒轴上,所述右行走履带组件中的从动行走轮固定连接在右后摆臂履带组件中的摆臂套筒轴上,所述左行走履带组件中的主动行走轮固定连接在左前摆臂履带组件中的摆臂套筒轴上,所述左行走履带组件中的从动行走轮固定连接在左后摆臂履带组件中的摆臂套筒轴上。

上述的一种六履带四摆臂救援机器人,其特征在于:所述左行走齿轮传动组件和右行走齿轮传动组件的结构相同且均包括行走电机锥齿轮和与行走电机锥齿轮啮合的行走轮锥齿轮,所述行走电机锥齿轮固定连接在左行走电机或右行走电机的输出轴上,所述行走轮锥齿轮与摆臂套筒轴固定连接。

上述的一种六履带四摆臂救援机器人,其特征在于:所述左减震支撑轮组件包括三个左减震支撑轮组,每个所述左减震支撑轮组均包括与左减震支架固定连接的左减震轮固定板和与左减震轮固定板通过左减震轮旋转轴转动连接的左减震轮连接板,所述左减震轮连接板的两端各转动连接有一个左减震轮,三个所述左减震支撑轮组中的其中两个设置在左减震支架的下部,三个所述左减震支撑轮组中的另外一个设置在左减震支架的上部,所述左减震支架上固定连接有罩住三个左减震支撑轮组的左减震护板。

上述的一种六履带四摆臂救援机器人,其特征在于:所述右减震支撑轮组件包括三个右减震支撑轮组,每个所述右减震支撑轮组均包括与右减震支架固定连接的右减震轮固定板和与右减震轮固定板通过右减震轮旋转轴转动连接的右减震轮连接板,所述右减震轮连接板的两端各转动连接有一个右减震轮,三个所述右减震支撑轮组中的其中两个设置在右减震支架的下部,三个所述右减震支撑轮组中的另外一个设置在右减震支架的上部,所述右减震支架上固定连接有罩住三个右减震支撑轮组的右减震护板。

本发明还公开了一种方法步骤简单、设计新颖合理、实现方便、能够实现自动避障的六履带四摆臂救援机器人的自主行走控制方法,其特征在于,该方法包括以下步骤:

步骤一、数据采集及传输:环境信息传感器对救援机器人所处环境信息进行检测并将检测到的信号传输给控制计算机,双目视觉传感器对救援机器人前方的道路环境图像进行检测并将检测到的信号传输给控制计算机,激光雷达传感器对救援机器人与前方障碍物的距离进行检测并将检测到的信号传输给控制计算机,左红外传感器对救援机器人左侧的障碍物进行检测并将检测到的信号传输给控制计算机,右红外传感器对救援机器人右侧的障碍物进行检测并将检测到的信号传输给控制计算机,超声波传感器用于对救援机器人前方的障碍物进行检测并将检测到的信号传输给控制计算机,三维数字罗盘对救援机器人的姿态进行检测并将检测到的信号传输给控制计算机;控制计算机将其接收到的环境信息传感器输出的环境信息和双目视觉传感器输出的救援机器人前方的道路环境图像通过无线通信模块传输给远程监控计算机;

步骤二、数据分析处理,具体过程为:

步骤、控制计算机对其接收到的超声波传感器输出的信号进行分析处理,判断出救援机器人行走环境中的前方是否有障碍物,并对其接收到的激光雷达传感器输出的信号进行分析处理,判断出救援机器与前方障碍物的距离;

步骤、控制计算机对其接收到的左红外传感器输出的信号进行分析处理,判断出救援机器人行走环境中的左侧是否有障碍物;

步骤、控制计算机对其接收到的右红外传感器输出的信号进行分析处理,判断出救援机器人行走环境中的右侧是否有障碍物;

步骤、控制计算机对其接收到的三维数字罗盘输出的救援机器人的姿态信号进行分析处理,判断出救援机器人行走环境为平坦路面、上斜坡还是下斜坡;

步骤三、机器人运动控制:控制计算机根据步骤二中的数据分析处理结果,判断出救援机器人行走环境为平坦路面、上斜坡还是下斜坡,并判断出救援机器人行走环境中是否有障碍物及障碍物的方位,根据行走环境不同输出对左行走电机、右行走电机、左前摆臂电机、左后摆臂电机、右前摆臂电机和右后摆臂电机的控制信号,控制救援机器人行走;

当救援机器人行走环境为平坦路面时,所述控制计算机通过左行走电机驱动器驱动左行走电机,并通过右行走电机驱动器驱动右行走电机,使左行走电机和右行走电机的转速相等,进行直线行驶;

当救援机器人行走环境为上斜坡时,所述控制计算机通过左行走电机驱动器驱动左行走电机,通过右行走电机驱动器驱动右行走电机,通过左后摆臂电机驱动器驱动左后摆臂电机,并通过右后摆臂电机驱动器驱动右后摆臂电机,使左行走履带组件中的主动行走轮和右行走履带组件中的主动行走轮均接触地面,同时使左后摆臂履带组件和右后摆臂履带组件均支起接触地面,使救援机器人机身水平,左行走电机的转速等于右行走电机的转速,进行直线行驶;

当救援机器人行走环境为下斜坡时,所述控制计算机通过左前摆臂电机驱动器驱动左前摆臂电机,并通过右前摆臂电机驱动器驱动右前摆臂电机,使左前摆臂履带组件和右前摆臂履带组件支起接触地面,同时使左行走履带组件中的主动行走轮和右行走履带组件中的主动行走轮均离开地面,使左行走履带组件中的从动行走轮和右行走履带组件中的从动行走轮均接触地面,使救援机器人机身水平,左行走电机的转速等于右行走电机的转速,进行直线行驶;

当救援机器人行走环境中前方有障碍物、右侧有障碍物或前方与右侧均有障碍物时,所述控制计算机通过左行走电机驱动器驱动左行走电机,并通过右行走电机驱动器驱动右行走电机,先使右行走电机的转速大于左行走电机的转速,进行左拐弯行驶,再使左行走电机的转速大于右行走电机的转速,进行右拐弯行驶,使行驶路线呈半圆弧,绕过前方障碍物,最后再使左行走电机和右行走电机的转速相等,进行直线行驶;

当救援机器人行走环境中左侧有障碍物或前方与左侧均有障碍物时,所述控制计算机通过左行走电机驱动器驱动左行走电机,并通过右行走电机驱动器驱动右行走电机,先使左行走电机的转速大于右行走电机的转速,进行右拐弯行驶,再使右行走电机的转速大于左行走电机的转速,进行左拐弯行驶,使行驶路线呈半圆弧,绕过左侧障碍物,最后再使左行走电机和右行走电机的转速相等,进行直线行驶;

当救援机器人行走环境中左侧与右侧均有障碍物时,所述控制计算机通过左行走电机驱动器驱动左行走电机,并通过右行走电机驱动器驱动右行走电机,使左行走电机和右行走电机的转速相等,进行直线行驶;

当救援机器人行走环境中前方、左侧与右侧均有障碍物时,所述控制计算机先通过左前摆臂电机驱动器驱动左前摆臂电机,通过左后摆臂电机驱动器驱动左后摆臂电机,通过右前摆臂电机驱动器驱动右前摆臂电机,并通过右后摆臂电机驱动器驱动右后摆臂电机,使救援机器人的左前摆臂履带组件、左后摆臂履带组件、右前摆臂履带组件和右后摆臂履带组件均转动,竖直支撑在地面上,所述控制计算机再通过左行走电机驱动器驱动左行走电机,并通过右行走电机驱动器驱动右行走电机,使左行走电机和右行走电机的转速相等,进行直线行驶,越过障碍物,最后再使救援机器人的左前摆臂履带组件、左后摆臂履带组件、右前摆臂履带组件和右后摆臂履带组件放平,使左行走电机和右行走电机的转速相等,进行直线行驶。

本发明与现有技术相比具有以下优点:

1、本发明六履带四摆臂救援机器人的结构紧凑,设计新颖合理,实现方便。

2、本发明六履带四摆臂救援机器人的四个摆臂履带组件包含有四个独立的驱动电机,四个摆臂履带组件能够实现独立360°旋转运动,实现机体的多姿态变化,同时机器人的四个摆臂履带组件能够单独拆解,方便了机器人的安装及调试。

3、本发明的两个行走履带组件包含有两个独立的驱动电机,机器人的前进、倒退及转向运动能够通过控制两电机的速度来实现,机器人的转向运动中,机器人以不同的速度差行驶时,可实现不同转向半径的运动,当机器人两个行走履带组件速度大小相等,方向相反时,机器人能够实现零半径转向运动。

4、本发明的六履带四摆臂救援机器人包含有多种环境传感器,如三维数字罗盘,激光传感器,红外传感器,双目视觉传感器等,能够全面感知机器人运行环境,实现自动避障。

5、本发明六履带四摆臂救援机器人的智能化程度高,工作稳定性和可靠性高。

6、本发明六履带四摆臂救援机器人的自主行走控制方法的方法步骤简单,设计新颖合理,实现方便,能够实现自动避障。

7、本发明的实用性强,使用效果好,便于推广使用。

综上所述,本发明的结构紧凑,设计新颖合理,智能化程度高,工作稳定性和可靠性高,实用性强,使用效果好,便于推广使用。

下面通过附图和实施例,对本发明的技术方案做进一步的详细描述。

附图说明

图1为本发明救援机器人的立体图。

图2为本发明救援机器人上箱腔体剖开后的俯视图。

图3为本发明救援机器人下箱腔体剖开后的俯视图。

图4为本发明左前摆臂履带组件、右前摆臂履带组件、左后摆臂履带组件或右后摆臂履带组件的结构示意图。

图5为图4的A-A剖视放大图。

图6为本发明主动行走轮、摆臂套筒轴和摆臂轴的连接关系示意图。

图7为本发明左支撑轮腔体的内部结构示意图。

图8为图7的仰视图。

图9为本发明右支撑轮腔体的内部结构示意图。

图10为图9的仰视图。

图11为本发明控制计算机与其他各单元的连接关系示意图。

附图标记说明:

1—左前摆臂履带组件; 2—左支撑轮腔体; 3—左后摆臂履带组件;

4—左行走履带组件; 5—天线; 6—右后摆臂履带组件;

7—右行走履带组件; 8—上箱腔体; 9—传感器腔体;

10—右前摆臂履带组件; 11—摆臂电机锥齿轮;

12—摆臂轴锥齿轮; 13—行走电机锥齿轮; 14—主动行走轮;

15—行走轮锥齿轮; 16—从动行走轮; 17—下箱腔体;

18—左行走电机; 19—左前摆臂电机; 20—三维数字罗盘;

21—电池; 22—电机驱动器组;22-1—右行走电机驱动器;

22-2—左行走电机驱动器; 22-3—右前摆臂电机驱动器;

22-4—右后摆臂电机驱动器; 22-5—左前摆臂电机驱动器;

22-6—左后摆臂电机驱动器; 23—控制计算机;

24—变压器; 25—远程监控计算机; 26—无线通信模块;

27—环境信息传感器; 27-1—温度传感器;27-2—氧气传感器;

27-3—甲烷传感器; 27-4—一氧化碳传感器;

28—双目视觉传感器; 29—激光雷达传感器;

30—照明灯; 31—摆臂轴; 32—摆臂支架;

33—摆臂前轮; 34—摆臂驱动轮;35—摆臂上支撑轮;

36—摆臂下支撑轮; 37—摆臂橡胶履带; 38—轴承;

39—摆臂套筒轴; 40—行走橡胶履带; 41—右行走电机;

42—右减震支架; 43—右减震轮固定板; 44—右减震轮旋转轴;

45—右减震轮连接板; 46—右减震轮; 47—右减震护板;

48—右减震支撑轮组; 49—左减震支架; 50—左减震轮固定板;

51—左减震轮旋转轴; 52—左减震轮连接板; 53—左减震轮;

54—左减震护板;55—左减震支撑轮组;56—右前摆臂电机;

57—右后摆臂电机;58—左后摆臂电机; 59—超声波传感器;

60—右支撑轮腔体; 61—右红外传感器;62—左红外传感器;

63—前齿轮腔体; 64—左后齿轮腔体;65—右后齿轮腔体。

具体实施方式

如图1、图2和图3所示,本发明的六履带四摆臂救援机器人,包括机器人本体、两个行走履带组件和四个摆臂履带组件,所述机器人本体包括下箱腔体17、上箱腔体8、传感器腔体9、三个齿轮腔体和两个支撑轮腔体,所述上箱腔体8设置在下箱腔体17的上部,所述传感器腔体9设置在上箱腔体8的上部前侧,三个所述齿轮腔体分别为前齿轮腔体63、左后齿轮腔体64和右后齿轮腔体65,所述前齿轮腔体63设置在下箱腔体17的前侧,所述左后齿轮腔体64设置在下箱腔体17的后方左侧,所述右后齿轮腔体65设置在下箱腔体17的后方右侧,两个所述支撑轮腔体分别为左支撑轮腔体2和右支撑轮腔体60,所述左支撑轮腔体2设置在下箱腔体17的左侧,所述右支撑轮腔体60设置在下箱腔体17的右侧;两个行走履带组件分别为设置在左支撑轮腔体2上的左行走履带组件4和设置在右支撑轮腔体60上的右行走履带组件7,四个摆臂履带组件分别为设置在左支撑轮腔体2前侧的左前摆臂履带组件1、设置在左支撑轮腔体2后侧的左后摆臂履带组件3、设置在右支撑轮腔体60前侧的右前摆臂履带组件10和设置在右支撑轮腔体60后侧的右后摆臂履带组件6;

所述下箱腔体17内设置有用于驱动左行走履带组件4的左行走电机18和用于驱动右行走履带组件7的右行走电机41;以及用于驱动左前摆臂履带组件1的左前摆臂电机19、用于驱动左后摆臂履带组件3的左后摆臂电机58、用于驱动右前摆臂履带组件10的右前摆臂电机56和用于驱动右后摆臂履带组件6的右后摆臂电机57;所述下箱腔体17的外部前侧设置有用于对救援机器人前方的障碍物进行检测的超声波传感器59;

所述上箱腔体8内设置有控制计算机23、电池21、变压器24、电机驱动器组22和三维数字罗盘20;结合图11,所述电机驱动器组22包括左行走电机驱动器22-2、右行走电机驱动器22-1、左前摆臂电机驱动器22-5、右前摆臂电机驱动器22-3、左后摆臂电机驱动器22-6和右后摆臂电机驱动器22-4,所述左行走电机驱动器22-2、右行走电机驱动器22-1、左前摆臂电机驱动器22-5、右前摆臂电机驱动器22-3、左后摆臂电机驱动器22-6和右后摆臂电机驱动器22-4均与控制计算机23的输出端连接,所述左行走电机18与左行走电机驱动器22-2的输出端连接,所述右行走电机41与右行走电机驱动器22-1的输出端连接,所述左前摆臂电机19与左前摆臂电机驱动器22-5的输出端连接,所述右前摆臂电机56与右前摆臂电机驱动器22-3的输出端连接,所述左后摆臂电机58与左后摆臂电机驱动器22-6的输出端连接,所述右后摆臂电机57与右后摆臂电机驱动器22-4的输出端连接;所述超声波传感器59与控制计算机23的输入端连接;所述控制计算机23上接有用于与远程监控计算机25进行无线连接并通信的无线通信模块26,所述无线通信模块26上接有伸出上箱腔体8外部的天线5;

所述传感器腔体9内设置有环境信息传感器27、双目视觉传感器28、激光雷达传感器29和照明灯30;所述环境信息传感器27的输出端、双目视觉传感器28的输出端和激光雷达传感器29的输出端均与控制计算机23的输入端连接;使用时,所述双目视觉传感器28和激光雷达传感器29用于检测机器人前方障碍物信息。

所述前齿轮腔体63内设置有用于将左前摆臂电机19的动力传递给左前摆臂履带组件1的左前摆臂齿轮传动组件、用于将右前摆臂电机56的动力传递给右前摆臂履带组件10的右前摆臂齿轮传动组件、用于将左行走电机18的动力传递给左行走履带组件4的左行走齿轮传动组件和用于将右行走电机41的动力传递给右行走履带组件7的右行走齿轮传动组件;所述左后齿轮腔体64内设置有用于将左后摆臂电机58的动力传递给左后摆臂履带组件3的左后摆臂齿轮传动组件,所述右后齿轮腔体65内设置有用于将右后摆臂电机58的动力传递给右后摆臂履带组件3的右后摆臂齿轮传动组件;

所述左支撑轮腔体2内设置有左减震支架49和安装在左减震支架49上的左减震支撑轮组件,所述左支撑轮腔体外部设置有用于对救援机器人左侧的障碍物进行检测的左红外传感器62;所述右支撑轮腔体60内设置有右减震支架42和安装在右减震支架42上的右减震支撑轮组件,所述右支撑轮腔体60外部设置有用于对救援机器人右侧的障碍物进行检测的右红外传感器61;所述左红外传感器62和右红外传感器61均与控制计算机23的输入端连接。所述左支撑轮腔体2和右支撑轮腔体60为单独可拆解结构。

本实施例中,如图11所示,所述环境信息传感器27包括温度传感器27-1、氧气传感器27-2、甲烷传感器27-3和一氧化碳传感器27-4。

本实施例中,如图4和图5所示,所述左前摆臂履带组件1、右前摆臂履带组件10、左后摆臂履带组件3和右后摆臂履带组件6的结构相同且均包括摆臂轴31、摆臂支架32以及转动连接在摆臂支架32前端的摆臂前轮33和转动连接在摆臂支架32后端的摆臂驱动轮34,所述摆臂轴31通过花键与摆臂支架32连接,所述摆臂支架32的中部转动连接有上下相对设置的摆臂上支撑轮35和摆臂下支撑轮36,所述摆臂前轮33的直径小于摆臂驱动轮34的直径,所述摆臂前轮33、摆臂上支撑轮35、摆臂驱动轮34和摆臂下支撑轮36上跨接有摆臂橡胶履带37,所述摆臂轴31上通过轴承38转动连接有摆臂套筒轴39,所述摆臂驱动轮34固定连接在摆臂套筒轴39上。具体实施时,所述摆臂驱动轮34通过平键固定连接在摆臂套筒轴39上。

所述左前摆臂履带组件1、右前摆臂履带组件10、左后摆臂履带组件3和右后摆臂履带组件6均采用了同心轴的传动方式,此方式在传动中,摆臂套筒轴39与摆臂轴31能够实现独立的旋转运动,互不干涉运动,简化了机器人传动所需空间。所述左前摆臂履带组件1、右前摆臂履带组件10、左后摆臂履带组件3和右后摆臂履带组件6能够单独拆解,方便救援机器人的安装及调试。

本实施例中,如图2和图3所示,所述左前摆臂齿轮传动组件、右前摆臂齿轮传动组件、左后摆臂齿轮传动组件和右后摆臂齿轮传动组件的结构相同且均包括摆臂电机锥齿轮11和与摆臂电机锥齿轮11啮合的摆臂轴锥齿轮12,所述摆臂电机锥齿轮11固定连接在左前摆臂电机19、右前摆臂电机56、左后摆臂电机58或右后摆臂电机57的输出轴上,所述摆臂轴锥齿轮12与摆臂轴31固定连接。

本实施例中,如图2、图3和图6所示,所述左行走履带组件4和右行走履带组件7的结构相同且均包括主动行走轮14和从动行走轮16,以及跨接在所述主动行走轮14和所述从动行走轮16上的行走橡胶履带40,所述右行走履带组件7中的主动行走轮14固定连接在右前摆臂履带组件10中的摆臂套筒轴39上,所述右行走履带组件7中的从动行走轮16固定连接在右后摆臂履带组件6中的摆臂套筒轴39上,所述左行走履带组件4中的主动行走轮14固定连接在左前摆臂履带组件1中的摆臂套筒轴39上,所述左行走履带组件4中的从动行走轮16固定连接在左后摆臂履带组件3中的摆臂套筒轴39上。具体实施时,所述左行走履带组件4中的主动行走轮14和从动行走轮16分别设置在左支撑轮腔体的前后两侧,所述右行走履带组件7中的主动行走轮14和从动行走轮16分别设置在右支撑轮腔体60的前后两侧。

本实施例中,如图2和图3所示,所述左行走齿轮传动组件和右行走齿轮传动组件的结构相同且均包括行走电机锥齿轮13和与行走电机锥齿轮13啮合的行走轮锥齿轮15,所述行走电机锥齿轮13固定连接在左行走电机18或右行走电机41的输出轴上,所述行走轮锥齿轮15与摆臂套筒轴39固定连接。

使用时,所述左前摆臂履带组件1、右前摆臂履带组件10、左后摆臂履带组件3和右后摆臂履带组件6能够实现独立360°旋转运动,所述左前摆臂电机19、右前摆臂电机56、左后摆臂电机58或右后摆臂电机57的旋转运动通过摆臂电机锥齿轮11和摆臂轴锥齿轮12传递到摆臂轴31上,然后通过摆臂轴31的花键把摆臂轴31的旋转运动传递到摆臂支架32上,实现左前摆臂齿轮传动组件、右前摆臂齿轮传动组件、左后摆臂齿轮传动组件或右前摆臂齿轮传动组件的旋转运动。所述左行走电机18或右行走电机41的旋转运动通过行走电机锥齿轮13传递到摆臂套筒轴39上,再传递给主动行走轮14和摆臂驱动轮34,行走橡胶履带40把主动行走轮14的旋转运动传递给从动行走轮16,实现左行走履带组件4和右行走履带组件7的行走运动,完成机器人的行走运动;摆臂橡胶履带37把摆臂驱动轮34的旋转运动传递给摆臂前轮33,摆臂上支撑轮35和摆臂下支撑轮36能够调节摆臂橡胶履带37的张紧及支撑作用。

本实施例中,如图7和图8所示,所述左减震支撑轮组件包括三个左减震支撑轮组55,每个所述左减震支撑轮组55均包括与左减震支架49固定连接的左减震轮固定板50和与左减震轮固定板50通过左减震轮旋转轴51转动连接的左减震轮连接板52,所述左减震轮连接板52的两端各转动连接有一个左减震轮53,三个所述左减震支撑轮组55中的其中两个设置在左减震支架49的下部,三个所述左减震支撑轮组55中的另外一个设置在左减震支架49的上部,所述左减震支架49上固定连接有罩住三个左减震支撑轮组55的左减震护板54。使用时,两个左减震轮53通过左减震轮旋转轴51进行旋转,调整角度,机器人在遇到较低障碍时,两个左减震轮53能够自行调整旋转角度,以辅助机器人平滑越障障碍。

本实施例中,如图9和图10所示,所述右减震支撑轮组件包括三个右减震支撑轮组48,每个所述右减震支撑轮组48均包括与右减震支架42固定连接的右减震轮固定板43和与右减震轮固定板43通过右减震轮旋转轴44转动连接的右减震轮连接板45,所述右减震轮连接板45的两端各转动连接有一个右减震轮46,三个所述右减震支撑轮组48中的其中两个设置在右减震支架42的下部,三个所述右减震支撑轮组48中的另外一个设置在右减震支架42的上部,所述右减震支架42上固定连接有罩住三个右减震支撑轮组48的右减震护板47。使用时,两个右减震轮46通过右减震轮旋转轴44进行旋转,调整角度,机器人在遇到较低障碍时,两个右减震轮46能够自行调整旋转角度,以辅助机器人平滑越障障碍。

本发明的六履带四摆臂救援机器人的自主行走控制方法,包括以下步骤:

步骤一、数据采集及传输:环境信息传感器27对救援机器人所处环境信息进行检测并将检测到的信号传输给控制计算机23,双目视觉传感器28对救援机器人前方的道路环境图像进行检测并将检测到的信号传输给控制计算机23,激光雷达传感器29对救援机器人与前方障碍物的距离进行检测并将检测到的信号传输给控制计算机23,左红外传感器62对救援机器人左侧的障碍物进行检测并将检测到的信号传输给控制计算机23,右红外传感器61对救援机器人右侧的障碍物进行检测并将检测到的信号传输给控制计算机23,超声波传感器59用于对救援机器人前方的障碍物进行检测并将检测到的信号传输给控制计算机23,三维数字罗盘20对救援机器人的姿态进行检测并将检测到的信号传输给控制计算机23;控制计算机23将其接收到的环境信息传感器27输出的环境信息和双目视觉传感器28输出的救援机器人前方的道路环境图像通过无线通信模块26传输给远程监控计算机25;

步骤二、数据分析处理,具体过程为:

步骤201、控制计算机23对其接收到的超声波传感器59输出的信号进行分析处理,判断出救援机器人行走环境中的前方是否有障碍物,并对其接收到的激光雷达传感器29输出的信号进行分析处理,判断出救援机器与前方障碍物的距离;

步骤202、控制计算机23对其接收到的左红外传感器62输出的信号进行分析处理,判断出救援机器人行走环境中的左侧是否有障碍物;

步骤203、控制计算机23对其接收到的右红外传感器61输出的信号进行分析处理,判断出救援机器人行走环境中的右侧是否有障碍物;

步骤204、控制计算机23对其接收到的三维数字罗盘20输出的救援机器人的姿态信号进行分析处理,判断出救援机器人行走环境为平坦路面、上斜坡还是下斜坡;

步骤三、机器人运动控制:控制计算机23根据步骤二中的数据分析处理结果,判断出救援机器人行走环境为平坦路面、上斜坡还是下斜坡,并判断出救援机器人行走环境中是否有障碍物及障碍物的方位,根据行走环境不同输出对左行走电机18、右行走电机41、左前摆臂电机19、左后摆臂电机58、右前摆臂电机56和右后摆臂电机57的控制信号,控制救援机器人行走;

当救援机器人行走环境为平坦路面时,所述控制计算机23通过左行走电机驱动器22-2驱动左行走电机18,并通过右行走电机驱动器22-1驱动右行走电机41,使左行走电机18和右行走电机41的转速相等,进行直线行驶;

当救援机器人行走环境为上斜坡时,所述控制计算机23通过左行走电机驱动器22-2驱动左行走电机18,通过右行走电机驱动器22-1驱动右行走电机41,通过左后摆臂电机驱动器22-6驱动左后摆臂电机58,并通过右后摆臂电机驱动器22-4驱动右后摆臂电机57,使左行走履带组件4中的主动行走轮14和右行走履带组件7中的主动行走轮14均接触地面,同时使左后摆臂履带组件3和右后摆臂履带组件6均支起接触地面,使救援机器人机身水平,左行走电机18的转速等于右行走电机41的转速,进行直线行驶;

当救援机器人行走环境为下斜坡时,所述控制计算机23通过左前摆臂电机驱动器22-5驱动左前摆臂电机19,并通过右前摆臂电机驱动器22-3驱动右前摆臂电机56,使左前摆臂履带组件1和右前摆臂履带组件10支起接触地面,同时使左行走履带组件4中的主动行走轮14和右行走履带组件7中的主动行走轮14均离开地面,使左行走履带组件4中的从动行走轮16和右行走履带组件7中的从动行走轮16均接触地面,使救援机器人机身水平,左行走电机18的转速等于右行走电机41的转速,进行直线行驶;

当救援机器人行走环境中前方有障碍物、右侧有障碍物或前方与右侧均有障碍物时,所述控制计算机23通过左行走电机驱动器22-2驱动左行走电机18,并通过右行走电机驱动器22-1驱动右行走电机41,先使右行走电机41的转速大于左行走电机18的转速,进行左拐弯行驶,再使左行走电机18的转速大于右行走电机41的转速,进行右拐弯行驶,使行驶路线呈半圆弧,绕过前方障碍物,最后再使左行走电机18和右行走电机41的转速相等,进行直线行驶;

当救援机器人行走环境中左侧有障碍物或前方与左侧均有障碍物时,所述控制计算机23通过左行走电机驱动器22-2驱动左行走电机18,并通过右行走电机驱动器22-1驱动右行走电机41,先使左行走电机18的转速大于右行走电机41的转速,进行右拐弯行驶,再使右行走电机41的转速大于左行走电机18的转速,进行左拐弯行驶,使行驶路线呈半圆弧,绕过左侧障碍物,最后再使左行走电机18和右行走电机41的转速相等,进行直线行驶;

当救援机器人行走环境中左侧与右侧均有障碍物时,所述控制计算机23通过左行走电机驱动器22-2驱动左行走电机18,并通过右行走电机驱动器22-1驱动右行走电机41,使左行走电机18和右行走电机41的转速相等,进行直线行驶;

当救援机器人行走环境中前方、左侧与右侧均有障碍物时,所述控制计算机23先通过左前摆臂电机驱动器22-5驱动左前摆臂电机19,通过左后摆臂电机驱动器22-6驱动左后摆臂电机58,通过右前摆臂电机驱动器22-3驱动右前摆臂电机56,并通过右后摆臂电机驱动器22-4驱动右后摆臂电机57,使救援机器人的左前摆臂履带组件1、左后摆臂履带组件3、右前摆臂履带组件10和右后摆臂履带组件6均转动,竖直支撑在地面上,所述控制计算机23再通过左行走电机驱动器22-2驱动左行走电机18,并通过右行走电机驱动器22-1驱动右行走电机41,使左行走电机18和右行走电机41的转速相等,进行直线行驶,越过障碍物,最后再使救援机器人的左前摆臂履带组件1、左后摆臂履带组件3、右前摆臂履带组件10和右后摆臂履带组件6放平,使左行走电机18和右行走电机41的转速相等,进行直线行驶。

以上所述,仅是本发明的较佳实施例,并非对本发明作任何限制,凡是根据本发明技术实质对以上实施例所作的任何简单修改、变更以及等效结构变化,均仍属于本发明技术方案的保护范围内。

当前第1页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1