一种多功能越障机器人的制作方法
【专利摘要】本发明公开了一种多功能越障机器人，包括车架；驱动电机，其固定在车架上；行星轮组，包括驱动行星轮组和从动行星轮组，所述驱动行星轮组对称布设在车架前端两侧，由驱动电机驱动；所述从动行星轮组对称安装在车架后端两侧，其随驱动行星轮组同步运动，其中，所述驱动行星轮组包括：内行星架、太阳齿轮、行星齿轮、中心链轮、多个行星链轮、链条和行进轮，将电机动力传输至行进轮。本发明的越障机器人能够根据不同的越障阻力，智能调节驱动电机的输出扭矩从而保证越障机器人顺利越障。
【专利说明】
-种多功能越障机器人
技术领域
[0001] 本发明设及一种越障机器人。更具体地说，本发明设及一种装配行星轮系的多功 能越障机器人。
【背景技术】
[0002] 近年来科技不断发展，人民生活水平日益提高，但是人类对自然灾害等特殊情况 的侦查、救援还存在着很多的问题。地震等自然灾害因其本身的突发性等特征难W被预测， 因此加强灾后救援力度就显得尤为重要了。目前存在的具有一定越障功能的陆上侦查、探 测类的机器人普遍采用履带传动，但履带传动效率低下，耗能高。且小型机器人上的履带式 传动受体积限制，无法翻越城市环境中广泛存在的路阶、楼梯等障碍物。使得履带式侦查机 器人在反恐侦察、灾害救援等领域应用中有许多局限性。所W目前迫切需要一种新型传动 方式的小型机器人，使其在城市环境中具有一定越障能力，且具有较高的传动效率，W及灵 活的机动性。
【发明内容】
[0003] 本发明目的是提供一种多功能越障机器人，采用电机驱动的=角行星轮组带动行 进，当遇到障碍时，行进轮由自转切换成绕=角行星轮组公转，从而顺利越障。
[0004] 本发明还有一个目的是驱动电机通过差速器带动驱动行星轮组偏转，从而实现越 障机器人的前轮转向模式。
[0005] 本发明还有一个目的是利用转向电机驱动折腰式转向单元，折腰式转向单元带动 从动行星轮组偏转，从而实现越障机器人的后轮转向模式。
[0006] 本发明还有一个目的是提供一种多功能越障机器人，通过电子调速器调整越障机 器人在平地行进或爬楼越障过程中的速度，便于运输货物。
[0007] 本发明还有一个目的是提供一种多功能越障机器人，控制系统根据不同的越障阻 力矩调整驱动电机的输出扭矩，解决行星轮组因打滑或停转导致的越障机器人越障失败。 [000引为了实现根据本发明的运些目的和其它优点，提供了一种多功能越障机器人，包 括：
[0009] 车架；
[0010] 驱动电机，其固定在车架上；
[0011] 驱动行星轮组和从动行星轮组，所述驱动行星轮组对称布设在车架前端两侧，由 驱动电机驱动;所述从动行星轮组对称安装在车架后端两侧;其中，所述行星轮组包括：
[0012] 内行星架，其包括至少二个向外延伸的支脚，并且朝向所述驱动电机的一侧上设 置太阳齿轮和行星齿轮，另一侧面上设置中屯、链轮和多个行星链轮；W及
[0013] 所述太阳齿轮，其通过第一轴可旋转固定在所述内行星架上，所述电机输出轴连 接所述太阳齿轮；
[0014] 所述行星齿轮，其通过第二轴可旋转固定在所述内行星架上，并且和所述太阳齿 轮晒合；
[0015] 所述中屯、链轮，其固定在所述第二轴上，所述中屯、链轮和所述行星齿轮共同旋转；
[0016] 所述多个行星链轮，其一一对应的可旋转的设置在所述支脚的外端；
[0017] 链条，其与所述中屯、链轮和所述多个行星链轮同时晒合；
[0018] 行进轮，其分别和所述多个行星链轮同轴固定，并且和所述多个行星链轮共同旋 转。
[0019] 优选的是，所述车架还包括转向系统，其连接在车架后部，包括转向电机和折腰式 转向单元，所述转向电机驱动折腰式转向单元相对于车架倾斜一定角度，从而实现转向；其 中，所述从动行星轮组对称安装在转向系统两侧。
[0020] 优选的是，所述驱动电机连接差速器，所述差速器输出两个动力轴连接车架两侧 的驱动行星轮组。
[0021] 优选的是，所述折腰式转向单元包括：
[0022] 导轨，其横向固定在车架上；
[0023] 滑块，其套设在导轨上并能够沿导轨滑动；
[0024] 转向齿条，其与转向电机晒合，并且固定连接滑块，所述转向齿条在转向电机驱动 下带动滑块沿导轨移动；
[0025] 连杆机构，包括纵杆、第一横杆和第二横杆，纵杆前端可旋转连接滑块，纵杆后端 分别较接在第一横杆和第二横杆的中屯、点，第一横杆和第二横杆平行设置且其两端较接转 向臂；
[0026] 所述转向臂的前端较接在车架后端；
[0027] 其中，当纵杆前端在滑块带动下沿导轨移动，其带动第一横杆和第二横杆横向移 动，从而带动转向臂与车架倾斜一定角度，实现从动行星轮组转向。
[0028] 优选的是，所述车架还包括载物台，其固定在车架上，用于承载物品。
[0029] 优选的是，还包括控制系统，其包括：
[0030] 扭矩传感器，其安装在驱动电机输出轴上，所述扭矩传感器测量驱动电机的扭矩；
[0031] 转速传感器，其分别安装在差速器的两个所述动力轴上，用于检测两个动力轴的 转速；
[0032] 信号接收发射机，其连接扭矩传感器和转速传感器，所述信号接收发射机接收扭 矩传感器和转速传感器的信号；
[0033] 控制器，其连接信号接收发射机、驱动电机和转向电机，所述控制器接收信号接收 发射机的信号并控制转向电机和驱动电机;W及
[0034] 电子调速器，其连接控制器，所述电子调速器调节驱动行星轮组的行进速度。
[0035] 优选的是，所述驱动电机为伺服电机，控制器通过信号接收发射机接收扭矩传感 器的信号，并控制驱动电机的输出扭矩。
[0036] 优选的是，所述电子调速器连接驱动电机的电源，其通过调节电源调节驱动行星 轮组的行进速度。
[0037] 优选的是，所述驱动行星轮组遇到障碍行进轮与地面打滑时，为保证驱动行星轮 组公转越障，控制器控制电机的实时扭矩r满足：
[00；3 引
[0039] 其中，0为行走轮之间夹角，k为驱动行星轮组传动比，Tl为驱动行星轮组的机械效 率;m为驱动行星轮组的质量，f为行进轮与地面的动摩擦系数，R为行星轮系的旋转半径。
[0040] 优选的是，所述驱动行星轮组遇到障碍而轮与地面没有相对运动，为驱动行星轮 组公转越障，控制器控制电机的实时扭矩r满足；
[0--'1
[0042] 其中，0为行走轮之间夹角，k为驱动行星轮组传动比，Tl为驱动行星轮组的机械效 率;m为驱动行星轮组的质量，f为行进轮与地面的动摩擦系数，R为行星轮系的旋转半径。
[0043] 本发明至少包括W下有益效果：1、其上载物台可W安装或承载各种探测设备，便 于侦查;2、可W在平地状态下助力运载货物，也可W在爬楼梯时助力运载货物;3、越障机器 人利用差速器进行转向，从动行星轮组利用折腰式转向单元配合转向，适用于狭窄或对转 弯区域。4、采用齿轮传动和链传动结合的方式使运作流程简单，操作简便，性能提高，延长 使用寿命;5、安装扭矩传感器，并将测量电机输出扭矩值传输至控制器，控制器根据不同情 况计算越障扭矩，并调节电机输出扭矩高于越障扭矩，保证越障机构顺利越障，同时减少电 机的输出功率，较少能耗。
[0044] 本发明的其它优点、目标和特征将部分通过下面的说明体现，部分还将通过对本 发明的研究和实践而为本领域的技术人员所理解。
【附图说明】
[0045] 图1是本发明的越障机器人的结构图。
[0046] 图2是本发明的越障机器人的行进系统和转向系统的连接图。
[0047] 图3是本发明的越障机器人转向示意图。
[004引图4是本发明的越障机器人的行星轮组结构图。
[0049] 图5是本发明的越障机器人的行星轮组结构图。
[0050] 图6是本发明的越障机器人的行星轮组结构图。
[0051 ]图7是本发明的越障机器人的控制系统示意图。
【具体实施方式】
[0052] 下面结合附图对本发明做进一步的详细说明，W令本领域技术人员参照说明书文 字能够据W实施。
[0053] 应当理解，本文所使用的诸如"具有"、"包含"W及"包括"术语并不配出一个或多 个其它元件或其组合的存在或添加。
[0054] 图1-3示出了根据本发明的一种实现形式，多功能助力越障机器人包括车架100、 行进系统200、转向系统300和控制系统，车架100用于承载探测设备，所述行进系统200、转 向系统300和控制系统连接车架100,行进系统200带动车架100在平地前进或在遇到障碍、 楼梯时越障，转向系统300配合行进系统200和控制系统控制进行转向。
[0055]如图2所示，车架100包括车体110和载物台120,车体110由两块相同且相互平行不 诱钢材质的纵板及两端固定在纵板上的多根横杆组成，所述车体110用于支撑和连接行进 系统200和转向系统300,载物台120固定在车体110上面，其为不诱钢板，用于承载探测设 备。
[0化6] 行进系统200包括驱动电机210、驱动行星轮组、从动行星轮组和差速器250,其中， 驱动行星轮组由驱动行星轮系230和行进轮220组成，从动行星轮组由从动行星轮系240和 行进轮220组成。驱动电机210固定在车体110的横杆上，其为可调扭矩式电机，驱动电机210 输出轴上安装扭矩传感器，其为常见的传感器，未在图中示出。所述扭矩传感器测量采用应 变片电测技术，其上粘贴应变片组成测量电桥，当输出轴受扭矩产生微小变形后引起电桥 电阻值变化，应变电桥电阻的变化转变成电信号的变化从而实现扭矩测量，从而实现测量 电机的扭矩。驱动电机210输出轴通过斜齿轮晒合差速器250,所述差速器250两端分别输出 第一动力轴251和第二动力轴252,其中，第一动力轴251和第二动力轴252上分别安装转速 传感器，转速传感器连接信号接收发射机，将第一动力轴251和第二动力轴252的转速传输 至信号接收发射机;驱动行星轮组对称安装在车架100前部左、右两侧，所述第一动力轴251 连接车架100左侧的驱动行星轮系230,第二动力轴252连接车架100右侧的驱动行星轮系 230;所述驱动行星轮系230和从动行星轮系240为相同机械组件，说明书中只对驱动行星轮 系230结构进行说明，由图4-6可见，驱动行星轮系230为变速机构，其包括太阳齿轮231、行 星齿轮232、行星齿轮盖板233、内行星架234、外行星架235、中屯、链轮236、行星链轮237、链 条238和行进轮轴239。太阳齿轮231设有中屯、通孔、其外圆周上布设有齿牙，其中，中屯、通孔 与第一动力轴251和第二动力轴252的大小向匹配，用于连接第一动力轴251或第二动力轴 252，太阳齿轮231旋转连接在内行星架234的中屯、处。行星齿轮232通过其中屯、轴旋转连接 在内行星架234上，其外圆周上布设齿牙。其中，所述太阳齿轮231和行星齿轮232通过行星 齿轮盖板233固定在在内行星架234的同侧，进一步的是，=个行星齿轮232等角度布设车等 边=角形，并与太阳齿轮231晒合，由太阳齿轮231带动=个行星齿轮232转动。中屯、链轮236 与行星齿轮232同轴屯、设置，并通过同一中屯、轴固定在内行星架234的两侧，行星齿轮232的 转动带动中屯、链轮236同步转动。由图5可见，中屯、链轮236、链条238和行星链轮237布设在 内行星架234的同一侧，进一步的是，与太阳齿轮231和行星齿轮232设置在内行星架234的 相反一侧，其中，=个行星链轮237通过行进轮轴239连接在内行星架234的=个角上，链条 238分别于中屯、链轮236和行星链轮237晒合，即中屯、链轮236通过链条238带动行星链轮237 转动，从而带动与行星链轮237固定连接的行进轮轴239旋转。由图5可见，行进轮轴239套设 在平行设置的内行星架234和外行星架235上，内行星架234和外行星架235结构相同，为不 规则=角形结构，其中，行进轮轴239在外行星架235的支出端连接行进轮220，=个行进轮 220通过行进轮轴239连接驱动行星轮系230。
[0057] 当越障机器人转弯时，驱动电机210驱动差速器250调整第一动力轴251和第二动 力轴252之间的速度差，第一动力轴251和第二动力轴252将速度差传输至左右两侧的驱动 行星轮组同侧偏转，此时，从动行星轮组不偏转，从而实现越障机器人的前轮转向模式。
[005引如图2和3所示，转向系统300包括转向电机310、转向齿条320、导轨330、连杆机构 340和转向臂350,转向电机310固定在车体110的横杆上，其输出轴晒合转向齿条320,从而 带动转向齿条320移动；转向齿条320上表面布设齿条，其下表面的中屯、处固定在滑块331 上；导轨330平行于横杆，其两端固定在车体110上，其上套设滑块331，滑块331下表面开设 滑槽，纵杆上表面设有凸台，所述凸台连接滑槽并可沿滑槽滑动，滑块331能够沿导轨 330滑动，此时，转向电机310带动转向齿条320横向移动，从而带动滑块331沿导轨330横向 移动。连杆机构340包括纵杆341、第一横杆342和第二横杆343,纵杆341前端较接滑块331， 当滑块331移动时带动纵杆341移动;第一横杆342两端点与转向臂350前端、车体110的纵板 末端通过较链连接，其中线点与纵杆341较接;第二横杆343两端点较接在转向臂350中部， 其中屯、点较接纵杆341的末端;转向臂350对称较接在车架100的末端，其上连接从动行星轮 组。
[0059] 如图3所示为越障机器人后轮转向模式，打开转向电机310,其带动转向齿条320沿 导轨330横向移动，从而带动与滑块331较接的纵杆341移动并倾斜一定角度，纵杆341带动 第一横杆342和第二横杆343横移，从而使与第一横杆342和第二横杆343较接的转向臂350 倾斜，其倾斜角度与纵杆341相同，从而带动从动行星轮组与车架100偏移一定角度，实现从 动行星轮组同侧偏转，此时驱动行星轮组不偏转，从而实现越障机器人后轮转向模式。
[0060] 如图7所示，控制系统包括控制器、电子调速器、转速传感器、扭矩传感器和信号接 收发射机，控制系统安装在车架100中部，所述控制器连接驱动电机210、电子调速器，电子 调速器具有变频器的作用，通过控制器改变电机工作电源频率来控制驱动电机的转速，从 而控制越障机器人的速度。所述控制器还连接转速传感器、信号接收发射机和转向电机 310,信号接收发射机接收第一动力轴251和第二动力轴252的转速信号，并将信号传输至控 制器，控制器比较第一动力轴251和第二动力轴252的转速，当控制器判断第一动力轴251和 第二动力轴252转速不同，控制器控制转向电机310开启，转向电机带动从动行星轮组转向。 所述扭矩传感器连接信号接收发射机，扭矩传感器将驱动电机210的输出扭矩值传输至信 号接收发射机，信号接收发射机将扭矩信号传输至控制器，控制器接收、存储扭矩传感器测 量的驱动电机210的转矩，控制器根据情况调节驱动电机240的扭矩，实现越障机器人顺利 越障。
[0061] 当越障机器人在平地行走时，路面阻力矩小于驱动行星轮组自转扭矩，驱动电机 210通过差速器250传动至太阳齿轮231，太阳齿轮231带动行星齿轮232转动，中屯、链轮236 与行星齿轮232同步转动，中屯、链轮236通过链条238带动行星链轮237转动，从而使行进轮 220自转，从而带动越障机器人前进。当越障机器人遇到障碍物或爬楼梯时，行进阻力矩瞬 间增大至大于驱动行星轮组自转扭矩，驱动电机210通过差速器250传动至太阳齿轮231，但 阻力使行星齿轮232停滞，太阳齿轮231带动内行星架234转动，从而实现驱动行星轮组公 转，驱动行星轮组带动越障机器人顺利越障。但是越障机器人在越障时会出现两种情况:一 是在障碍物处行进轮220与地面打滑；二是在障碍物处行进轮220与地面没有相对运动，即 停止转动，下面分别讨论两种情况下越障机器人越障的条件。
[0062] 当遇到障碍行进轮220与地面打滑时，控制器通过扭矩传感器测量越障机器人实 时扭矩r，控制器根据公式（1)计算越障需要的扭矩为Tl,控制器控制电机的实时扭矩r〉 Tl,越障机器人中的行星轮系230公转从而越障：
[0063]
(I)
[0064] 其中，A为第一影响因子，反映角度0、传动比k、机械效率Tl和半径R对越障扭矩的影 响，其计算公式(2)为：
[0065]
(2)
[0066] 其中，A刃巧一影啊因于，尤因次；0为构成等边S角形的S个行走轮之间夹角，单 位为度;k为行星轮传动比，Tl为越障机器人的机械效率;m为越障机器人的质量，单位为g;f 为越障机器人与地面的动摩擦系数，R为越障机器人的=个行走轮形成的等边=角形的外 切圆的半径，单位为米。
[0067] 当遇到障碍行进轮220与地面没有相对运动，即行进轮220停止运动时，控制器根 据公式(3)计算越障需要的扭矩为T2,控制器控制电机的实时扭矩r〉T2,越障机器人中的行 星轮系230从而越障；
[006引
[0069] 其中，A为第一影响因子，反映角度0、传动比k、机械效率Tl和半径R对越障扭矩的影 响，其计當公古（4)九，
[0070]
(4)
[0071] 其中，A为第一影响因子，无因次；0为构成等边=角形的=个行走轮之间夹角，单 位为度;k为行星轮传动比，Tl为越障机器人的机械效率;m为越障机器人的质量，单位为g;f 为越障机器人与地面的动摩擦系数，R为越障机器人的=个行走轮形成的等边=角形的外 切圆的半径，单位为米。
[0072] 尽管本发明的实施方案已公开如上，但其并不仅仅限于说明书和实施方式中所列 运用。它完全可W被适用于各种适合本发明的领域。对于熟悉本领域的人员而言，可容易地 实现另外的修改。因此在不背离权利要求及等同范围所限定的一般概念下，本发明并不限 于特定的细节和运里示出与描述的图例。
【主权项】
1. 一种多功能越障机器人，其特征在于，包括： 车架； 驱动电机，其固定在车架上； 驱动行星轮组和从动行星轮组，所述驱动行星轮组对称布设在车架前端两侧，由驱动 电机驱动;所述从动行星轮组对称安装在车架后端两侧;其中，所述行星轮组包括： 内行星架，其包括至少二个向外延伸的支脚，并且朝向所述驱动电机的一侧上设置太 阳齿轮和行星齿轮，另一侧面上设置中屯、链轮和多个行星链轮；W及 所述太阳齿轮，其通过第一轴可旋转固定在所述内行星架上，所述电机输出轴连接所 述太阳齿轮； 所述行星齿轮，其通过第二轴可旋转固定在所述内行星架上，并且和所述太阳齿轮晒 合； 所述中屯、链轮，其固定在所述第二轴上，所述中屯、链轮和所述行星齿轮共同旋转； 所述多个行星链轮，其一一对应的可旋转的设置在所述支脚的外端； 链条，其与所述中屯、链轮和所述多个行星链轮同时晒合； 行进轮，其分别和所述多个行星链轮同轴固定，并且和所述多个行星链轮共同旋转。2. 如权利要求1所述的多功能越障机器人，其特征在于，所述车架还包括转向系统，其 连接在车架后部，包括转向电机和折腰式转向单元，所述转向电机驱动折腰式转向单元相 对于车架倾斜一定角度，从而实现转向；其中，所述从动行星轮组对称安装在转向系统两 侧。3. 如权利要求2所述的多功能越障机器人，其特征在于，所述驱动电机连接差速器，所 述差速器输出两个动力轴连接车架两侧的驱动行星轮组。4. 如权利要求2所述的多功能越障机器人，其特征在于，所述折腰式转向单元包括： 导轨，其横向固定在车架上； 滑块，其套设在导轨上并能够沿导轨滑动； 转向齿条，其与转向电机晒合，并且固定连接滑块，所述转向齿条在转向电机驱动下带 动滑块沿导轨移动； 连杆机构，包括纵杆、第一横杆和第二横杆，纵杆前端可旋转连接滑块，纵杆后端分别 较接在第一横杆和第二横杆的中屯、点，第一横杆和第二横杆平行设置且其两端较接转向 臂； 所述转向臂的前端较接在车架后端； 其中，当纵杆前端在滑块带动下沿导轨移动，其带动第一横杆和第二横杆横向移动，从 而带动转向臂与车架倾斜一定角度，实现从动行星轮组转向。5. 如权利要求3或4所述的多功能越障机器人，其特征在于，所述车架还包括载物台，其 固定在车架上，用于承载物品。6. 如权利要求3所述的多功能越障机器人，其特征在于，还包括控制系统，其包括： 扭矩传感器，其安装在驱动电机输出轴上，所述扭矩传感器测量驱动电机的扭矩； 转速传感器，其分别安装在差速器的两个所述动力轴上，用于检测两个动力轴的转速； 信号接收发射机，其连接扭矩传感器和转速传感器，所述信号接收发射机接收扭矩传 感器和转速传感器的信号； 控制器，其连接信号接收发射机、驱动电机和转向电机，所述控制器接收信号接收发射 机的信号并控制转向电机和驱动电机;W及 电子调速器，其连接控制器，所述电子调速器调节驱动行星轮组的行进速度。7. 如权利要求6所述的多功能越障机器人，其特征在于，所述驱动电机为伺服电机，控 制器通过信号接收发射机接收扭矩传感器的信号，并控制驱动电机的输出扭矩。8. 如权利要求6所述的多功能越障机器人，其特征在于，所述电子调速器连接驱动电机 的电源，其通过调节电源调节驱动行星轮组的行进速度。9. 如权利要求7所述的多功能越障机器人，其特征在于，所述驱动行星轮组遇到障碍行 而打、膊_电化沛服动軒居龄姐A柱战陪_歧出Ii巢歧出Ii由枕的立R才巧其中，e为行走轮之间夹角，k为驱动行星轮组传动比，Tl为驱动行星轮组的机械效率;m 为驱动行星轮组的质量，f为行进轮与地面的动摩擦系数，R为行星轮系的旋转半径。10. 如权利要求7所述的多功能越障机器人，其特征在于，所述驱动行星轮组遇到障碍 而轮与地面没有相对运动，为驱动行星轮组公转越障，控制器控制电机的实时扭矩r满足；具甲，6刃化疋祀之间乂用，k刃驱功化星祀姐巧功此，n刃驱功化星祀姐的机楓巧準；m 为驱动行星轮组的质量，f为行进轮与地面的动摩擦系数，R为行星轮系的旋转半径。
【文档编号】B60L15/20GK105905178SQ201610297760
【公开日】2016年8月31日
【申请日】2016年5月6日
【发明人】洪哲浩, 洪日
【申请人】吉林大学