一种机械臂及智能控制技术制造技术

一种机械臂及智能控制技术，结构新颖，工作原理清晰，利用液压控制装置可以实现机械臂伸缩过程中运动抖动的补偿功能，采用智能控制液压装置供油与机械臂运功关系分析相结合方式，运动模型分析中采用模糊pid遗传算法，补偿运动状态下的机械臂抖动，由单位阶跃响应曲线，对该进行具象化分析，于pid算法相对比，分析出该对机械臂抖动补偿的提高性。大大缩短了机械臂在运动过程中到达稳态的时间。

A kind of mechanical arm and intelligent control technology

【技术实现步骤摘要】
一种机械臂及智能控制技术
本专利技术涉及一种机械臂及智能控制技术，属于机械臂机领域，具体的是一种基于机械臂运动抖动补偿的模糊pid遗传智能控制算法。
技术介绍
随着机械臂技术的公开，很多行业对机械臂的使用和性能提出了新要求，传统的机械臂运动带来的问题，给生产发展自动化造成了制约，而随着计算机和数字信息技术的发展和完善，人们开始依靠智能控制算法来改善机械运动模糊pid智能控制算法在控制运动中越来越重要的地位，而在智能控制算法领域，某些智能控制算法也不断的进步和改善优化，例如温控，调节距离等，这些都是依靠控制智能控制算法来处理，在这样的情况下，出现了机械臂抖动补偿pid遗传智能控制算法。
技术实现思路
本专利技术的目的在于针对现有机械臂运动过程的抖动幅度大，提供一种基于模糊pid遗传智能控制算法改良的机械臂抖动补偿控制技术，以实现机械臂运动抖动的减小。本专利技术的技术方案：一种机械臂及智能控制技术，其特征是，该智能控制技术是基于机械臂运动抖动补偿的模糊pid遗传智能控制算法，包括如下步骤：步骤1，建立机械臂运动系统模型,包括：液压系统，载物装置，机械臂。机械臂由四伸臂组成，其中每个伸臂与图1所示滑轮组和5条拉索相结合，形成机械臂，每个伸臂之间采用嵌套组合的方式，接触端采用滑块导向运动，在机械臂中，1,2,3号为伸出拉索，4,5号为回缩拉索；1号拉索：一伸臂拉动二伸臂伸出，ν0＝0；ν1＝ν油缸；ν2＝2ν1，2号拉索：二伸臂拉动三伸臂伸出，ν1＝ν油缸将一伸臂看做静止,ν1’＝0，ν2’＝2ν1-ν1＝ν1；ν3’＝2ν2’＝2ν1；ν3＝ν3’+ν1＝2ν1+ν1＝3ν1；3号拉索：三伸臂拉动四伸臂伸出，将二伸臂看成静止，ν2’＝0,ν3’＝3ν1-2ν1＝ν1；ν4’＝2ν3’＝2ν1；ν4＝2ν4’+2ν1＝2ν1+2ν1＝4ν1，臂伸出速度总结ν0＝0,ν1＝ν1,ν2＝2ν1,ν3＝3ν1,ν4＝4ν1，4号拉索：一伸臂拉动二伸臂回缩，ν1＝ν油缸，ν0＝0,ν2＝2ν1，5号拉索：二伸臂拉动四伸臂回缩，将二伸臂看做静止，则ν1’＝-ν1(-表示方向相反)，ν4’＝2ν1,ν4＝4ν1，臂回缩速度ν0＝0,ν1＝ν1,ν2＝2ν1,ν3＝3ν1,ν4＝4ν1。ν0表示基本臂速度，ν1表示一伸臂速度，ν2表示二伸臂速度，ν3表示三伸臂速度，ν4表示四伸臂速度，ν1’表示一伸臂相对速度，ν2’表示二伸臂相对速度，ν3’表示三伸臂相对速度，ν4’表示四伸臂相对速度。步骤2，采集机械臂参数信息获取机械臂液压系统的活塞有杆腔面积A2，活塞无杆腔面积A1，Cip为液压缸活塞内泄漏系数，CIp为液压缸活塞外泄漏系数，Ctp为液压缸活塞有效泄漏系数Ctp＝Cip+CIp/2，V1为无杆腔体积，V2为有杆腔体积，液压油体积弹性模量为Ec。步骤3，求解机械臂模型系统中机械伸臂的伸出部分和载重物部分的抖动之间的函数关系xp＝tan(θ)y(t)。步骤4，建立求解产品运动过程的供油流量与抖动幅度传递函数G(s)＝4tan(θ)(ApS+(iV1S(2Ec(1+i2))-1+Kc)MS2(Ap)-1)-1。步骤5，对求解出的控制系统传递函数利用模糊pid遗传智能控制算法计算参数并获得阶跃响应曲线，与pid智能控制算法进行比较。步骤4具体包括以下步骤:伺服阀流量方程：q＝KqXν-KcPl；液压缸受力平衡方程：液压缸无杆腔和有杆腔的流量分别为q＝(q1+q2)/2；活塞杆伸出量与抖动幅度关系方程为xp＝tan(θ)y(t)，式中，t为时间，m为与液压缸活塞杆相连的伸出部分全部物体质量之和，dpi/dt为压强的微分，活塞压力差为PL，伺服阀的流量增益系数为Kq，伺服阀的流量压力系数为Kc，阀芯的偏移量为Xν，q是负载流量，y(t)是活塞关于时间运动量，为活塞运动速度，为活塞运动加速度，液压油体积弹性模量为Ec，q1为无杆腔流量，A1为无杆腔的活塞面积，P1为无杆腔的液压油压力，V1为无杆腔体积，A2为有杆腔的活塞面积，P2为有杆腔的液压油压力，V2为有杆腔体积，q2为有杆腔流量f(t)为负载阻力，Cip为液压缸活塞内泄漏系数；CIp为液压缸活塞外泄漏系数，Ctp为液压缸活塞有效泄漏系数Ctp＝Cip+CIp/2，xp为抖动幅度，θ为偏移角度，Ap为有效作用面积。优选的，控制系统的传递函数求解出传递函数为：G(s)＝4tan(θ)(ApS+(iV1S(2Ec(1+i2))-1+Kc)MS2(Ap)-1)-1其中i为无杆腔比有杆腔面积比，S为与频率相关的变量，M为伸臂及伸臂端负载物体的质量，以分析信号频谱上的特性，在pid智能控制算法中是偏差e(t)＝uo(t)-ui(t)修正改善性能，而G(s)＝L[uo(t)]/L[ui(t)]，uo(t)为输出信号，ui(t)为输入信号，L[]为拉普拉斯变换求解传递函数G[s]。优选的，步骤5对于求解模糊pid遗传智能控制算法参数和阶跃响应曲线对比过程：基于求解出的传递函数，当改善后的智能控制算法图超调量小于改善前的智能控制算法图，并且改善后的智能控制算法图趋于无穷稳定幅值的速率快于改善前的智能控制算法图，输出模糊pid遗传智能控制算法参数。本专利技术的特征在于建立函数关系，计算传递函数，将传递函数进行pid控制，进行模糊pid遗传智能控制算法。本专利技术的有益效果为：本专利技术提出的一种机械臂及智能控制技术，结构新颖，工作原理清晰，利用液压控制装置可以实现机械臂伸缩过程中运动抖动的补偿功能，采用智能控制液压装置供油与机械臂运功关系分析相结合方式，运动模型分析中采用模糊pid遗传算法，补偿运动状态下的机械臂抖动，由单位阶跃响应曲线，对该进行具象化分析，于pid算法相对比，分析出该对机械臂抖动补偿的提高性。大大缩短了机械臂在运动过程中到达稳态的时间。附图说明图1为本专利技术的基于机械臂的伸臂伸出部分及其运动关系示意图；图2为本专利技术的基于流量运动关系的液压缸供油关系图；图3为改进前Kp取0.608，Ki取0.0441，Kd取0.0068传统PID的MATLAB阶跃响应图；图4为改进后的模糊pid遗传智能控制算法的阶跃响应图，模糊pid遗传智能控制算法计算出的Kp为19.6905,Ki为0.0312,Kd为0.0035。具体实施方式为了说明本专利技术的技术方案以及技术目的，下面结合附图及具体事例对本专利技术做进一步介绍。结合图2本专利技术的一种机械臂及智能控制技术，该智能控制技术是基于机械臂运动抖动补偿的模糊pid遗传智能控制算法，包括以下步骤：步骤1，采集产品的伸出长度，位置信息，载重质量液压泵供油，使得机械臂开始伸出，使得末端的位移传感器接收运动信息，并通过水平仪得到角度的偏移量，对数据进行记录处理，取合适值，确定产品信息。步骤本文档来自技高网...

