一种机器人爬坡的驱动力控制装置制造方法及图纸

本发明专利技术公开了一种机器人爬坡的驱动力控制装置，具体涉及机器人领域，包括牵引头，所述牵引头一侧活动连接有箱体，所述牵引头底部设有牵引轮，所述箱体底部设有主动轮和从动轮，所述主动轮和从动轮外侧均固定连接有定齿轮，所述主动轮远离定齿轮的一侧设有驱动电机，所述驱动电机输出轴传动连接主动轮。本发明专利技术通过光电传感器感测地面坡度，当坡度达到设定值时，电动推杆推动爬坡机构下降，履带接触地面，增大摩擦力，定齿轮与第一齿条环啮合，使主动轮传动动轮盘，方便履带运动，爬坡时单片机控制变频调速器，限制驱动电机转速，降低机器人速度，防止机器人倾倒，减少装置磨损，平整路段时，主动轮和从动轮牵引箱体，提高机器人运行速度。

A Driving Force Control Device for Robot Climbing

The invention discloses a driving force control device for robot climbing, which specifically relates to the field of robots, including a traction head. One side of the traction head is movably connected with a box body. The bottom of the traction head is equipped with a traction wheel. The bottom of the box body is equipped with a driving wheel and a driven wheel. The outside of the driving wheel and the driven wheel are fixedly connected with a fixed gear, and the driving wheel is far from the side of the fixed gear. A driving motor is provided, and the output shaft of the driving motor drives to connect the driving wheel. The invention detects the gradient of the ground by photoelectric sensor. When the gradient reaches the set value, the electric push rod drives the climbing mechanism to descend, the crawler contacts the ground, enhances the friction force, the fixed gear meshes with the first rack ring, so that the driving wheel drives the wheel, facilitates the crawler movement, the single chip computer controls the frequency converter when climbing, limits the speed of the driving motor, reduces the speed of the robot and prevents the machine. The robot tips over, reduces the wear and tear of the device, and when leveling the road section, the driving and driven wheels pull the box body to improve the running speed of the robot.

