CN114055478A - 一种前馈补偿的电液比例控制系统及多关节液压机械臂 - Google Patents
一种前馈补偿的电液比例控制系统及多关节液压机械臂 Download PDFInfo
- Publication number
- CN114055478A CN114055478A CN202111579614.6A CN202111579614A CN114055478A CN 114055478 A CN114055478 A CN 114055478A CN 202111579614 A CN202111579614 A CN 202111579614A CN 114055478 A CN114055478 A CN 114055478A
- Authority
- CN
- China
- Prior art keywords
- reversing valve
- proportional
- valve
- proportional reversing
- hydraulic
- 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
- 230000007246 mechanism Effects 0.000 claims abstract description 65
- 238000000034 method Methods 0.000 claims abstract description 18
- 239000003921 oil Substances 0.000 claims description 67
- 210000000707 wrist Anatomy 0.000 claims description 54
- 230000009471 action Effects 0.000 claims description 16
- 238000006073 displacement reaction Methods 0.000 claims description 13
- 230000001133 acceleration Effects 0.000 claims description 6
- 210000000245 forearm Anatomy 0.000 claims description 5
- 238000012546 transfer Methods 0.000 claims description 5
- 239000010720 hydraulic oil Substances 0.000 claims description 4
- 230000010355 oscillation Effects 0.000 claims 2
- 239000007788 liquid Substances 0.000 claims 1
- 230000002194 synthesizing effect Effects 0.000 claims 1
- 230000004044 response Effects 0.000 abstract description 18
- 238000013461 design Methods 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 14
- 238000013016 damping Methods 0.000 description 4
- 238000012423 maintenance Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000035945 sensitivity Effects 0.000 description 2
- 230000006641 stabilisation Effects 0.000 description 2
- 238000011105 stabilization Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008094 contradictory effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 239000012530 fluid Substances 0.000 description 1
- 238000010438 heat treatment Methods 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
- 238000012544 monitoring process Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000004043 responsiveness Effects 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J17/00—Joints
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J18/00—Arms
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种前馈补偿的电液比例控制系统及多关节液压机械臂,多关节液压机械臂包括肩部旋摆机构、大臂俯仰机构、肘部俯仰机构、前臂、腕部俯仰摆动机构、腕部旋转机构和电液比例阀系统,肩部旋摆机构、大臂俯仰机构、肘部俯仰机构、前臂、腕部俯仰摆动机构、腕部旋转机构依次通过旋转关节连接。本发明采用电液比例阀前馈补偿系统,设计分布式的比例阀模块,贴近执行机构布置,嵌于机械臂内部,同时为满足机械手高精度和高响应的要求,在比例系统PID控制的基础上,采用极点配置的方法对系统进行前馈补偿控制,增加系统的响应频宽,提高系统的响应速度。
Description
技术领域
本发明涉及机械臂技术领域,具体涉及一种前馈补偿的电液比例控制系统及多关节液压机械臂。
背景技术
近些年来,机器人技术发展十分迅速,机器人在工业、农业、服务、医疗、军事等领域获得了广泛应用。机械手臂作为是机器人技术的重要构成,承载各项工作任务的具体执行。其驱动方式常为电驱动和液压驱动,在某些轻载的产线和医疗设备中,也有采用气动的。液压驱动机械手具有运动平稳、负载能力大、快速性好、可实现无级变速等优点,被广应用于核电、破拆救援、水下作业等重载作业场合。在要求精细作业的场合,机械手的控制精度为一个非常重要的指标,高性能灵巧的机械手臂通常有六个运动自由度,再额外增加作业必须的工具或夹持器,常采用电液伺服控制方式,对其稳态、动态控制性能要求较高。但由此也造成了此类液压机械臂的价格高昂,油液的污染敏感度高,维护操作性较差,极大限制了液压高精度机械臂的推广与应用。因此对液压机械臂的液压控制方式、俯仰及旋摆执行机构进行优化,在保证控制精度的前提下,提高液压机械臂的环境适用性和现场维护的便利性,并大幅降低因伺服系统带来的高额成本,具有十分重要的意义。
发明内容
针对现有技术存在的不足,本发明目的是提供一种前馈补偿的电液比例控制系统及多关节液压机械臂,该机械臂具备负载/自重比大,可适应狭小空间的灵活作业,防护等级高、维护便利和性价比高的特点。
本发明的目的可以通过以下所述技术方案来实现:一种前馈补偿的电液比例控制系统及多关节液压机械臂,包括肩部旋摆机构、大臂俯仰机构、肘部俯仰机构、前臂、腕部俯仰摆动机构、腕部旋转机构和电液比例阀系统,肩部旋摆机构、大臂俯仰机构、肘部俯仰机构、前臂、腕部俯仰摆动机构、腕部旋转机构依次通过旋转关节连接,肩部旋摆机构包括控制机械臂肩部旋摆动作的肩部旋摆油缸,大臂俯仰机构包括控制机械臂大臂俯仰动作的大臂俯仰油缸,肘部俯仰机构包括控制机械臂肘部俯仰动作的肘部俯仰油缸,腕部俯仰摆动机构包括控制机械臂腕部俯仰动作的腕部俯仰油缸及控制机械臂腕部摆动动作的腕部摆动油缸,腕部旋转机构包括控制机械臂腕部旋转动作的液压马达,电液比例阀系统通过出油管路为肩部旋摆油缸、大臂俯仰油缸、肘部俯仰油缸、腕部俯仰油缸、腕部摆动油缸及液压马达提供液压油。
优选的,电液比例阀系统包括上油箱、设置于上油箱上的蓄能器及分布式内嵌于机械臂中的第一比例换向阀、第二比例换向阀、第三比例换向阀、第四比例换向阀、第五比例换向阀、第六比例换向阀,上油箱与第一比例换向阀、第二比例换向阀、第三比例换向阀、第四比例换向阀、第五比例换向阀、第六比例换向阀之间分别设置有对应连接的第一压力补偿模块、第二压力补偿模块、第三压力补偿模块、第四压力补偿模块、第五压力补偿模块、第六压力补偿模块,第一压力补偿模块、第二压力补偿模块、第三压力补偿模块、第四压力补偿模块、第五压力补偿模块、第六压力补偿模块分别对第一比例换向阀、第二比例换向阀、第三比例换向阀、第四比例换向阀、第五比例换向阀、第六比例换向阀的进出口压差进行补偿。
优选的,第一压力补偿模块、第二压力补偿模块、第三压力补偿模块、第四压力补偿模块、第五压力补偿模块、第六压力补偿模块均包括定差减压阀和梭阀,各定差减压阀分别与第一比例换向阀、第二比例换向阀、第三比例换向阀、第四比例换向阀、第五比例换向阀、第六比例换向阀的进油管路对应连通,各梭阀分别安装在第一比例换向阀、第二比例换向阀、第三比例换向阀、第四比例换向阀、第五比例换向阀、第六比例换向阀的出油管路上,第一比例换向阀、第二比例换向阀、第三比例换向阀、第四比例换向阀、第五比例换向阀、第六比例换向阀的出油管路上分别安装有与对应梭阀电性连接的压力感应器。
优选的,各定差减压阀分别与第一比例换向阀、第二比例换向阀、第三比例换向阀、第四比例换向阀、第五比例换向阀、第六比例换向阀的进油口对应节流配合。
优选的,第一比例换向阀、第二比例换向阀、第三比例换向阀、第四比例换向阀、第五比例换向阀、第六比例换向阀上均设置有阀芯位移监测器。
优选的,肩部旋摆油缸、肘部俯仰油缸、腕部俯仰油缸、腕部摆动油缸及液压马达的进出油口处均设置有旋转接头。
优选的,大臂俯仰油缸的进出油口处设置有油缸平衡阀。
本发明还提供一种前馈补偿的电液比例控制系统,包括多关节液压机械臂和用于控制多关节液压机械臂运动的电液比例控制方法,电液比例控制方法包括以下步骤:
步骤一、构造电液比例阀系统模型,并采用PID控制器进行控制,令PID控制器的控制律为:
式中,KP—比例系数,TI—积分时间常数,TD—微分时间常数;
步骤二、根据步骤一构建的所述电液比例阀系统模型,通过极点配置法构建三状态前馈控制系统,采用三状态前馈控制系统对消所述电液比例阀系统传递函数距离虚轴较近的极点,令三状态前馈控制器为:
B(s)=Kdr+Kvrs+Kars2
式中,Kdr—三状态前馈位移增益,Kvr—三状态前馈速度增益,Kar—三状态前馈加速度增益;通过采集电液比例阀系统负载的加速度和位移信号,同时合成等效的速度信号,形成对电液比例阀系统的三状态控制系统,应用极点配置原理对电液比例阀系统闭环极点进行重新配置,控制电液比例阀系统频宽的扩展和系统稳定性;
步骤三、基于电液比例阀系统出现的谐振峰特性构建结构滤波器,在三状态前馈控制系统中设置结构滤波器,对电液比例阀系统进行补偿,抵消电液比例阀系统出现的谐振峰,令结构滤波器的传递函数为:
式中,K1——调节中心频率的参数,K2——调节宽度的参数,K3——调节深度的参数;K4——调节低频幅值的参数,K5——调节高频幅值的参数,K6——调节深度的参数,作用与K3相反;
步骤四、通过步骤二构建的三状态前馈控制系统和步骤三构建的结构滤波器形成混合控制系统,利用混合控制系统对电液比例阀系统进行位置伺服驱动。
与现有技术比,本发明的有益效果:1、相比传统以及当前普片应用的伺服阀组集成设计为一个阀组单元,再通过管路连接至各相应的执行机构,本发明设计为紧凑可集成于执行机构或贴近执行机构布置的分布式比例阀模块,且嵌于机械臂内部,既可同时满足机械臂高精度和高响应性要求,又可满足机械臂在特种场合的应用,如需要有严格防爆要求的场景。
2、采用比例换向阀替代目前绝大部分高精度液压机械臂采用的伺服阀,既可大幅降低成本,又因降低了对油液污染的敏感度,大大提升了机械臂的实用性。
3、电液比例阀系统的应用和分布式的布局,也降低了液压机械臂在运行过程中的压损,提升了工作效率,尤其是在减少系统发热有突出的贡献,使得机械臂可以满足连续运行的工况。
4、本发明在电液比例阀系统PID控制的基础上,采用极点配置的方法对系统进行前馈补偿控制,增加系统的响应频宽,提高了液压系统的响应速度。
附图说明
利用附图对本发明作进一步说明,但附图中的实施例不构成对本发明的任何限制,对于本领域的普通技术人员,在不付出创造性劳动的前提下,还可以根据以下附图获得其它的附图。
图1为本发明一种多关节液压机械臂的结构示意图。
图2为本发明一种多关节液压机械臂中电液比例阀系统的示意图。
图3为图2中第一比例换向阀和第一压力补偿模块的放大示意图。
图4为本发明一种前馈补偿的电液比例控制系统中加入前馈控制前的阶跃响应曲线图。
图5为本发明一种前馈补偿的电液比例控制系统中加入前馈控制前的Bode图。
图6为本发明一种前馈补偿的电液比例控制系统中PID控制器的闭环系统零极点图。
图7为本发明一种前馈补偿的电液比例控制系统中加入前馈控制后的系统Bode图。
图8为本发明一种前馈补偿的电液比例控制系统中结构滤波器的频率特性图。
图9为本发明一种前馈补偿的电液比例控制系统中设置结构滤波器后的系统阶跃响应曲线。
图10为本发明一种前馈补偿的电液比例控制系统中设置结构滤波器后的Bode图。
图中所示标号表示为:1、肩部旋摆机构;2、大臂俯仰机构;3、肘部俯仰机构;4、前臂;5、腕部俯仰摆动机构;6、腕部旋转机构;7、上油箱;8、蓄能器;9、肩部旋摆油缸;10、大臂俯仰油缸;11、油缸平衡阀;12、肘部俯仰油缸;13、腕部俯仰油缸;14、腕部摆动油缸;15、液压马达;101、第一比例换向阀;102、第二比例换向阀;103、第三比例换向阀;104、第四比例换向阀;105、第五比例换向阀;106、第六比例换向阀;201、第一压力补偿模块;2011、定差减压阀;2022、梭阀;202、第二压力补偿模块;203、第三压力补偿模块;204、第四压力补偿模块;205、第五压力补偿模块;206、第六压力补偿模块;301、旋转接头。
具体实施方式
需要说明,若本发明实施例中有涉及方向性指示(诸如上、下、左、右、前、后……),则该方向性指示仅用于解释在某一特定姿态(如附图所示)下各部件之间的相对位置关系、运动情况等,如果该特定姿态发生改变时,则该方向性指示也相应地随之改变。
另外,若本发明实施例中有涉及“第一”、“第二”等的描述,则该“第一”、“第二”等的描述仅用于描述目的,而不能理解为指示或暗示其相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。另外,各个实施例之间的技术方案可以相互结合,但是必须是以本领域普通技术人员能够实现为基础,当技术方案的结合出现相互矛盾或无法实现时应当认为这种技术方案的结合不存在,也不在本发明要求的保护范围之内。
下面将结合具体实施例,对本发明的技术方案进行清楚、完整的描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通的技术人员在没有做出创造性劳动的前提下所获得的所有其它实施例,都属于本发明的保护范围。
实施例
请参阅图1-图2,本发明提供一种前馈补偿的电液比例控制系统及多关节液压机械臂,包括肩部旋摆机构1、大臂俯仰机构2、肘部俯仰机构3、前臂4、腕部俯仰摆动机构5、腕部旋转机构6和电液比例阀系统,肩部旋摆机构1、大臂俯仰机构2、肘部俯仰机构3、前臂4、腕部俯仰摆动机构5、腕部旋转机构6依次通过旋转关节连接,肩部旋摆机构1包括控制机械臂肩部旋摆动作的肩部旋摆油缸9,大臂俯仰机构2包括控制机械臂大臂俯仰动作的大臂俯仰油缸10,肘部俯仰机构3包括控制机械臂肘部俯仰动作的肘部俯仰油缸12,腕部俯仰摆动机构5包括控制机械臂腕部俯仰动作的腕部俯仰油缸13及控制机械臂腕部摆动动作的腕部摆动油缸14,腕部旋转机构6包括控制机械臂腕部旋转动作的液压马达15,电液比例阀系统通过出油管路为肩部旋摆油缸9、大臂俯仰油缸10、肘部俯仰油缸12、腕部俯仰油缸13、腕部摆动油缸14及液压马达15提供液压油。
本实施例中,该液压机械臂设计成反铲式,即肘部在上的结构形式,可最大化工作空间,并且可使收拢状态具备尽可能小的体积。该液压机械臂具备有六个自由度,即肩部旋摆、大臂俯仰、肘部俯仰、腕部俯仰、腕部摆动和腕部旋转,所有的动作均通过相关的液压执行机构来实现,其中肩部旋摆、肘部俯仰、腕部俯仰以及腕部摆动均采用液压摆动缸,大臂俯仰采用变幅液压油缸,腕部的旋转采用液压马达,采用电液比例阀前补偿系统,创新设计分布式的比例阀模块,贴近执行机构布置,嵌于机械臂内部,同时为满足机械手高精度和高响应的要求,在比例系统PID控制的基础上,采用极点配置的方法对系统进行前馈补偿控制,增加系统的响应频宽,提高系统的响应速度。
本实施例中,电液比例阀系统包括上油箱7、设置于上油箱7上的蓄能器8及分布式内嵌于机械臂中的第一比例换向阀101、第二比例换向阀102、第三比例换向阀103、第四比例换向阀104、第五比例换向阀105、第六比例换向阀106,上油箱7与第一比例换向阀101、第二比例换向阀102、第三比例换向阀103、第四比例换向阀104、第五比例换向阀105、第六比例换向阀106之间分别设置有对应连接的第一压力补偿模块201、第二压力补偿模块202、第三压力补偿模块203、第四压力补偿模块204、第五压力补偿模块205、第六压力补偿模块206,第一压力补偿模块201、第二压力补偿模块202、第三压力补偿模块203、第四压力补偿模块204、第五压力补偿模块205、第六压力补偿模块206分别对第一比例换向阀101、第二比例换向阀102、第三比例换向阀103、第四比例换向阀104、第五比例换向阀105、第六比例换向阀106的进出口压差进行补偿,肩部旋摆采用液压比例换向阀控制摆动缸的方式,通过比例换向阀的换向,可实现旋摆范围为±180°。
本实施例中,第一压力补偿模块201、第二压力补偿模块202、第三压力补偿模块203、第四压力补偿模块204、第五压力补偿模块205、第六压力补偿模块206均包括定差减压阀2011和梭阀2022,各定差减压阀2011分别与第一比例换向阀101、第二比例换向阀102、第三比例换向阀103、第四比例换向阀104、第五比例换向阀105、第六比例换向阀106的进油管路对应连通,各梭阀2022分别安装在第一比例换向阀101、第二比例换向阀102、第三比例换向阀103、第四比例换向阀104、第五比例换向阀105、第六比例换向阀106的出油管路上,第一比例换向阀101、第二比例换向阀102、第三比例换向阀103、第四比例换向阀104、第五比例换向阀105、第六比例换向阀106的出油管路上分别安装有与对应梭阀2022电性连接的压力感应器,通过梭阀2022选取A、B油路上的最大压力反馈至压力传感器。
本实施例中,各定差减压阀2011分别与第一比例换向阀101、第二比例换向阀102、第三比例换向阀103、第四比例换向阀104、第五比例换向阀105、第六比例换向阀106的进油口对应节流配合,为确保在各执行机构联动时,保持系统压差的恒定,使得流量不因负载压力的变化而变化。
本实施例中,第一比例换向阀101、第二比例换向阀102、第三比例换向阀103、第四比例换向阀104、第五比例换向阀105、第六比例换向阀106上均设置有阀芯位移监测器,通过阀芯位移监测器对各比例换向阀101~106的阀芯位移进行监测,故而可以获得比例换向阀驱动电流大小与阀芯位移及流量的对应曲线,当机械臂各关节联动时,各执行机构A、B口处的压力可以通过布置的压力传感器获取,压力传感器读取到各执行机构的压力值,反馈至控制器,控制器接收到信号后调节控制比例换向阀电流值,配合阀芯位移的监测数据,进行流量的精确调节,并配合压力补偿模块201~206的作用,从而使各执行机构按照需要精准完成各种动作。
本实施例中,肩部旋摆油缸9、肘部俯仰油缸12、腕部俯仰油缸13、腕部摆动油缸14及液压马达15的进出油口处均设置有旋转接头301,通过设置旋转接头301,为防止因大臂俯仰机构2、肘部俯仰机构3、腕部俯仰摆动机构5、腕部旋转机构6的运动使得液压油管发生缠绕和扭曲。
本实施例中,大臂俯仰油缸10的进出油口处设置有油缸平衡阀11,在某些应用场景中,需要在断开液压动力源时仍使大臂俯仰油缸10保持其位置,故在其进出油口处设置油缸平衡阀11,为兼顾油缸位置保持和大臂抬起后不因油缸泄漏或突然切断动力导致大臂快速下落,损坏机械臂、搭载的作业装置和伤及操作维护人员。
参考图1-图10,本发明还提供一种前馈补偿的电液比例控制系统,包括多关节液压机械臂和用于控制多关节液压机械臂运动的电液比例控制方法,电液比例控制方法包括以下步骤:
(1)构造电液比例阀系统模型,并采用PID控制器进行控制,PID控制是工业界技术最为成熟,也最常用的控制方法,其参数整定方便,易于实现,控制效果显著,令PID控制器的控制律为:
式中,KP—比例系数,TI—积分时间常数,TD—微分时间常数;利用MATLAB/Simulink工具,构造电液位置伺服系统模型,并采用PID控制器进行仿真,当指令输入为20mm,等效负载为50kg时,系统的阶跃响应曲线和Bode图分别如图4、图5所示,其上升时间约为0.1s,稳定时间约为0.5s,幅频响应-3dB时频率约为3.25Hz,频宽较低。从Bode图中看出,系统在68Hz左右,即液压固有频率处有一个谐振峰,降低了系统幅值裕量。若要在不降低系统快速性的前提下提高系统幅值裕量,或在不降低幅值裕量的前提下提高系统快速性,需要提高系统阻尼比。由上述分析,液压动力机构的阻尼很小,使用PID控制器进行控制时系统频宽较低,若要增加系统频宽,可使用极点配置的方法对系统进行补偿。但由于液压位置伺服系统的阻尼较小,其幅频特性在液压固有频率处有谐振峰,影响系统的稳定性,还需要设计结构滤波器来抵消谐振峰的影响。
(2)根据步骤一构建的所述电液比例阀系统模型,通过极点配置法构建三状态前馈控制系统,根据PID控制器的闭环系统零极点图(图6所示),从图中可以看出在1.63Hz和68.5Hz处有两对极点,其中1.63Hz处极点距虚轴较近,对系统响应影响较大,采用极点配置方法消除其影响;68.5Hz即为液压固有频率,可以看到该处的阻尼比较小,只有0.04,使系统幅频响应受到谐振影响,该谐振与负载有关,使用结构滤波器来消除其影响。根据零极点分布图,采用三状态前馈控制系统对消所述电液比例阀系统传递函数距离虚轴较近的极点,即抵消1.63Hz处的共轭极点,经仿真,加入前馈控制后的系统Bode图如图7所示,从加入三状态前馈控制系统后的Bode图可以看出,由于系统谐振的存在,系统是不稳定的,由于此谐振与系统负载相关,可使用结构滤波器消除其影响,令三状态前馈控制器为:
B(s)=Kdr+Kvrs+Kars2
式中,Kdr—三状态前馈位移增益,Kvr—三状态前馈速度增益,Kar—三状态前馈加速度增益;通过采集电液比例阀系统负载的加速度和位移信号,同时合成等效的速度信号,形成对电液比例阀系统的三状态控制系统,应用极点配置原理对电液比例阀系统闭环极点进行重新配置,控制电液比例阀系统频宽的扩展和系统稳定性;
步骤三、基于电液比例阀系统出现的谐振峰特性构建结构滤波器,在三状态前馈控制系统中设置结构滤波器,对电液比例阀系统进行补偿,抵消电液比例阀系统出现的谐振峰,令结构滤波器的传递函数为:
式中,K1——调节中心频率的参数,K2——调节宽度的参数,K3——调节深度的参数;K4——调节低频幅值的参数,K5——调节高频幅值的参数,K6——调节深度的参数,作用与K3相反;设计一个中心频率为68.5Hz,深度为-21dB的结构滤波器,各参数如表1所示,滤波器的频率特性如图8所示,
表1结构滤波器参数
在系统前馈控制环节中设置结构滤波器,经仿真,可得系统阶跃响应曲线和Bode图分别如图9、图10所示,当指令输入为20mm,等效负载为50kg时,其上升时间约为0.05s,稳定时间约为0.15s,幅频响应-3dB时频率约为83Hz,控制性能详见表2。
表2系统控制性能表
性能指标 | PID控制 | 加入前馈补偿控制后 |
阶跃响应上升时间 | 0.1s | 0.05s |
阶跃响应稳定时间 | 0.5s | 0.15s |
频宽 | 3.25Hz | 83Hz |
从表2可得出,与未加前馈补偿控制前的系统响应比较,加入前馈补偿控制后控制性能得到很大提升。
步骤四、通过步骤二构建的三状态前馈控制系统和步骤三构建的结构滤波器形成混合控制系统,利用混合控制系统对电液比例阀系统进行位置伺服驱动。
具体使用时,上油箱7的压力油经进油口P1~P6进入压力补偿模块201~206中,然后经定差减压阀2011进入比例换向阀101~106的进油口P。如图2示,比例换向阀101~106左侧得电,比例换向阀101~106的P口与B口连通,油液经P口流到B口,然后经由旋转接头301进入各执行机构的工作油口B,再由各执行机构的A口流出,然后油液至比例换向阀的A口,因比例换向阀的A口与T口连通,顾而油液经比例换向阀的A口至T口,再经管道流回油箱,从而驱动各执行机构朝一个方向运动。反之,当比例换向阀101~106的右侧得电,则驱动执行结构朝相反的方向运动。
以上借助具体实施例对本发明做了进一步描述,但是应该理解的是,这里具体的描述,不应理解为对本发明的实质和范围的限定,本领域内的普通技术人员在阅读本说明书后对上述实施例做出的各种修改,都属于本发明所保护的范围。
Claims (8)
1.一种多关节液压机械臂,其特征在于:包括肩部旋摆机构(1)、大臂俯仰机构(2)、肘部俯仰机构(3)、前臂(4)、腕部俯仰摆动机构(5)、腕部旋转机构(6)和电液比例阀系统,所述肩部旋摆机构(1)、大臂俯仰机构(2)、肘部俯仰机构(3)、前臂(4)、腕部俯仰摆动机构(5)、腕部旋转机构(6)依次通过旋转关节连接,所述肩部旋摆机构(1)包括控制机械臂肩部旋摆动作的肩部旋摆油缸(9),所述大臂俯仰机构(2)包括控制机械臂大臂俯仰动作的大臂俯仰油缸(10),所述肘部俯仰机构(3)包括控制机械臂肘部俯仰动作的肘部俯仰油缸(12),所述腕部俯仰摆动机构(5)包括控制机械臂腕部俯仰动作的腕部俯仰油缸(13)及控制机械臂腕部摆动动作的腕部摆动油缸(14),所述腕部旋转机构(6)包括控制机械臂腕部旋转动作的液压马达(15),所述电液比例阀系统通过出油管路为所述肩部旋摆油缸(9)、大臂俯仰油缸(10)、肘部俯仰油缸(12)、腕部俯仰油缸(13)、腕部摆动油缸(14)及液压马达(15)提供液压油。
2.根据权利要求1所述的一种多关节液压机械臂,其特征在于:所述电液比例阀系统包括上油箱(7)、设置于上油箱(7)上的蓄能器(8)及分布式内嵌于机械臂中的第一比例换向阀(101)、第二比例换向阀(102)、第三比例换向阀(103)、第四比例换向阀(104)、第五比例换向阀(105)、第六比例换向阀(106),所述第一比例换向阀(101)、第二比例换向阀(102)、第三比例换向阀(103)、第四比例换向阀(104)、第五比例换向阀(105)、第六比例换向阀(106)分别与上油箱(7)之间设置有对应连接的第一压力补偿模块(201)、第二压力补偿模块(202)、第三压力补偿模块(203)、第四压力补偿模块(204)、第五压力补偿模块(205)、第六压力补偿模块(206),所述第一压力补偿模块(201)、第二压力补偿模块(202)、第三压力补偿模块(203)、第四压力补偿模块(204)、第五压力补偿模块(205)、第六压力补偿模块(206)分别对所述第一比例换向阀(101)、第二比例换向阀(102)、第三比例换向阀(103)、第四比例换向阀(104)、第五比例换向阀(105)、第六比例换向阀(106)的进出口压差进行补偿。
3.根据权利要求2所述的一种多关节液压机械臂,其特征在于:所述第一压力补偿模块(201)、第二压力补偿模块(202)、第三压力补偿模块(203)、第四压力补偿模块(204)、第五压力补偿模块(205)、第六压力补偿模块(206)均包括定差减压阀(2011)和梭阀(2022),各所述定差减压阀2011分别与第一比例换向阀(101)、第二比例换向阀(102)、第三比例换向阀(103)、第四比例换向阀(104)、第五比例换向阀(105)、第六比例换向阀(106)的进油管路对应连通,各所述梭阀(2022)分别安装在所述第一比例换向阀(101)、第二比例换向阀(102)、第三比例换向阀(103)、第四比例换向阀(104)、第五比例换向阀(105)、第六比例换向阀(106)的出油管路上,所述第一比例换向阀(101)、第二比例换向阀(102)、第三比例换向阀(103)、第四比例换向阀(104)、第五比例换向阀(105)、第六比例换向阀(106)的出油管路上分别安装有与对应所述梭阀(2022)电性连接的压力感应器。
4.根据权利要求3所述的一种多关节液压机械臂,其特征在于:各所述定差减压阀2011分别与所述第一比例换向阀(101)、第二比例换向阀(102)、第三比例换向阀(103)、第四比例换向阀(104)、第五比例换向阀(105)、第六比例换向阀(106)的进油口对应节流配合。
5.根据权利要求2所述的一种多关节液压机械臂,其特征在于:所述第一比例换向阀(101)、第二比例换向阀(102)、第三比例换向阀(103)、第四比例换向阀(104)、第五比例换向阀(105)、第六比例换向阀(106)上均设置有阀芯位移监测器。
6.根据权利要求1所述的一种多关节液压机械臂,其特征在于:所述肩部旋摆油缸(9)、肘部俯仰油缸(12)、腕部俯仰油缸(13)、腕部摆动油缸(14)及液压马达(15)的进出油口处均设置有旋转接头(301)。
7.根据权利要求1所述的一种多关节液压机械臂,其特征在于:所述大臂俯仰油缸(10)的进出油口处设置有油缸平衡阀(11)。
8.一种前馈补偿的电液比例控制系统,其特征在于,包括如权利要求1~7任一项所述的多关节液压机械臂和用于控制所述多关节液压机械臂运动的电液比例控制方法,所述电液比例控制方法包括以下步骤:
步骤一、构建电液比例阀系统模型,并采用PID控制器进行控制;
步骤二、根据步骤一构建的所述电液比例阀系统模型,采用三状态前馈控制器对消系统闭环传递函数靠近虚轴的极点,当系统具有二阶振荡特性时,对消其二阶振荡因子;当系统具有一阶惯性特性时,对消其一阶惯性因子,
令三状态前馈控制器为:
B(s)=Kdr+Kvrs+Kars2
式中,Kdr为三状态前馈位移增益,Kvr为三状态前馈速度增益,Kar为三状态前馈加速度增益;通过采集电液比例阀系统负载的加速度和位移信号,同时合成等效的速度信号,形成对电液比例阀的三状态控制系统,采用极点配置原理对电液比例阀系统的闭环极点进行重新配置,控制电液比例阀系统频宽的扩展和系统稳定性;
步骤三、根据电液比例阀系统出现的谐振峰特性构建结构滤波器,在所述三状态前馈控制系统中设置结构滤波器,通过所述结构滤波器对电液比例阀系统进行补偿,设计结构滤波器的中心频率和深度来抵消电液比例阀系统出现的谐振峰;
步骤四、通过步骤二构建的三状态前馈控制系统和步骤三构建的结构滤波器形成混合控制系统,利用混合控制系统对电液比例阀系统进行位置伺服驱动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111579614.6A CN114055478A (zh) | 2021-12-22 | 2021-12-22 | 一种前馈补偿的电液比例控制系统及多关节液压机械臂 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111579614.6A CN114055478A (zh) | 2021-12-22 | 2021-12-22 | 一种前馈补偿的电液比例控制系统及多关节液压机械臂 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114055478A true CN114055478A (zh) | 2022-02-18 |
Family
ID=80230174
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111579614.6A Pending CN114055478A (zh) | 2021-12-22 | 2021-12-22 | 一种前馈补偿的电液比例控制系统及多关节液压机械臂 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114055478A (zh) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106762884A (zh) * | 2017-03-13 | 2017-05-31 | 浙江大学 | 基于压力补偿的tbm竖向调向液压系统 |
CN110118208A (zh) * | 2019-04-19 | 2019-08-13 | 武汉智仁传控技术有限公司 | 适用于机械臂的液压系统和机械臂 |
CN113001523A (zh) * | 2021-04-09 | 2021-06-22 | 山东大学 | 一种四足双臂机器人及其运行模式 |
-
2021
- 2021-12-22 CN CN202111579614.6A patent/CN114055478A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106762884A (zh) * | 2017-03-13 | 2017-05-31 | 浙江大学 | 基于压力补偿的tbm竖向调向液压系统 |
CN110118208A (zh) * | 2019-04-19 | 2019-08-13 | 武汉智仁传控技术有限公司 | 适用于机械臂的液压系统和机械臂 |
CN113001523A (zh) * | 2021-04-09 | 2021-06-22 | 山东大学 | 一种四足双臂机器人及其运行模式 |
Non-Patent Citations (1)
Title |
---|
王鸿飞;严允;罗凌波;晏红文;: "水下机械手电液伺服系统前馈补偿控制策略研究", 控制与信息技术, no. 03, 5 June 2020 (2020-06-05), pages 8 - 13 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108196445B (zh) | 一种基于双闭环自抗扰的水下机器人姿态与位置控制方法 | |
Zhihui et al. | Analysis of the dynamic performance of an electro-hydrostatic actuator and improvement methods | |
CN106607901A (zh) | 一种3自由度气动串联机械手的关节控制器 | |
Yuan et al. | Nonlinear adaptive robust precision pointing control of tank servo systems | |
Bu et al. | Nonlinear model based coordinated adaptive robust control of electro-hydraulic robotic arms via overparametrizing method | |
CN114055478A (zh) | 一种前馈补偿的电液比例控制系统及多关节液压机械臂 | |
CN112196856B (zh) | 一种电传动设备的液压系统及其控制方法 | |
CN110630596B (zh) | 一种水下冗余液压机械臂及其工作方法 | |
Qin et al. | Design and analysis of the hydraulic driving system for the circular transfer platform of the CFETR divertor | |
CN212044723U (zh) | 一种带弹簧平衡缸装置的重载荷通用型多关节机器人 | |
Misir et al. | Graphical stability analysis for a fuzzy PID controlled robot arm model | |
Li et al. | Real-time flow optimization of hydraulic manipulator with one degree of redundancy considering joint limit constraint | |
Li et al. | Robust control of a two-link flexible manipulator with neural networks based quasi-static deflection compensation | |
Liu et al. | Position-pose control of a pneumatic 3-upu robot based on immersion and invariance | |
Bejczy et al. | Robust robot arm control with nonlinear feedback | |
CN110273876A (zh) | 针对阀控缸力阻抗控制系统的外环阻抗补偿方法及系统 | |
Liu et al. | Trajectory tracking and vibration control of vehicle hydraulic rigid—Flexible manipulator with input constraints | |
CN205466220U (zh) | 焊锡机器人的主机控制系统 | |
Wang et al. | Study on positioning control of transfer robot with solar cell | |
CN114810732A (zh) | 一种两自由度电液运动平台的高频干扰力补偿方法 | |
Chen et al. | Fuzzy controller design for positioning and synchronization of electrohydraulic system | |
CN202996309U (zh) | 一种三自由度位姿调整平台 | |
CN211899701U (zh) | 带有臂架减震系统的泵车 | |
Cheng et al. | Real-Time Anti-Saturation Flow Optimization Algorithm of the Redundant Hydraulic Manipulator. Actuators 2021, 10, 11 | |
Komarov | Tip control of a log crane with mobile hydraulic proportional valves |
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 |