【技术保护点】
1.一种机械臂及智能控制技术，其特征是，该智能控制技术是基于机械臂运动抖动补偿的模糊pid遗传智能控制算法，包括以下步骤：/n步骤1，建立机械臂运动系统模型，包括：液压系统，载物装置，机械臂；机械臂由四伸臂组成，其中每个伸臂通过滑轮组和5条拉索采用嵌套组合形成机械臂，接触端采用滑块导向运动；1、2、3号为伸出拉索，4、5号为回缩拉索；/n1号拉索：一伸臂拉动二伸臂伸出，V

【技术特征摘要】
1.一种机械臂及智能控制技术，其特征是，该智能控制技术是基于机械臂运动抖动补偿的模糊pid遗传智能控制算法，包括以下步骤：
步骤1，建立机械臂运动系统模型，包括：液压系统，载物装置，机械臂；机械臂由四伸臂组成，其中每个伸臂通过滑轮组和5条拉索采用嵌套组合形成机械臂，接触端采用滑块导向运动；1、2、3号为伸出拉索，4、5号为回缩拉索；
1号拉索：一伸臂拉动二伸臂伸出，V0＝0；V1＝V油缸；V2＝2V1；
2号拉索：二伸臂拉动三伸臂伸出，V1＝V油缸将一伸臂看做静止,V1’＝0，V2’＝2V1-V1＝V1；V3’＝2V2’＝2V1；V3＝V3’+V1＝2V1+V1＝3V1；
3号拉索：三伸臂拉动四伸臂伸出，将二伸臂看成静止，V2’＝0,V3’＝3V1-2V1＝V1；V4’＝2V3’＝2V1；V4＝2V4’+2V1＝2V1+2V1＝4V1，臂伸出速度总结V0＝0,V1＝V1,V2＝2V1,V3＝3V1,V4＝4V1；
4号拉索：一伸臂拉动二伸臂回缩，V1＝V油缸，V0＝0,V2＝2V1；
5号拉索：二伸臂拉动四伸臂回缩，将二伸臂看做静止，则V1’＝-V1，-表示方向相反，V4’＝2V1,V4＝4V1；
臂回缩速度V0＝0,V1＝V1,V2＝2V1,V3＝3V1,V4＝4V1；
步骤2，采集机械臂参数信息获取机械臂液压系统的活塞有杆腔面积A2，活塞无杆腔面积A1，Cip为液压缸活塞内泄漏系数；CIp为液压缸活塞外泄漏系数，Ctp为液压缸活塞有效泄漏系数Ctp＝Cip+CIp/2，V1为无杆腔体积，V2为有杆腔体积，液压油体积弹性模量为Ec；
步骤3，求解机械臂模型系统中机械伸臂的伸出部分和载重物部分的抖动之间的函数关系xp＝tan(θ)y(t)；
步骤4，建立求解产品运动过程的供油流量与抖动幅度传递函数G(s)＝4tan(θ)(ApS+(iV1S(2Ec(1+i2))-1+Kc)MS2(Ap)-1)-1；
步骤5，对求解出的控制系统传递函数利用模糊pid遗传...

【专利技术属性】
技术研发人员：张燕军，韩甲文，缪宏，葛文军，张善文，刘思幸，
申请(专利权)人：扬州大学，
类型：发明
国别省市：江苏;32