【技术实现步骤摘要】
一种机器人爬坡的驱动力控制装置
本专利技术涉及机器人领域，更具体地说，本专利技术涉及一种机器人爬坡的驱动力控制装置。
技术介绍
机器人在日常的生产生活中得到更广泛的应用，在工业、医疗、服务等领域发挥着重要作用。在机器人行走过程中，爬坡必不可少，机器人在进行爬坡时，由于坡度变化，导致机器人自身的倾斜角度随之发生变化。专利申请公布号CN108860364A的中国专利公开了一种基于抗倾倒的爬坡运输机器人，包括主处理控制器和角度传感器，第一支撑结构与第二支撑结构之间设有第一固定结构；第一固定结构的一侧固定连接有第一伸缩装置，第一固定结构的另一侧固定连接有第二伸缩装置；第一固定结构上固定连接有第二固定结构；第二固定结构上装设有驱动轮结构。本专利技术通过在机器人本体上设置角度传感器来监测机器人所行走的坡面角度，在机器人爬坡时，伸缩装置对伸缩机构进行驱动伸缩，从而带动行走轮进行位置调节，有效防止爬坡机器人发生倾倒；通过在第一固定结构上设置动力装置，在第二固定结构上设置驱动轮，提升了机器人爬坡时的稳固性。但是上述技术方案中提供的一种基于抗倾倒的爬坡运输机器人在实际运用时，仍旧存在较多缺点，如行走轮抓地不牢，与地面摩擦力小，容易发生滑动，影响爬坡，没有爬坡时的速度控制，不利于机器人工作的稳定性。
技术实现思路
为了克服现有技术的上述缺陷，本专利技术的实施例提供一种机器人爬坡的驱动力控制装置，通过光电传感器感测牵引头与地面的倾角，判断坡度，当坡度达到设定坡度时，电动推杆推动提升架使爬坡机构下降，履带与地面接触，增大摩擦力，定齿轮与第一齿条环啮合，从而使主动轮传动动轮盘，方便履带运动，爬坡时单片机控制变频调速器，限制驱动电机转速，从而降低机器人速度，防止机器人倾倒，减少装置磨损，平整路段时，主动轮和从动轮牵引箱体，提高机器人运行速度。为实现上述目的，本专利技术提供如下技术方案：一种机器人爬坡的驱动力控制装置，包括牵引头，所述牵引头一侧活动连接有箱体，所述牵引头底部设有牵引轮，所述箱体底部设有主动轮和从动轮，所述主动轮和从动轮外侧均固定连接有定齿轮，所述主动轮远离定齿轮的一侧设有驱动电机，所述驱动电机输出轴传动连接主动轮，所述箱体两侧均设有爬坡机构，所述爬坡机构包括两个水平设置的固定三角架，两个所述固定三角架之间固定连接有提升架，所述箱体两侧均固定连接有电动推杆，所述电动推杆输出端与提升架固定连接，所述固定三角架顶端设有动轮盘，所述固定三角架底部两端均设有动撑轮，所述动轮盘和两个动撑轮外侧之间连接有履带，所述动轮盘中部设有凹形环槽，所述凹形环槽外侧设有第一齿条环，所述动轮盘外侧设有第二齿条环，所述牵引头内部设有电源模块、感知系统和控制系统，所述箱体内部设有执行系统，所述感知系统、控制系统和执行系统均与电源模块电性连接，所述感知系统、控制系统和执行系统分别用于机器人实时路况采集、智能判断及决策和运行调整；所述感知系统包括感知电路，所述牵引头远离箱体的一侧底部设有超声波传感器，所述超声波传感器顶部设有光电传感器，所述光电传感器两侧均设有摄像头，所述超声波传感器、光电传感器和摄像头均与感知电路电性连接；所述控制系统包括控制电路，所述控制电路连接端设有单片机和编程器，所述单片机内部设有计时单元，所述计时单元用于计算牵引头倾斜超过设定角时间，所述编程器用于人工输入设定程序和输出编程命令；所述执行系统包括控制电路，所述控制电路连接端设有调速机构和避障机构，所述爬坡机构与控制电路电性连接，所述调速机构包括变频调速器，所述变频调速器与驱动电机电性连接。在一个优选地实施方式中，所述避障机构包括转向电机和转向轴，所述转向电机输出轴传动连接转向轴，所述转向轴与牵引头一体化设置，所述转向轴与箱体转动连接。在一个优选地实施方式中，所述箱体两侧均固定连接有固定块，所述固定块底部固定连接有限位杆，所述限位杆外侧套设有减震弹簧，所述限位杆贯穿提升架，所述减震弹簧设置在固定块与提升架之间。在一个优选地实施方式中，所述电动推杆的数量设置为两个，两个所述电动推杆对称分布在提升架两端，所述电动推杆一侧设有滑槽，所述提升架靠近箱体的一侧设有滑块，所述滑槽与滑块相匹配。在一个优选地实施方式中，所述光电传感器设置在牵引头的垂直平分线上，两个所述摄像头对称分布在光电传感器两侧，所述驱动电机设置为无刷电机。在一个优选地实施方式中，所述定齿轮与凹形环槽相匹配，所述定齿轮与第一齿条环相啮合，所述动撑轮外侧设有第二齿条环，所述第二齿条环与履带内侧啮合连接。在一个优选地实施方式中，所述单片机输入端设有A/D转换器，所述单片机输出端设有D/A转换器，所述超声波传感器、光电传感器和摄像头均与A/D转换器电性连接，所述电动推杆、变频调速器和转向电机均与D/A转换器电性连接。本专利技术的技术效果和优点：1、通过光电传感器感测牵引头与地面的倾角，判断坡度，当坡度达到设定坡度时，电动推杆推动提升架使爬坡机构下降，履带与地面接触，增大摩擦力，定齿轮与第一齿条环啮合，从而使主动轮传动动轮盘，方便履带运动，爬坡时单片机控制变频调速器，限制驱动电机转速，从而降低机器人速度，防止机器人倾倒，减少装置磨损，平整路段时，主动轮和从动轮牵引箱体，提高机器人运行速度；2、通过超声波传感器感测牵引头前方路况，并使用摄像头拍摄实时图像，将路况信息发送给单片机，当牵引头前方出现障碍物，单片机根据实时图像和超声波传感器感测障碍距离分析避障路线，单片机控制转向电机工作，转向电机输出轴传动连接转向轴使牵引头调整角度，避开障碍物，保证机器人正常运行；3、通过两个摄像头对称分布在超声波传感器两侧，方便观察前方路况，扩大视角，减少盲区，有利于提高机器人的控制精度，计时模块头计算牵引头过角时间，配合摄像头观测爬坡长度，避免小坡对机器人的干扰，限位杆贯穿提升架并配合减震弹簧，有利于保证爬坡机构升降稳定性，同时缓冲减震，延长装置使用寿命。附图说明图1为本专利技术的整体结构示意图。图2为本专利技术的整体俯视图。图3为本专利技术定齿轮与动轮盘的连接结构示意图。图4为本专利技术图1的A部结构放大图。图5为本专利技术的系统机构框图。图6为本专利技术的控制系统结构示意图附图标记为：1牵引头、2箱体、3牵引轮、4主动轮、5从动轮、6定齿轮、7驱动电机、8固定三角架、9提升架、10电动推杆、11动轮盘、12动撑轮、13履带、14凹形环槽、15电源模块、16感知系统、17控制系统、18执行系统、19超声波传感器、20光电传感器、21摄像头、22单片机、23编程器、24变频调速器、25转向电机、26转向轴、27限位杆、28减震弹簧、29滑槽。具体实施方式下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。实施例1：根据图1-6所示的一种机器人爬坡的驱动力控制装置，包括牵引头1，所述牵引头1一侧活动连接有箱体2，所述牵引头1底部设有牵引轮3，所述箱体2底部设有主动轮4和从动轮5，所述主动轮4和从动轮5外侧均固定连接有定齿轮6，所述主动轮4远离定齿轮6的一侧设有驱动电机7，所述驱动电机7输本文档来自技高网...

