CN112193346A - 一种并联四足机器狗 - Google Patents
一种并联四足机器狗 Download PDFInfo
- Publication number
- CN112193346A CN112193346A CN202011236071.3A CN202011236071A CN112193346A CN 112193346 A CN112193346 A CN 112193346A CN 202011236071 A CN202011236071 A CN 202011236071A CN 112193346 A CN112193346 A CN 112193346A
- Authority
- CN
- China
- Prior art keywords
- iii
- bearing
- thigh
- motor
- shaft
- 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.)
- Pending
Links
- 230000005540 biological transmission Effects 0.000 claims abstract description 72
- 210000002414 leg Anatomy 0.000 claims description 87
- 210000000689 upper leg Anatomy 0.000 claims description 48
- 210000001699 lower leg Anatomy 0.000 claims description 36
- 230000009467 reduction Effects 0.000 claims description 6
- 229920000049 Carbon (fiber) Polymers 0.000 claims description 3
- 239000004917 carbon fiber Substances 0.000 claims description 3
- 239000000463 material Substances 0.000 claims description 3
- VNWKTOKETHGBQD-UHFFFAOYSA-N methane Chemical compound C VNWKTOKETHGBQD-UHFFFAOYSA-N 0.000 claims description 3
- 241000282472 Canis lupus familiaris Species 0.000 abstract description 50
- 230000009471 action Effects 0.000 abstract description 12
- 230000010354 integration Effects 0.000 abstract description 2
- 230000033001 locomotion Effects 0.000 description 11
- 230000005021 gait Effects 0.000 description 6
- 230000009191 jumping Effects 0.000 description 5
- 238000009434 installation Methods 0.000 description 3
- 238000000034 method Methods 0.000 description 3
- 239000011664 nicotinic acid Substances 0.000 description 3
- 241001465754 Metazoa Species 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000002349 favourable effect Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 210000001364 upper extremity Anatomy 0.000 description 2
- 241001455214 Acinonyx jubatus Species 0.000 description 1
- 241000282373 Panthera pardus Species 0.000 description 1
- 244000309466 calf Species 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 239000004575 stone Substances 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
- B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
- B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种并联四足机器狗,其包括二自由度五连杆机械腿、动力传动系统、STM32单片机控制系统和机身;STM32单片机控制系统固定在机身底部上方,4个独立的动力传动系统分别设置在机身内4个方位,二自由度五连杆机械腿设置在机身下方,并连接在动力传动系统的外侧。本发明提供的并联四足机器狗采用简单的设计原理来完成复杂动作的理念;设计合理,结构简单,模块集成度高;与其他串联机器狗相比较,本发明的并联四足机器狗重负荷比小,且具有精度高,强度大、刚度大、承载能力强,无累计误差、便于控制等特点。
Description
技术领域
本发明属于机器人技术领域,涉及一种并联四足机器狗。更具体地,本发明涉及一种小型并联四足机器狗,该小型并联四足机器狗是以电动作为动力,以STM32单片机控制系统控制电机有效工作,结合平面二自由度五杆机构,来实现机器狗仿四足动物运动的一种仿生装置。
背景技术
四足机器狗因其优越的地形适应能力,近年来一直是国内外的研究重点。其中美国波士顿动力公司(Boston Dynamics)的Spot系列的机器狗已经开始商业化,支持订购;美国麻省理工学院(MIT)的猎豹系列机器人(Cheetah);国内宇树科技的XDog、浙江大学的“绝影”等相继出现。对于复杂狭小的地形(如室内、街道、石路等),小型并且运动灵活的四足机器人,像狗等四足动物,更加适合这种场合的应用。这些四足机器人采用串联结构,12自由度闭环控制。因此设计难度高、控制控制难度大、易累计误差、门槛较高。
发明内容
本发明专利的目的在于:基于单片机控制技术、无刷电机控制技术,设计一种仿生并联四足机器狗,主要完成四足动物-狗的对角行走方式完成行走动作。
本发明提供的并联四足机器狗包括4个二自由度五连杆机械腿Ⅰ(第一机械腿Ⅰ-1、第二机械腿Ⅰ-2、第三机械腿Ⅰ-3和第四机械腿Ⅰ-4)、4个动力传动系统Ⅱ(第一动力传动Ⅱ-1、第二动力传动Ⅱ-2、第三动力传动Ⅱ-3和第四动力传动Ⅱ-4)、STM32单片机控制系统Ⅲ、机身Ⅳ四大部分。其中,所述的STM32单片机控制系统Ⅲ固定在机身Ⅳ底部上方,4个独立的动力传动系统Ⅱ分别设置在机身Ⅳ内4个方位,呈前后左右对称分布,二自由度五连杆机械腿Ⅰ设置在机身Ⅳ下方,并连接在动力传动系统Ⅱ的外侧。
所述机身Ⅳ包括上板Ⅳ-3、底板Ⅳ-1和侧板Ⅳ-2,所述的上板Ⅳ-3、底板Ⅳ-1和侧板Ⅳ-2均为碳纤维板,上板Ⅳ-3和底板Ⅳ-1相互平行设置于上方及下方,二者垂直方向投影重叠,所述的侧板Ⅳ-2设置有两块,对称设置于上板Ⅳ-3和底板Ⅳ-1的两长边位置;上板Ⅳ-3、底板Ⅳ-1和两块侧板Ⅳ-2组成了机身Ⅳ的框架结构。
每一个所述的动力传动系统Ⅱ包括2个直流无刷减速电机Ⅱ-1-1、电机支架Ⅱ-1-2、2个梅花桩联轴器Ⅱ-1-3、第一轴承座Ⅱ-1-4、第二轴承座Ⅱ-1-9、4个卡簧Ⅱ-1-5、4个轴承Ⅱ-1-6、2个第一轴套Ⅱ-1-7、2个第二轴套Ⅱ-1-8;其中,在机身Ⅳ中,每个动力传动系统Ⅱ的电机支架Ⅱ-1-2、第一轴承座Ⅱ-1-4和第二轴承座Ⅱ-1-8由内至外依次设置于上板Ⅳ-3和底板Ⅳ-1之间,具体地,通过螺丝钉将电机支架Ⅱ-1-2、第一轴承座Ⅱ-1-4和第二轴承座Ⅱ-1-8的上、下面分别固定在上板Ⅳ-3和底板Ⅳ-1上。并且,位于同侧的两个第二轴承座Ⅱ-1-8的外端面上固定侧板Ⅳ-2。
所述的直流无刷减速电机Ⅱ-1-1固定在电机支架Ⅱ-1-2上,通过梅花桩联轴器Ⅱ-1-3将直流无刷减速电机Ⅱ-1-1的输出轴与二自由度五连杆机械腿Ⅰ的传动轴Ⅰ-1-9连接。
所述的传动轴Ⅰ-1-9的短轴端与第一轴套Ⅱ-1-7、轴承Ⅱ-1-6内圈间隙配合,轴承Ⅱ-1-6外圈与第一轴承座Ⅱ-1-4间隙配合,并由卡簧Ⅱ-1-5固定。
具体地,传动轴Ⅰ-1-9的短轴端的轴肩与第一轴套Ⅱ-1-7的一端接触,第一轴套Ⅱ-1-7的另一端与轴承Ⅱ-1-6的内圈接触,轴承Ⅱ-1-6的外圈与卡簧Ⅱ-1-5接触,卡簧Ⅱ-1-5将轴承Ⅱ-1-6外圈固定在第一轴承座Ⅱ-1-4上。
同样地,所述的传动轴Ⅰ-1-9的长轴端与第二轴套Ⅱ-1-8、轴承的内圈间隙配合,轴承的外圈与第二轴承座Ⅱ-1-9间隙配合,并由卡簧固定。
具体地,传动轴Ⅰ-1-9长轴端的轴肩与第二轴套Ⅱ-1-8的一端接触,第二轴套Ⅱ-1-8的另一端与轴承的内圈接触,轴承的外圈与卡簧接触,卡簧将轴承的外圈固定在第二轴承座Ⅱ-1-9上。
每一个所述的二自由度五连杆机械腿Ⅰ包括足部Ⅰ-1-1、第一小腿Ⅰ-1-2、第二小腿Ⅰ-1-3、轴肩螺栓组Ⅰ-1-4、机械腿轴承Ⅰ-1-5、第一大腿Ⅰ-1-6、圆柱销Ⅰ-1-7、第二大腿Ⅰ-1-8和传动轴Ⅰ-1-9;所述的足部Ⅰ-1-1是由橡胶材料制成,直接粘附在第一小腿Ⅰ-1-2的近足端末端处。
所述的第一大腿Ⅰ-1-6、第一小腿Ⅰ-1-2、第二小腿Ⅰ-1-3和第二大腿Ⅰ-1-8依次连接,连接处通过过盈配合连接机械腿轴承Ⅰ-1-5,并配合轴肩螺栓组Ⅰ-1-4依次串联固定,所述的第一大腿Ⅰ-1-6和第二大腿Ⅰ-1-8分别与连接于同一动力传动系统Ⅱ的两个直流无刷减速电机Ⅱ-1-1的两个传动轴Ⅰ-1-9相连接,且位于第一轴承座Ⅱ-1-4与第二轴承座Ⅱ-1-8之间。
具体地,第一大腿Ⅰ-1-6的两端分别设置有连接孔和通孔,同样地,第二大腿Ⅰ-1-8的两端分别设置有连接孔和通孔。第一小腿Ⅰ-1-2的近足端及远足端均设置有一连接孔,第二小腿Ⅰ-1-3的两端均设置有一连接孔。
其中,第一大腿Ⅰ-1-6的连接孔与第一小腿Ⅰ-1-2的远足端连接孔连接,第一小腿Ⅰ-1-2的近足端连接孔与第二小腿Ⅰ-1-3的一端连接孔连接,第二小腿Ⅰ-1-3的另一端连接孔与第二大腿Ⅰ-1-8的连接孔连接。腿部的各连接孔均为阶梯孔,腿部各连接处设置有机械腿轴承Ⅰ-1-5,机械腿轴承Ⅰ-1-5的外圈端面与各连接孔(阶梯孔)的阶梯面接触;轴肩螺栓组Ⅰ-1-4与机械腿轴承Ⅰ-1-5的内圈间隙配合。第一大腿Ⅰ-1-6、第二大腿Ⅰ-1-8的通孔分别与两传动轴Ⅰ-1-9间隙配合,并通过圆柱销Ⅰ-1-7固定。
所述的STM32单片机控制系统Ⅲ包括STM32控制板Ⅲ-1、电池Ⅲ-2、陀螺仪Ⅲ-3和8个C620无刷电机调速器Ⅲ-4;其中,STM32控制板Ⅲ-1固定在底板Ⅳ-1中间段的一侧,电池Ⅲ-2、陀螺仪Ⅲ-3固定在底板Ⅳ-1中间段的中心位置,C620无刷电机调速器Ⅲ-4固定在底板Ⅳ-1中间段的另一侧;STM32控制板Ⅲ-1与电池Ⅲ-2连接,由电池Ⅲ-2为并联四足机器狗供电;STM32控制板Ⅲ-1与陀螺仪Ⅲ-3连接,以读取陀螺仪Ⅲ-3的信号,具体地,STM32单片机通过数据线读取陀螺仪Ⅲ-3的信号;STM32控制板Ⅲ-1与各C620无刷电机调速器Ⅲ-4连接,各C620无刷电机调速器Ⅲ-4与各直流无刷减速电机Ⅱ-1-1一一对应连接,以通过STM32单片机控制各C620无刷电机调速器Ⅲ-4,进而控制各直流无刷减速电机Ⅱ-1-1。
进一步地,通过调整第一大腿Ⅰ-1-6的通孔和第二大腿Ⅰ-1-8的通孔与不同的传动轴Ⅰ-1-9相连接(同一动力传动系统Ⅱ的两个直流无刷减速电机Ⅱ-1-1的两个传动轴Ⅰ-1-9),使得4个二自由度五连杆机械腿Ⅰ实际的安装布置方式,划分为2种:①:前机械腿的足端朝向前,后机械腿的足端朝向后,这种安装布置方式使四足机器狗具有较好的被控性能。选用①这种布置方式,是因为在四足机器人典型的对角步态时,机器人的左前腿与右后腿和右前腿模块与左后腿的运动是关于机器狗中心完全对称的,而且足端支撑的范围较大。②:前机械腿的足端朝向前,后机械腿的足端朝向前,当为了提升机器狗行走的速度、提高跳跃性能时,选用②这种布置方式,是因为两连杆腿在动力学上的特点,使得这种结构形式有利于提升机器狗在行走、跳跃等步态的性能。
进一步地,本发明提供的并联四足机器狗的动力传动系统Ⅱ中的8个直流无刷减速电机Ⅱ-1-1与STM32单片机控制系统Ⅲ中的8个C620无刷电机调速器Ⅲ-4一一对应,各C620无刷电机调速器Ⅲ-4对各自对应的直流无刷减速电机Ⅱ-1-1的调速,STM32单片机获取陀螺仪Ⅲ-3中的位姿信号集中控制各个C620无刷电机调速器Ⅲ-4。使用STM32单片机控制直流无刷减速电机Ⅱ-1-1,系统构成简单,可靠性高,抗干扰能力强;并且扩展容易,便于搭载其他设备。
进一步地,本发明提供的并联四足机器狗的直流无刷减速电机Ⅱ-1-1采用闭环控制技术,以实现对电机的力矩控制、速度控制、位置控制;所述的直流无刷减速电机Ⅱ-1-1设有霍尔编码器和温度传感器,以使直流无刷减速电机Ⅱ-1-1具有温度感知功能,防止电机过热;并且,所述的直流无刷减速电机Ⅱ-1-1允许实施超额定电流驱动,使直流无刷减速电机Ⅱ-1-1瞬时获得较大的驱动电流而瞬时输出较大的力矩;超额定电流工作的直流无刷减速电机Ⅱ-1-1,可以提升机器狗腿部间歇性发力运动步态下(跳跃)的性能。
本发明与现有技术相比,具有下述优点:机器狗由电动系统、二自由度五连杆机构、STM32单片机控制系统有机结合而成,该设计体现了用简单的设计原理来完成复杂动作的理念;设计合理,结构简单,模块集成度高;与其他驱动方式比较,电动具有安装方便、实用性强、驱动精确度高、控制调速方便等优点。与其他串联机器狗相比较,本发明的并联四足机器狗重负荷比小,且具有精度高,强度大、刚度大、承载能力强,无累计误差、便于控制等特点。
附图说明
图1是本发明的并联四足机器狗的整体轴测图;
图2是本发明的并联四足机器狗的俯视内部图;
图3是本发明的并联四足机器狗的腿部和动力及其传动的爆炸图;
图4是本发明的并联四足机器狗的支撑相机械腿的机构简图;
图5是本发明的并联四足机器狗的摆动相机械腿的机构简图;
图6是本发明的并联四足机器狗的4条腿的一种布置方式的示意图;
图7是本发明的并联四足机器狗的4条腿的另一种布置方式的示意图。
图中:
Ⅰ二自由度五连杆机械腿;Ⅱ动力传动系统;ⅢSTM32单片机控制系统;Ⅳ机身;
Ⅰ-1-1足部;Ⅰ-1-2第一小腿;Ⅰ-1-3第二小腿;Ⅰ-1-4轴肩螺丝组;Ⅰ-1-5机械腿轴承;Ⅰ-1-6第一大腿;Ⅰ-1-7圆柱销;Ⅰ-1-8第二大腿;Ⅰ-1-9传动轴;
Ⅱ-1-1直流无刷减速电机;Ⅱ-1-2电机支架;Ⅱ-1-3梅花桩联轴器;Ⅱ-1-4第一轴承座;Ⅱ-1-5卡簧;Ⅱ-1-6轴承;Ⅱ-1-7第一轴套;Ⅱ-1-8第二轴套;Ⅱ-1-9第二轴承座;
Ⅰ-1第一机械腿;Ⅰ-2第二机械腿;Ⅰ-3第三机械腿;Ⅰ-4第四机械腿;
Ⅱ-1第一动力传动;Ⅱ-2第二动力传动;Ⅱ-3第三动力传动;Ⅱ-4第四动力传动;
Ⅲ-1STM32控制板;Ⅲ-2电池;Ⅲ-3陀螺仪;Ⅲ-4C620无刷电机调速器;
Ⅳ-1底板;Ⅳ-2侧板;Ⅳ-3上板。
具体实施方式
下述各实施例仅用于说明本发明,其中各部件的结构、连接方式和制作工艺等都是可以有所变化的,凡是在本发明技术方案的基础上进行的等同变换和改进,均不应排除在本发明的保护范围之外。
图1是本发明的并联四足机器狗的整体轴测图;图2是本发明的并联四足机器狗的俯视内部图;图3是本发明的并联四足机器狗的腿部和动力及其传动的爆炸图。参见图1至图3,在本实施例中提供的并联四足机器狗包括4个二自由度五连杆机械腿Ⅰ(第一机械腿Ⅰ-1、第二机械腿Ⅰ-2、第三机械腿Ⅰ-3和第四机械腿Ⅰ-4)、4个动力传动系统Ⅱ(第一动力传动Ⅱ-1、第二动力传动Ⅱ-2、第三动力传动Ⅱ-3和第四动力传动Ⅱ-4)、STM32单片机控制系统Ⅲ、机身Ⅳ四大部分。其中,所述的STM32单片机控制系统Ⅲ固定在机身Ⅳ底部上方,4个独立的动力传动系统Ⅱ分别设置在机身Ⅳ内4个方位,呈前后左右对称分布,二自由度五连杆机械腿Ⅰ设置在机身Ⅳ下方,并连接在动力传动系统Ⅱ的外侧。
所述机身Ⅳ包括上板Ⅳ-3、底板Ⅳ-1和侧板Ⅳ-2,所述的上板Ⅳ-3、底板Ⅳ-1和侧板Ⅳ-2均为碳纤维板,上板Ⅳ-3和底板Ⅳ-1相互平行设置于上方及下方,二者垂直方向投影重叠,所述的侧板Ⅳ-2设置有两块,对称设置于上板Ⅳ-3和底板Ⅳ-1的两长边位置;上板Ⅳ-3、底板Ⅳ-1和两块侧板Ⅳ-2组成了机身Ⅳ的框架结构。
每一个所述的动力传动系统Ⅱ包括2个直流无刷减速电机Ⅱ-1-1、电机支架Ⅱ-1-2、2个梅花桩联轴器Ⅱ-1-3、第一轴承座Ⅱ-1-4、第二轴承座Ⅱ-1-9、4个卡簧Ⅱ-1-5、4个轴承Ⅱ-1-6、2个第一轴套Ⅱ-1-7、2个第二轴套Ⅱ-1-8;其中,在机身Ⅳ中,每个动力传动系统Ⅱ的电机支架Ⅱ-1-2、第一轴承座Ⅱ-1-4和第二轴承座Ⅱ-1-8由内至外依次设置于上板Ⅳ-3和底板Ⅳ-1之间,具体地,通过螺丝钉将电机支架Ⅱ-1-2、第一轴承座Ⅱ-1-4和第二轴承座Ⅱ-1-8的上、下面分别固定在上板Ⅳ-3和底板Ⅳ-1上。并且,位于同侧的两个第二轴承座Ⅱ-1-8的外端面上固定侧板Ⅳ-2。
所述的直流无刷减速电机Ⅱ-1-1固定在电机支架Ⅱ-1-2上,通过梅花桩联轴器Ⅱ-1-3将直流无刷减速电机Ⅱ-1-1的输出轴与二自由度五连杆机械腿Ⅰ的传动轴Ⅰ-1-9连接。
所述的传动轴Ⅰ-1-9的短轴端与第一轴套Ⅱ-1-7、轴承Ⅱ-1-6内圈间隙配合,轴承Ⅱ-1-6外圈与第一轴承座Ⅱ-1-4间隙配合,并由卡簧Ⅱ-1-5固定。
具体地,传动轴Ⅰ-1-9的短轴端的轴肩与第一轴套Ⅱ-1-7的一端接触,第一轴套Ⅱ-1-7的另一端与轴承Ⅱ-1-6的内圈接触,轴承Ⅱ-1-6的外圈与卡簧Ⅱ-1-5接触,卡簧Ⅱ-1-5将轴承Ⅱ-1-6外圈、第一轴承座Ⅱ-1-4固定。
同样地,所述的传动轴Ⅰ-1-9的长轴端与第二轴套Ⅱ-1-8、轴承的内圈间隙配合,轴承的外圈与第二轴承座Ⅱ-1-9间隙配合,并由卡簧固定。
具体地,传动轴Ⅰ-1-9长轴端的轴肩与第二轴套Ⅱ-1-8的一端接触,第二轴套Ⅱ-1-8的另一端与轴承的内圈接触,轴承的外圈与卡簧接触,卡簧将轴承的外圈、第二轴承座Ⅱ-1-9固定。
每一个所述的二自由度五连杆机械腿Ⅰ包括足部Ⅰ-1-1、第一小腿Ⅰ-1-2、第二小腿Ⅰ-1-3、轴肩螺栓组Ⅰ-1-4、机械腿轴承Ⅰ-1-5、第一大腿Ⅰ-1-6、圆柱销Ⅰ-1-7、第二大腿Ⅰ-1-8和传动轴Ⅰ-1-9;所述的足部Ⅰ-1-1是由橡胶材料制成,直接粘附在第一小腿Ⅰ-1-2的近足端末端处。
所述的第一大腿Ⅰ-1-6、第一小腿Ⅰ-1-2、第二小腿Ⅰ-1-3和第二大腿Ⅰ-1-8依次连接,连接处通过过盈配合连接机械腿轴承Ⅰ-1-5,并配合轴肩螺栓组Ⅰ-1-4依次串联固定,所述的第一大腿Ⅰ-1-6和第二大腿Ⅰ-1-8分别与连接于同一动力传动系统Ⅱ的两个直流无刷减速电机Ⅱ-1-1的两个传动轴Ⅰ-1-9相连接,且位于第一轴承座Ⅱ-1-4与第二轴承座Ⅱ-1-8之间。
具体地,第一大腿Ⅰ-1-6的两端分别设置有连接孔和通孔,同样地,第二大腿Ⅰ-1-8的两端分别设置有连接孔和通孔。第一小腿Ⅰ-1-2的近足端及远足端均设置有一连接孔,第二小腿Ⅰ-1-3的两端均设置有一连接孔。
其中,第一大腿Ⅰ-1-6的连接孔与第一小腿Ⅰ-1-2的远足端连接孔连接,第一小腿Ⅰ-1-2的近足端连接孔与第二小腿Ⅰ-1-3的一端连接孔连接,第二小腿Ⅰ-1-3的另一端连接孔与第二大腿Ⅰ-1-8的连接孔连接。腿部的各连接孔均为阶梯孔,腿部各连接处设置有机械腿轴承Ⅰ-1-5,机械腿轴承Ⅰ-1-5的外圈端面与各连接孔(阶梯孔)的阶梯面接触;轴肩螺栓组Ⅰ-1-4与机械腿轴承Ⅰ-1-5的内圈间隙配合。第一大腿Ⅰ-1-6、第二大腿Ⅰ-1-8的通孔分别与两传动轴Ⅰ-1-9间隙配合,并通过圆柱销Ⅰ-1-7固定。
所述的STM32单片机控制系统Ⅲ包括STM32控制板Ⅲ-1、电池Ⅲ-2、陀螺仪Ⅲ-3和8个C620无刷电机调速器Ⅲ-4;其中,STM32控制板Ⅲ-1固定在底板Ⅳ-1中间段的一侧,电池Ⅲ-2、陀螺仪Ⅲ-3固定在底板Ⅳ-1中间段的中心位置,C620无刷电机调速器Ⅲ-4固定在底板Ⅳ-1中间段的另一侧;STM32控制板Ⅲ-1与电池Ⅲ-2电连接,由电池Ⅲ-2为并联四足机器狗供电;STM32控制板Ⅲ-1与陀螺仪Ⅲ-3连接,以读取陀螺仪Ⅲ-3的信号,具体地,STM32单片机通过数据线读取陀螺仪Ⅲ-3的信号;STM32控制板Ⅲ-1与各C620无刷电机调速器Ⅲ-4连接,各C620无刷电机调速器Ⅲ-4与各直流无刷减速电机Ⅱ-1-1一一对应连接,以通过STM32单片机控制各C620无刷电机调速器Ⅲ-4,进而控制各直流无刷减速电机Ⅱ-1-1。
进一步地,通过调整第一大腿Ⅰ-1-6的通孔和第二大腿Ⅰ-1-8的通孔与不同的传动轴Ⅰ-1-9相连接(同一动力传动系统Ⅱ的两个直流无刷减速电机Ⅱ-1-1的两个传动轴Ⅰ-1-9),使得4个二自由度五连杆机械腿Ⅰ实际的安装布置方式,划分为2种:①:前机械腿的足端朝向前,后机械腿的足端朝向后(如图7所示),这种安装布置方式使四足机器狗具有较好的被控性能。选用①这种布置方式,是因为在四足机器人典型的对角步态时,机器人的左前腿与右后腿和右前腿模块与左后腿的运动是关于机器狗中心完全对称的,而且足端支撑的范围较大。②:前机械腿的足端朝向前,后机械腿的足端朝向前(如图6所示),当为了提升机器狗行走的速度、提高跳跃性能时,选用②这种布置方式,是因为两连杆腿在动力学上的特点,使得这种结构形式有利于提升机器狗在行走、跳跃等步态的性能。
进一步地,本发明提供的并联四足机器狗的动力传动系统Ⅱ中的8个直流无刷减速电机Ⅱ-1-1与STM32单片机控制系统Ⅲ中的8个C620无刷电机调速器Ⅲ-4一一对应,各C620无刷电机调速器Ⅲ-4对各自对应的直流无刷减速电机Ⅱ-1-1的调速,STM32单片机获取陀螺仪Ⅲ-3中的位姿信号集中控制各个C620无刷电机调速器Ⅲ-4。使用STM32单片机控制直流无刷减速电机Ⅱ-1-1,系统构成简单,可靠性高,抗干扰能力强;并且扩展容易,便于搭载其他设备。
进一步地,本发明提供的并联四足机器狗的直流无刷减速电机Ⅱ-1-1采用闭环控制技术,以实现对电机的力矩控制、速度控制、位置控制;所述的直流无刷减速电机Ⅱ-1-1设有霍尔编码器和温度传感器,以使直流无刷减速电机Ⅱ-1-1具有温度感知功能,防止电机过热;并且,所述的直流无刷减速电机Ⅱ-1-1允许实施超额定电流驱动,使直流无刷减速电机Ⅱ-1-1瞬时获得较大的驱动电流而瞬时输出较大的力矩;超额定电流工作的直流无刷减速电机Ⅱ-1-1,可以提升机器狗腿部间歇性发力运动步态下(跳跃)的性能。
本发明的原理及操作过程分述如下:本发明依据仿生学原理,模仿四足动物对角步态的行走动作、四足动物的跳跃来设计机器狗的运动动作,使机器狗能够简捷而且有效的实现规定动作。用电池Ⅲ-2作为动力源,采用STM32单片机系统Ⅲ-1控制直流无刷减速电机Ⅱ-1-1的转动,驱动第一大腿Ⅰ-1-6、第二大腿Ⅰ-1-8摆动完成运动动作。
并联四足机器狗的行走动作主要由支撑相和摆动相两个相位同时采用周期调度来实现,采用对角步态(即四足对角的机械腿相位相同)完成直行,左右转向(即内侧机械腿步幅或频率低于外侧),以及原地转向(即四足对角的机械腿相位相反)。
图4是本发明的并联四足机器狗的支撑相机械腿的机构简图;图5是本发明的并联四足机器狗的摆动相机械腿的机构简图;参见图4和图5,下面具体描述支撑相和摆动相的功能:
1.支撑相起支撑整个机体的作用;
2.摆动相起机器狗向期望方向的跨腿以保证机器狗的持续运动的作用;
下面将详细阐述机器狗的行走的具体动作。
1.支撑相动作
机械腿简化成对称式五连杆结构,L1、L2分别为主动臂;L3、L4为从动臂;点P为足端,根据L1、L2按顺时针转动时,保持足端P在一条直线上移动且距离机架的高度恒定不变,支撑整个机身的高度恒定不变,即为并联四足机器狗的支撑相动作。
以第一机械腿Ⅰ-1为例详细阐述机械腿支撑相动作:STM32单片机Ⅲ-1发送信号给C620无刷电机调速器Ⅲ-4使其控制直流无刷减速电机Ⅱ-1-1顺时针转动,梅花桩联轴器Ⅱ-1-3将转速和扭矩传递给传动轴Ⅰ-1-9,传动轴Ⅰ-1-9带动第一大腿Ⅰ-1-6和第二大腿Ⅰ-1-8顺时针旋转,经第一小腿Ⅰ-1-2、第二小腿Ⅰ-1-3使足部Ⅰ-1-1在地面上做水平直线运动,完成一次支撑。
2.摆动相动作:
机械腿简化成对称式五连杆结构,L1、L2分别为主动;L3、L4为从动臂;点P为足端,根据L1、L2按逆时针转动时,使足端P离开地面。摆动相动作与支撑相动作类似,而电机的转动方向与支撑相的转动方向相反,使足部Ⅰ-1-1在地面上完成跨越动作。
Claims (6)
1.一种并联四足机器狗,其特征在于,包括4个二自由度五连杆机械腿(Ⅰ)、4个动力传动系统(Ⅱ)、STM32单片机控制系统(Ⅲ)、机身(Ⅳ);其中,所述的STM32单片机控制系统(Ⅲ)固定在机身(Ⅳ)底部上方,4个独立的动力传动系统(Ⅱ)分别设置在机身(Ⅳ)内4个方位,呈前后左右对称分布,二自由度五连杆机械腿(Ⅰ)设置在机身(Ⅳ)下方,并连接在动力传动系统(Ⅱ)的外侧;
所述的机身(Ⅳ)包括上板(Ⅳ-3)、底板(Ⅳ-1)和侧板(Ⅳ-2),所述的上板(Ⅳ-3)、底板(Ⅳ-1)和侧板(Ⅳ-2)均为碳纤维板,上板(Ⅳ-3)和底板(Ⅳ-1)相互平行设置于上方及下方,二者垂直方向投影重叠,所述的侧板(Ⅳ-2)设置有两块,对称设置于上板(Ⅳ-3)和底板(Ⅳ-1)的两长边位置;上板(Ⅳ-3)、底板(Ⅳ-1)和两块侧板(Ⅳ-2)组成了机身(Ⅳ)的框架结构;
每一个所述的动力传动系统(Ⅱ)包括2个直流无刷减速电机(Ⅱ-1-1)、电机支架(Ⅱ-1-2)、2个梅花桩联轴器(Ⅱ-1-3)、第一轴承座(Ⅱ-1-4)、第二轴承座(Ⅱ-1-9)、4个卡簧(Ⅱ-1-5)、4个轴承(Ⅱ-1-6)、2个第一轴套(Ⅱ-1-7)、2个第二轴套(Ⅱ-1-8);其中,在机身(Ⅳ)中,每个动力传动系统(Ⅱ)的电机支架(Ⅱ-1-2)、第一轴承座(Ⅱ-1-4)和第二轴承座(Ⅱ-1-8)由内至外依次设置于上板(Ⅳ-3)和底板(Ⅳ-1)之间;位于同侧的两个第二轴承座(Ⅱ-1-8)的外端面上固定侧板(Ⅳ-2);
所述的直流无刷减速电机(Ⅱ-1-1)固定在电机支架(Ⅱ-1-2)上,通过梅花桩联轴器(Ⅱ-1-3)将直流无刷减速电机(Ⅱ-1-1)的输出轴与二自由度五连杆机械腿(Ⅰ)的传动轴(Ⅰ-1-9)连接;所述的传动轴(Ⅰ-1-9)的短轴端与第一轴套(Ⅱ-1-7)、轴承(Ⅱ-1-6)内圈间隙配合,轴承(Ⅱ-1-6)外圈与第一轴承座(Ⅱ-1-4)间隙配合,并由卡簧(Ⅱ-1-5)固定;同样地,所述的传动轴(Ⅰ-1-9)的长轴端与第二轴套(Ⅱ-1-8)、轴承的内圈间隙配合,轴承的外圈与第二轴承座(Ⅱ-1-9)间隙配合,并由卡簧固定;
每一个所述的二自由度五连杆机械腿(Ⅰ)包括足部(Ⅰ-1-1)、第一小腿(Ⅰ-1-2)、第二小腿(Ⅰ-1-3)、轴肩螺栓组(Ⅰ-1-4)、机械腿轴承(Ⅰ-1-5)、第一大腿(Ⅰ-1-6)、圆柱销(Ⅰ-1-7)、第二大腿(Ⅰ-1-8)和传动轴(Ⅰ-1-9);所述的足部(Ⅰ-1-1)是由橡胶材料制成,直接粘附在第一小腿(Ⅰ-1-2)的近足端末端处;
所述的第一大腿(Ⅰ-1-6)、第一小腿(Ⅰ-1-2)、第二小腿(Ⅰ-1-3)和第二大腿(Ⅰ-1-8)依次连接,连接处通过过盈配合连接机械腿轴承(Ⅰ-1-5),并配合轴肩螺栓组(Ⅰ-1-4)依次串联固定,所述的第一大腿(Ⅰ-1-6)和第二大腿(Ⅰ-1-8)分别与连接于同一动力传动系统(Ⅱ)的两个直流无刷减速电机(Ⅱ-1-1)的两个传动轴(Ⅰ-1-9)相连接,且位于第一轴承座(Ⅱ-1-4)与第二轴承座(Ⅱ-1-8)之间;
所述的STM32单片机控制系统(Ⅲ)包括STM32控制板(Ⅲ-1)、电池(Ⅲ-2)、陀螺仪(Ⅲ-3)和8个C620无刷电机调速器(Ⅲ-4);其中,STM32控制板(Ⅲ-1)固定在底板(Ⅳ-1)中间段的一侧,电池(Ⅲ-2)、陀螺仪(Ⅲ-3)固定在底板(Ⅳ-1)中间段的中心位置,C620无刷电机调速器(Ⅲ-4)固定在底板(Ⅳ-1)中间段的另一侧;STM32控制板(Ⅲ-1)与电池(Ⅲ-2)电连接,由电池(Ⅲ-2)为并联四足机器狗供电;STM32控制板(Ⅲ-1)与陀螺仪(Ⅲ-3)连接,以读取陀螺仪(Ⅲ-3)的信号;STM32控制板(Ⅲ-1)与各C620无刷电机调速器(Ⅲ-4)连接,各C620无刷电机调速器(Ⅲ-4)与各直流无刷减速电机(Ⅱ-1-1)一一对应连接,以通过STM32单片机(Ⅲ-1)控制各C620无刷电机调速器(Ⅲ-4),进而控制各直流无刷减速电机(Ⅱ-1-1)。
2.根据权利要求1所述的并联四足机器狗,其特征在于,所述的传动轴(Ⅰ-1-9)的短轴端的轴肩与第一轴套(Ⅱ-1-7)的一端接触,第一轴套(Ⅱ-1-7)的另一端与轴承(Ⅱ-1-6)的内圈接触,轴承(Ⅱ-1-6)的外圈与卡簧(Ⅱ-1-5)接触,卡簧(Ⅱ-1-5)将轴承(Ⅱ-1-6)外圈固定第一轴承座(Ⅱ-1-4)上;所述的传动轴(Ⅰ-1-9)长轴端的轴肩与第二轴套(Ⅱ-1-8)的一端接触,第二轴套(Ⅱ-1-8)的另一端与轴承的内圈接触,轴承的外圈与卡簧接触,卡簧将轴承的外圈固定在第二轴承座(Ⅱ-1-9)上。
3.根据权利要求1或2所述的并联四足机器狗,其特征在于,所述的第一大腿(Ⅰ-1-6)的两端分别设置有连接孔和通孔,第二大腿(Ⅰ-1-8)的两端分别设置有连接孔和通孔;第一小腿(Ⅰ-1-2)的近足端及远足端均设置有一连接孔,第二小腿(Ⅰ-1-3)的两端均设置有一连接孔;其中,第一大腿(Ⅰ-1-6)的连接孔与第一小腿(Ⅰ-1-2)的远足端连接孔连接,第一小腿(Ⅰ-1-2)的近足端连接孔与第二小腿(Ⅰ-1-3)的一端连接孔连接,第二小腿(Ⅰ-1-3)的另一端连接孔与第二大腿(Ⅰ-1-8)的连接孔连接;腿部的各连接孔均为阶梯孔,腿部各连接处设置有机械腿轴承(Ⅰ-1-5),机械腿轴承(Ⅰ-1-5)的外圈端面与各连接孔的阶梯面接触;轴肩螺栓组(Ⅰ-1-4)与机械腿轴承(Ⅰ-1-5)的内圈间隙配合;第一大腿(Ⅰ-1-6)、第二大腿(Ⅰ-1-8)的通孔分别与两传动轴(Ⅰ-1-9)间隙配合,并通过圆柱销(Ⅰ-1-7)固定。
4.根据权利要求3所述的并联四足机器狗,其特征在于,通过调整所述的第一大腿(Ⅰ-1-6)的通孔和第二大腿(Ⅰ-1-8)的通孔与不同的传动轴(Ⅰ-1-9)相连接,使得4个二自由度五连杆机械腿(Ⅰ)具有两种安装布置方式:1)前机械腿的足部(Ⅰ-1-1)朝向前,后机械腿的足部(Ⅰ-1-1)朝向后,2)前机械腿的足部(Ⅰ-1-1)朝向前,后机械腿的足部(Ⅰ-1-1)朝向前。
5.根据权利要求1、2或4所述的并联四足机器狗,其特征在于,所述的直流无刷减速电机(Ⅱ-1-1)采用闭环控制技术,以实现对电机的力矩控制、速度控制、位置控制;所述的直流无刷减速电机(Ⅱ-1-1)设有霍尔编码器和温度传感器,以使直流无刷减速电机(Ⅱ-1-1)具有温度感知功能,防止电机过热;并且,所述的直流无刷减速电机(Ⅱ-1-1)允许实施超额定电流驱动,使直流无刷减速电机(Ⅱ-1-1)瞬时获得较大的驱动电流而瞬时输出较大的力矩。
6.根据权利要求3所述的并联四足机器狗,其特征在于,所述的直流无刷减速电机(Ⅱ-1-1)采用闭环控制技术,以实现对电机的力矩控制、速度控制、位置控制;所述的直流无刷减速电机(Ⅱ-1-1)设有霍尔编码器和温度传感器,以使直流无刷减速电机(Ⅱ-1-1)具有温度感知功能,防止电机过热;并且,所述的直流无刷减速电机(Ⅱ-1-1)允许实施超额定电流驱动,使直流无刷减速电机(Ⅱ-1-1)瞬时获得较大的驱动电流而瞬时输出较大的力矩。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011236071.3A CN112193346A (zh) | 2020-11-09 | 2020-11-09 | 一种并联四足机器狗 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011236071.3A CN112193346A (zh) | 2020-11-09 | 2020-11-09 | 一种并联四足机器狗 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112193346A true CN112193346A (zh) | 2021-01-08 |
Family
ID=74033365
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011236071.3A Pending CN112193346A (zh) | 2020-11-09 | 2020-11-09 | 一种并联四足机器狗 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112193346A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112829849A (zh) * | 2021-01-12 | 2021-05-25 | 北京交通大学 | 一种四足步行机器人 |
CN114906249A (zh) * | 2022-06-10 | 2022-08-16 | 中国人民解放军国防科技大学 | 一种十二自由度并联仿生四足机器人 |
-
2020
- 2020-11-09 CN CN202011236071.3A patent/CN112193346A/zh active Pending
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112829849A (zh) * | 2021-01-12 | 2021-05-25 | 北京交通大学 | 一种四足步行机器人 |
CN114906249A (zh) * | 2022-06-10 | 2022-08-16 | 中国人民解放军国防科技大学 | 一种十二自由度并联仿生四足机器人 |
CN114906249B (zh) * | 2022-06-10 | 2024-02-02 | 中国人民解放军国防科技大学 | 一种十二自由度并联仿生四足机器人 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112193346A (zh) | 一种并联四足机器狗 | |
CN111891253B (zh) | 四足机器人 | |
CN110217311B (zh) | 一种基于同轴并联机构的敏捷四足机器人 | |
CN107223104A (zh) | 多足机器人 | |
CN108927796B (zh) | 一种基于生物学特征的四足仿生机器人平台 | |
CN101007550A (zh) | 仿生多关节型机器人腿部驱动传动装置 | |
CN103144694B (zh) | 一种四足仿生机器人原地转向机构 | |
CN111516774B (zh) | 一种双足四足一体化可实时切换足式机器人 | |
CN111846008A (zh) | 一种具有变刚度踝关节的双足机器人 | |
CN106956247B (zh) | 串并混联的四足机器人主动柔顺脊椎 | |
CN111332382A (zh) | 一种水平关节四足机器人 | |
CN111924019B (zh) | 一种八自由度盘式无刷电机驱动四足机器人 | |
CN1483554A (zh) | 一种可调整的四足仿生机器人运动结构 | |
CN212861687U (zh) | 四足机器人 | |
CN213354654U (zh) | 一种并联四足机器狗 | |
CN210653415U (zh) | 一种基于同轴并联机构的敏捷四足机器人 | |
CN205971578U (zh) | 遥控机器人 | |
CN212187114U (zh) | 一种基于机器视觉的机械导盲犬 | |
CN113071274B (zh) | 一种基于混联机构的仿蛙式水陆两栖机器人 | |
CN210000442U (zh) | 一种机器人行走机构 | |
CN115489639A (zh) | 一种机器人腿部、四足仿生机器人 | |
CN111110529A (zh) | 一种基于机器视觉的机械导盲犬 | |
CN106863278A (zh) | 一种轮腿式3‑puu并联移动机器人 | |
CN213057275U (zh) | 一种三足机器人 | |
Chung et al. | On the design and development of a quadruped robot platform |
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 |