长春理工大学学报（自然科学版）
Journal of Changchun University of Science and Technology （Natural Science Edition ）
Vol.44No.3Jun.2021
第44卷第3期2021年6月
收稿日期：2020-01-08
基金项目：吉林省科技厅重点技术攻关项目（20190302019GX ）
作者简介：王红平（1976-），女，博士，副教授，E-mail ：*****************
王红平，熊梦强，马国庆
（长春理工大学
机电工程学院，长春
130022）
摘要：为了提高工件表面的磨抛质量，提出一种基于模糊PID 的恒力控制算法，以打磨压力误差e 和压力误差变化 率e c 为输入变量，将模糊控制与普通PID 结合，对打磨头的压力和位置进行控制。文中将该方法与传统PID 方法进行仿真对比，并基于FANUC 机器人构建恒力打磨平台，结果表明：该方法具有更快的调节速度、更小的超调量和良好的稳定性，恒力磨抛的工件表面粗糙度在0.18~0.22μm 之间，有效地提高了磨抛质量。关键词：磨抛质量；模糊PID ；恒力控制；表面粗糙度中图分类号：TP273 文献标志码：A
文章编号：1672-9870（2021）03-0034-06
Research on Robot Constant Force Grinding and Polishing Control Based on Fuzzy PID
WANG Hong-ping ，XIONG Meng-qiang ，MA Guo-qing
（School of Mechanical Engineering ，Changchun University of Science and Technology ，Changchun 130022）
Abstract ：In order to improve the grinding and polishing quality of the workpiece surface ，a constant force control method based on fuzzy PID is proposed in this paper.The grinding pressure error e and pressure error change rate ec are used as input variables.The fuzzy adaptive tuning PID method is used to achieve constant force grinding of the robot.In this paper ，this method is compared with the traditional PID method ，and the constant surface grinding based on the FANUC robot is used to perform the actual plane grinding experiment.The results show that the method has faster adjustment speed ，smaller overshoot ，and good stability.The surface roughness of the workpiece with constant force grinding and polishing is between 0.18-0.22μm ，which effectively improves the quality of grinding and polishing.Key words ：grinding and polishing quality ；fuzzy PID ；constant force control ；surface roughness
近年来，随着现代制造技术的发展，人们对各种产品的外观需求越来越高，如：卫浴产品、生活电器外壳、工艺品等，传统手工打磨加工的产品表面质量稳定性无法保证。同时加工环境非常恶劣，对工人身体有严重的危害［1］。对于企业而言，传统手工打磨不仅管理成本高，工人工资成本高，并且加工效率和加工质量也得不到保证，严重影响了企业的经济效益。所以，需要 一种高效的打磨抛光方式来代替手工打磨。传统数控加工技术虽然应用更加成熟，但是通常采用刚性磨削，导致磨抛一致性比较差的工件时会出现比较大的轮廓偏差，并且对复杂轮廓加工的适应性比较
差。而机器人打磨更加灵活，可以通过与各种类型的打磨工具结合来完美的避免这一情况的发生。将工业机器人与打磨工艺相结合实现全自动打磨加工是目前工业
领域的研究重点之一［2］。
Farzad Rafieian 等人［3］对机器人打磨工艺过
程中的循环冲击振荡进行了分析。谌鸿强等
人［4］研究不同粒度的磨具在打磨过程中的粗糙度变化，建立粗糙度下降与打磨前粗糙度的模型，优化磨具粒度的选择组合方案；孔袁莉等人［5］采用PLC 控制打磨机器人，实现对复杂曲面的打磨抛光，并设计控制系统实现全自动打磨抛光，极大地提高了打磨加工的效率；西安科技大学学者贺文海［6］采用模糊PID 控制与模糊控制相结合的方法，对掘进机恒功率控制系统进行了设计，相比于传统PID 控制具有更好的动态性能和鲁棒性；杨益兴［7］进行了模糊PID 控制的Simulink 仿真，验证其控制灵活的特点。
本文针对机器人打磨过程中的力和位置控
制进行了研究，基于对力和位置的双闭环控制，设计了相应的模糊PID 控制器，将模糊算法同传统的PID 相结合，利用MATLAB 进行了控制仿真，最后利用机器人离线编程软件实际进行机器人恒力打磨
加工实验。
1
机器人打磨系统整体方案
1.1
打磨系统工作原理
本文采用了机器人加气动打磨头的自适应
打磨系统，通过上位机编写算法控制力位执行器并非完全依靠机器人的定位精度来实现压力控制，同时在上位机上利用离线编程软件对打磨路径进行规划。从而使系统具有一定的柔性。其结构原理图如图1
所示。安全刀具
图1系统结构原理图
由图1可以看出机器人与上位机控制器实
时通讯，根据预先规划的轨迹，对打磨压力、打磨速度、执行器行程等参数的调控。上位机根据压力和位置传感器反馈的数据，控制比例阀，调节气缸的进出压力，从而对打磨压力进行控制，通过比例流量阀调节气动打磨头的转速，进一步保证了打磨质量。1.2
系统方案设计
根据系统结构原理分析，进行整体系统设计。如图2所示，打磨机器人系统主要分为5个部分，包括机器人本体、上位机控制器、末端执行器（包含力传感器、位置传感器、气缸等元器件）、打磨工具、动力源。机器人采用发那科公司的六自由度关节型机器人，型号为M20-iA ，负载能力为20kg
。
图2
打磨机器人系统构成
2
模糊PID 控制器设计
2.1
机器人打磨系统控制原理
根据设计打磨的打磨机器人系统，将打磨装
置简化为如图3
所示的力平衡模型。
图3
打磨头执行器系统简化模型
王红平，等：基于模糊PID 的机器人恒力磨抛控制研究
第3期35
长春理工大学学报（自然科学版）2021年
建立力平衡方程：
M d 2y d t +c d y d t
+F n =(p d 1+p d 2)-μF n sin θ（1）M d 2y d t
2+c d y d t +F n =(p d 1+p d 2)-(F t 1+F t 2)
（2）
式中，
M 为气缸的质量；c 为粘性阻尼系数；F n 为打磨头机构输出力；
F t1、F t2为两气缸所受摩擦力；
y 为气缸伸缩行程；p d 1、p d 2表示两气缸内气体压力［8］。
将式（1）拉普拉斯变换后得到：
Ms 2Y (s )+csY (s )+F n (s )=p d (s )A d -μF n (s )sin θ
（3）
式中，
A d 表示缸内无杆腔一侧的横截面积。在力F n 作用下，打磨头产生位移量y 。等效的刚度系数设为K e ，则有：
F n (s )=K e Y (s )
（4）
联立方程可得机器人打磨系统输入气体压力与输出打磨力之间的关系为：
F n (s )=
K e A d
Ms 2+cs +K e (1+μsin θ)
p d (s )（5）
由此建立机器人打磨系统的控制方案，如图4所示。2.2
模糊PID 控制原理
模糊PID 控制器的结构如图5所示，结合实际要求，以系统反馈的压力与压力设定值的偏差e 、压力偏差变化率e c 为模糊PID 控制器的输入变量，通过模糊推理，输出ΔK p 、
ΔK i 、ΔK d 用来调整PID 控制器中K p 、K i 、K d 的值，进而调节压缩
气缸的伸缩行程，从而使系统更加稳定［9］
。
图5
模糊PID 控制器结构框图
2.3隶属度函数与模糊规则表的制定
定义压力偏差e 、压力偏差变化率ec 、和
ΔK p 、ΔK i 、ΔK d 的模糊子集为{NB ，NM ，NS ，ZO ，PS ，PM ，PB}，子集中元素从左到右分别表示负大、负中、负小、零、正小、正中、正大。经实验采集相关数据分析后，可知输入偏差e 和偏差变化率在［-33］范围内变化，所以取模糊论域为［-3，3］，即e ，e c ={-3，-2，-1，0，1，2，3}，输出值K p 、K i 、K d 物理论域为{-2，-1，0，1，2}，各变量的隶属
度函数为三角函数，如图6
所示。
图6
隶属度函数曲线
图4基于位置控制的力/位混合控制系统框图
36
根据压力偏差和偏差变化率综合确定模糊规则，建立ΔK p、ΔK i、ΔK d的模糊规则，如表1所示。
表1模糊控制规则表
e
N B
充气包装袋N M
N S
Z O
P S
P M
P B
e
c
NB
NB
PBpcti
NS
NB
健身茶PB
PS
PM
NB
ZO
PM
M
ZO
PS
M
ZO
PS
ZO
PB
ZO
ZO
PB
NM
NB
PB
NS
NB
PB
PS
PM
NM
NS
PM
NM
NS
PS
NS
ZO
ZO
ZO
NS
ZO
ZO
PM
NS
NM
PB
ZO
NM
PM
PS
PM
NS
NM
PS
NS
NS
ZO
ZO
ZO
NS
PS
PS
NM
PS
NM
ZO
NM
PM
ZO
NM
PM
PS
PS
NS
NM
ZO
ZO
NS
NS
PS
ZO
NM
PS
PS
NM
PM
NM
PS
NS
PM
ZO
NS
PS
ZO
ZO
ZO
NS
NS
PS
NS
NS
PS
ZO
NM
PM
PS
NM
PM
PS
PM
NS
ZO
NB
ZO
ZO
PS
NS
PS
NS
NM
PM
NS
NM
PM
ZO
NM
PB
PS
NB
PB
PS
PB
ZO
ZO
NB
ZO
ZO
NM
NS
PS
ZO
NM
PM
ZO
NM
PB
ZO
NB
PB
PB
NB
PB
PB 根据ΔK p、ΔK i、ΔK d的模糊规则表动态整定
PID参数，计算公式如下：
K
离心机转子p=K p0+ΔK p（6）
K
i=K i0+ΔK i（7）
K
d=K d0+ΔK d（8）式中，K'p，K'i，K'd为上一次整定的PID参数。在线运行过程中，控制系统通过对模糊逻辑规则的结果处理、查表和运算，完成对PID参数的在线自校正［10］。
2.4控制变量的解模糊
对模糊推理的结果ΔK p、ΔK i、ΔK d的模糊量进行解模糊化操作，本文采用的解模糊方法为重心法，其表达式为：
z0=∑i=0nμc(z i)×z i
∑i=0nμc(z i)（9）
式中，z0为模糊控制器变量解模糊后的精确值；z i
为模糊控制量论域内的值；μc（z i）为z i的隶属度
值。
模糊PID参数整定是出PID三个参数与e
和e c之间的模糊关系，在运行中通过不断检测e
和e c，根据模糊控制原理对三个参数进行在线修
改，以满足不同e和e c时对控制参数的不同要
求，而使被控压力有良好的动、静态性能［11］。
2.5算法流程
机器人打磨过程中工作流程图如图7
所示。
图7模糊PID算法流程
3仿真分析
Simulink中搭建相应的控制系统模型，如图8
所示，将传统PID控制与模糊PID控制同时仿真
进行输出曲线对比。结果如图8所示。对磨抛
加工过程中采用的模糊PID控制系统进行仿真
分析。结果表明参数自整定模糊PID控制系统
响应速度提高，超调量降低，稳定性更好。仿真
效果如图9
所示。
图8系统控制模型
王红平，等：基于模糊PID的机器人恒力磨抛控制研究
第3期37
长春理工大学学报（自然科学版）2021
物料输送设备
年
（a ）常规PID
控制
（b ）模糊PID 控制图9
系统仿真对比图
4实验验证
根据设计的打磨机器人系统方案实际构建
的打磨平台如图10
所示。
图10
机器人恒力打磨平台图
对平面进行打磨实验，预设输出压力为10N ，打磨头进给速度为10mm/s ，通过上位机离线编程软件对平面加工路径经行规划，得到现场机器人工作时打磨头的实时受力曲线和位置曲线如图11和图12
所示。
图11
上位机实际打磨时力输出曲线图
图12上位机实际打磨时位置输出曲线图
观察上位机监控软件得知实际加工时打磨压力在9.5~10.5N 之内波动，气缸的伸缩行程在14.3~14.7mm 之内波动。两者精度都满足实际加工的控制要求，实现了很好的平面和曲面打
磨。打磨后的工件表面对照如图13
所示。（a ）打磨前形貌
（b ）打磨后形貌
图13
工件打磨前后对比图
明显可见打磨过的表面几乎看不见划痕且
比较光亮，而未加工的表面划痕很明显。
在打磨后的工件表面随机取30个点进行表面粗糙度测量，测量结果如图14所示。粗糙度R a 测量结果在0.18~0.21μm 区间波动，平均粗糙度为0.20μm ，工件表面质量得到了极大地提升，可见恒力打磨的精度是符合预期要求的。
38
豫公网安备41160202000603
站长QQ:729038198
关于我们
投诉建议