[发明专利]基于模糊自适应力控制的恒力自动打磨装置及方法

摘要

本发明公开了一种基于模糊自适应力控制的恒力自动打磨方法，所述打磨方法包括通过实时检测磨头与工件的接触力进行力信号的反馈，通过设定的控制算法改变控制器输出的模拟量电压值，从而控制x轴伺服电动机输出转矩的大小，达到接触力控制的目的。本发明还提供了一种实现该方法的打磨装置，包括工控主机、工作台、运动机构、一维力传感设备、用于获取工件位置坐标的位置传感器、打磨设备和工件装夹设备，本发明装置能实现基于智能力控制技术完成打磨过程中法向磨削力的检测，并对将检测结果进行反馈，通过控制器的处理，产生驱动信号不断调整驱动器的输出力矩，从而实时控制磨削法向力，实现恒定压力的打磨。

主权项

基于模糊自适应力控制的恒力自动打磨方法，其特征在于，包括以下步骤：1)通过位置传感器对工件坐标进行标定，缓慢移动x轴，当打磨设备碰到工件，一维力传感设备会产生一个阶跃信号，检测出这个阶跃信号和伺服电机编码器的读数，计算出运动机构坐标与工件坐标之间的转换关系；2)读取不同进给深度的力传感器的电压值，估算运动机构和装夹机构的刚度；3)对打磨过程建模，设计模糊自适应控制器，并初步估算控制器参数；4)所述模糊自适应控制器的算法通过工控主机编程，给定y轴一个恒定的速度运动，在x轴方向通过力反馈控制磨削力的大小，记录力传感器电压值，不断调整模糊PID参数直到得到较好的恒力磨削效果；5)以步骤4)所调整的参数作为初始参数，设计模糊自适应控制器；6)以步骤5)所述的模糊自适应控制器的算法编程并结合运动控制器的运动控制函数，完成模糊自适应PID控制器的设计；7)工控主机采用位置控制方式控制打磨设备y轴方向匀速运动，采用设计好的模糊自适应控制器控制打磨设备x轴方向的运动，使打磨设备以恒定的力与工件接触；所述步骤3)具体包括：步骤31)将磨削过程简化成质量‑弹簧‑阻尼模型，其动力学方程写成：Fd(t)+Fe(t)-Fs(t)=Mx··(t),]]>其中质量M是力传感器、连接件、和手持角磨机的总质量，x是x轴方向的位移，Fd为输入的力，Fe为力的干扰，包括伺服系统的干扰和力传感器的干扰，Fs为力传感器的检测力返回值：Fs(t)=Bx·(t)+Kx(t),]]>其中刚度K是串联刚度，连接件的刚度对K的影响最大，B是系统阻尼，即由力传感器、角磨机产生的阻尼，拉氏变换后消去X(s)得到：Fd(s)+Fe(s)-Fs(s)=MS2BS+KFs(s);]]>步骤32)设计带滤波器的PID控制器，系统的闭环传递函数为：G(s)=Fs(x)u(s)=Bkds3+(kkd+Bkp)s2+(Bki+kkp)s+kkiA1s3+A2s2+A3s+kki,]]>其中A1＝M+Bkd，A2＝B+kdk+Bkp，A3＝k+kiB+kkp；步骤33)由阻尼比和角频率画出特征方程的根轨迹图，初步确定一组特征方程的根，由分母恒等式就可以估算出一组控制参数kp、ki和kd的值。