【技术保护点】
1.一种机器人爬坡的驱动力控制装置，包括牵引头(1)，其特征在于：所述牵引头(1)一侧活动连接有箱体(2)，所述牵引头(1)底部设有牵引轮(3)，所述箱体(2)底部设有主动轮(4)和从动轮(5)，所述主动轮(4)和从动轮(5)外侧均固定连接有定齿轮(6)，所述主动轮(4)远离定齿轮(6)的一侧设有驱动电机(7)，所述驱动电机(7)输出轴传动连接主动轮(4)，所述箱体(2)两侧均设有爬坡机构，所述爬坡机构包括两个水平设置的固定三角架(8)，两个所述固定三角架(8)之间固定连接有提升架(9)，所述箱体(2)两侧均固定连接有电动推杆(10)，所述电动推杆(10)输出端与提升架(9)固定连接，所述固定三角架(8)顶端设有动轮盘(11)，所述固定三角架(8)底部两端均设有动撑轮(12)，所述动轮盘(11)和两个动撑轮(12)外侧之间连接有履带(13)，所述动轮盘(11)中部设有凹形环槽(14)，所述凹形环槽(14)外侧设有第一齿条环，所述动轮盘(11)外侧设有第二齿条环，所述牵引头(1)内部设有电源模块(15)、感知系统(16)和控制系统(17)，所述箱体(2)内部设有执行系统(18)，所述感知系统(16)、控制系统(17)和执行系统(18)均与电源模块(15)电性连接，所述感知系统(16)、控制系统(17)和执行系统(18)分别用于机器人实时路况采集、智能判断及决策和运行调整；所述感知系统(16)包括感知电路，所述牵引头(1)远离箱体(2)的一侧底部设有超声波传感器(19)，所述超声波传感器(19)顶部设有光电传感器(20)，所述光电传感器(20)两侧均设有摄像头(21)，所述超声波传感器(19)、光电传感器(20)和摄像头(21)均与感知电路电性连接；所述控制系统(17)包括控制电路，所述控制电路连接端设有单片机(22)和编程器(23)，所述单片机(22)内部设有计时单元，所述计时单元用于计算牵引头(1)倾斜超过设定角时间，所述编程器(23)用于人工输入设定程序和输出编程命令；所述执行系统(18)包括控制电路，所述控制电路连接端设有调速机构和避障机构，所述爬坡机构与控制电路电性连接，所述调速机构包括变频调速器(24)，所述变频调速器(24)与驱动电机(7)电性连接。...

【技术特征摘要】
1.一种机器人爬坡的驱动力控制装置，包括牵引头(1)，其特征在于：所述牵引头(1)一侧活动连接有箱体(2)，所述牵引头(1)底部设有牵引轮(3)，所述箱体(2)底部设有主动轮(4)和从动轮(5)，所述主动轮(4)和从动轮(5)外侧均固定连接有定齿轮(6)，所述主动轮(4)远离定齿轮(6)的一侧设有驱动电机(7)，所述驱动电机(7)输出轴传动连接主动轮(4)，所述箱体(2)两侧均设有爬坡机构，所述爬坡机构包括两个水平设置的固定三角架(8)，两个所述固定三角架(8)之间固定连接有提升架(9)，所述箱体(2)两侧均固定连接有电动推杆(10)，所述电动推杆(10)输出端与提升架(9)固定连接，所述固定三角架(8)顶端设有动轮盘(11)，所述固定三角架(8)底部两端均设有动撑轮(12)，所述动轮盘(11)和两个动撑轮(12)外侧之间连接有履带(13)，所述动轮盘(11)中部设有凹形环槽(14)，所述凹形环槽(14)外侧设有第一齿条环，所述动轮盘(11)外侧设有第二齿条环，所述牵引头(1)内部设有电源模块(15)、感知系统(16)和控制系统(17)，所述箱体(2)内部设有执行系统(18)，所述感知系统(16)、控制系统(17)和执行系统(18)均与电源模块(15)电性连接，所述感知系统(16)、控制系统(17)和执行系统(18)分别用于机器人实时路况采集、智能判断及决策和运行调整；所述感知系统(16)包括感知电路，所述牵引头(1)远离箱体(2)的一侧底部设有超声波传感器(19)，所述超声波传感器(19)顶部设有光电传感器(20)，所述光电传感器(20)两侧均设有摄像头(21)，所述超声波传感器(19)、光电传感器(20)和摄像头(21)均与感知电路电性连接；所述控制系统(17)包括控制电路，所述控制电路连接端设有单片机(22)和编程器(23)，所述单片机(22)内部设有计时单元，所述计时单元用于计算牵引头(1)倾斜超过设定角时间，所述编程器(23)用于人工输入设定程序和输出编程命令；所述执行系统(18)包括控制电...

【专利技术属性】
技术研发人员：李庆民，李延硕，刘春晖，王杰，邵红臣，尹彦斌，
申请(专利权)人：创泽智能机器人股份有限公司，
类型：发明
国别省市：山东,37