发明名称 一种基于磨边机恒线速度磨削的控制算法
摘要 本发明公开了一种基于磨边机恒线速度磨削的控制算法,首先对餐具盘外轮廓进行轨迹规划,离散外轮廓曲线,获取离散点坐标数据,然后计算每个离散点的砂轮进给速度<img file="dest_path_image002.GIF" wi="17" he="19" />和该点旋转切向速度<img file="dest_path_image004.GIF" wi="16" he="22" />,据此编写G代码程序,并结合PID调节控制,实现恒线速度、恒力矩磨削。采用了PID算法保证砂轮恒力矩磨边,该发明由餐具盘外轮廓计算、生成G代码,由G代码控制砂轮进给轴和餐具盘旋转轴实现两轴联动,保证了恒线速度磨边,本发明的控制算法,具有较强的自适应性、磨削精度高和动态响应等特点,可适用于复杂轮廓边缘的,且磨削效果较好。
申请公布号 CN105549545A 申请公布日期 2016.05.04
申请号 CN201610091714.7 申请日期 2016.02.19
申请人 泉州华中科技大学智能制造研究院 发明人 王平江;钟治魁;张顺林;李世其;陈达伟;苏德瑜;郭磊
分类号 G05B19/416(2006.01)I;G05B19/19(2006.01)I;G05B11/42(2006.01)I 主分类号 G05B19/416(2006.01)I
代理机构 代理人
主权项 一种基于磨边机恒线速度磨削的控制算法,其特征在于:该方法包括以下步骤:步骤1:构建磨边机运动数学模型,建立运动坐标系x0y,(x方向为砂轮的进给速度方向,y方向为盘旋转切向速度,坐标原点为转盘旋转中心);步骤2:根据餐具盘的外轮廓曲线,导出轮廓曲线DXF文件,读取文件离散化曲线,得到n个离散点,并输出各点的坐标值(<img file="266764dest_path_image001.GIF" wi="17" he="16" />,<img file="362896dest_path_image002.GIF" wi="19" he="18" />)(<img file="136817dest_path_image003.GIF" wi="97" he="20" />),其中(<img file="815054dest_path_image001.GIF" wi="17" he="17" />,<img file="16229dest_path_image002.GIF" wi="19" he="17" />)和(<img file="599657dest_path_image004.GIF" wi="35" he="18" />,<img file="662422dest_path_image005.GIF" wi="36" he="19" />)是曲线加工过程中的任意两点,其相位角分别是<img file="710012dest_path_image006.GIF" wi="13" he="16" />、<img file="19771dest_path_image007.GIF" wi="12" he="22" />,将曲线任意两点(<img file="903544dest_path_image001.GIF" wi="17" he="17" />,<img file="19268dest_path_image002.GIF" wi="19" he="20" />)和(<img file="672097dest_path_image004.GIF" wi="35" he="18" />,<img file="215074dest_path_image005.GIF" wi="36" he="20" />)进行坐标转换,转换为x0y坐标系下的两点(<img file="507515dest_path_image008.GIF" wi="17" he="25" />,<img file="177662dest_path_image009.GIF" wi="20" he="26" />)和(<img file="934265dest_path_image010.GIF" wi="35" he="23" />,<img file="398876dest_path_image011.GIF" wi="36" he="23" />);坐标转换公式:<img file="506509dest_path_image012.GIF" wi="149" he="51" /><img file="714768dest_path_image013.GIF" wi="441" he="51" />式中,α‑β为两点相位角差;步骤3:计算轮廓曲线每个离散点的砂轮进给速度<img file="263561dest_path_image014.GIF" wi="25" he="23" />、转盘切向速度<img file="413919dest_path_image015.GIF" wi="24" he="22" />,将磨削速度<img file="494002dest_path_image016.GIF" wi="20" he="22" />分解成砂轮进给速度<img file="692902dest_path_image014.GIF" wi="25" he="23" />和转盘切向速度<img file="158518dest_path_image015.GIF" wi="24" he="25" />,<img file="230511dest_path_image017.GIF" wi="13" he="18" />为<img file="984840dest_path_image016.GIF" wi="20" he="22" />与<img file="784169dest_path_image014.GIF" wi="25" he="24" />的夹角,外轮廓曲线离散点越密集,<img file="108885dest_path_image018.GIF" wi="41" he="19" />近似等于两点连线的斜率;<img file="601046dest_path_image019.GIF" wi="174" he="51" /><img file="577092dest_path_image020.GIF" wi="126" he="51" />步骤4:根据离散点坐标数据和速度编写G代码程序;步骤5:采集砂轮进给电机电流<img file="dest_path_image021.GIF" wi="21" he="21" />和砂轮旋转电机电流<img file="993161dest_path_image022.GIF" wi="16" he="22" />,在n个周期内采集n个电流值<img file="dest_path_image023.GIF" wi="25" he="22" />和<img file="449681dest_path_image024.GIF" wi="21" he="22" />(<img file="847165dest_path_image003.GIF" wi="97" he="23" />),采取堆栈方式存储电流值,即按“一进一出”的存取原则;步骤6:对采集的砂轮进给电机电流和砂轮旋转电机电流进行滤波处理,采用算数平均方法,得到滤波后的电流<img file="389136dest_path_image025.GIF" wi="21" he="28" />、<img file="467950dest_path_image026.GIF" wi="16" he="23" />,每周期刷新一次,计算得到电流<img file="28244dest_path_image025.GIF" wi="21" he="24" />和<img file="347361dest_path_image026.GIF" wi="16" he="24" />值;<img file="563579dest_path_image027.GIF" wi="126" he="75" /><img file="321451dest_path_image028.GIF" wi="114" he="75" />步骤7:给定权重<img file="673935dest_path_image006.GIF" wi="13" he="14" />,计算电流值<img file="678800dest_path_image029.GIF" wi="193" he="27" />;根据PID离散表达式,并结合抗饱和积分与变积分思想,编写PID控制算法;PID离散点形式:<img file="116734dest_path_image030.GIF" wi="432" he="38" />式中<img file="dest_path_image031.GIF" wi="21" he="21" />、<img file="412718dest_path_image032.GIF" wi="19" he="23" />和<img file="dest_path_image033.GIF" wi="21" he="21" />分别为比例系数、积分系数和微分系数;步骤8:给定恒定电流<img file="698337dest_path_image034.GIF" wi="9" he="19" />,将PID调节结果作为餐具盘装夹误差补偿,修正控制砂轮进给轴G代码,确保砂轮在恒定力矩下磨削;步骤9:根据G代码程序,由数控系统控制砂轮进给轴和餐具旋转轴运行,通过PID控制算法实时补偿、修正G代码程序,保证砂轮沿餐具盘外轮廓恒线速度、恒力矩跟随。
地址 362000 福建省泉州市丰泽区北清东路518号泉州数控一代科技创新中心13楼