发明名称 一种自由曲面喷涂机器人的喷枪轨迹规划方法
摘要 一种自由曲面喷涂机器人喷枪轨迹规划方法,本发明利用数控加工过程与喷涂过程非常相似的特点,喷枪的运动轨迹可以在刀位轨迹的基础上,经过少量的计算求得。该方法包括以下步骤:首先在三维造型软件中将被喷涂表面划分成若干个形状规则的区域,利用五轴数控加工方法在每一区域表面生成m条等间距刀位轨迹,并导出为标准APT文件;提取包含在APT文件中的刀具运动信息,对获得刀位点进行延展,并将拐角处处理成圆弧过渡,生成喷枪路径点序列,然后求得路径点序列上的喷枪位姿序列;对喷枪位姿序列进行插值,生成完整的喷枪运动轨迹。本发明方法能实现喷枪轨迹的精确控制,确保高的喷涂质量,计算过程简单,计算量小。
申请公布号 CN102527554A 申请公布日期 2012.07.04
申请号 CN201210050434.3 申请日期 2012.02.29
申请人 清华大学 发明人 陈恳;缪东晶;王国磊;杨向东;杨东超;潘玉龙;吴聊;谢颍;刘志
分类号 B05B13/04(2006.01)I;G06F19/00(2011.01)I 主分类号 B05B13/04(2006.01)I
代理机构 北京鸿元知识产权代理有限公司 11327 代理人 邸更岩
主权项 1.一种自由曲面喷涂机器人的喷枪轨迹规划方法,其特征在于该方法包括以下步骤:S1)在三维造型软件中将工件被喷涂表面划分成若干个形状规则的区域,利用数控加工方法在每一区域表面生成m条等间距刀位轨迹,并将刀位轨迹导出为标准APT文件,其中m=1,2,…;S2)提取包含在APT文件中的的刀位点及刀轴矢量,对获得的刀位点进行延展,并将拐角处处理成半径为r的圆弧过渡,设定开枪点(3)与关枪点(6),得到有序路径点序列P<sub>1</sub>,P<sub>2</sub>,...,P<sub>i</sub>,...,P<sub>n</sub>,点的总数为n,n=1,2,…,记P<sub>i</sub>点坐标为[x<sub>i</sub>y<sub>i</sub>z<sub>i</sub>],P<sub>i</sub>点处的刀轴矢量<img file="FDA0000139533940000011.GIF" wi="312" he="72" />称位于相邻两轨迹线关枪点(6)与开枪点(3)间通过延展与圆弧过渡得到的路径点为过渡段路径点;S3)在路径点P<sub>i</sub>处建立固结在喷锥(4)底中心的局部坐标系<img file="FDA0000139533940000012.GIF" wi="259" he="56" />即为P<sub>i</sub>点处的刀轴矢量,记P<sub>i</sub>点所在的轨迹线在m条轨迹中的次序为k,k∈[1,2,…,m];通过以下步骤求得<img file="FDA0000139533940000013.GIF" wi="64" he="53" />构造辅助矢量<img file="FDA0000139533940000014.GIF" wi="58" he="53" />当1<i<n,P<sub>i</sub>所在的轨迹线k为奇数时,<img file="FDA0000139533940000015.GIF" wi="291" he="56" />P<sub>i</sub>所在的轨迹线k为偶数时,<img file="FDA0000139533940000016.GIF" wi="289" he="56" />当P<sub>i</sub>为过渡段路径点时,<img file="FDA0000139533940000017.GIF" wi="36" he="54" />均与关枪点(6)处辅助矢量相同;当i=n时,<img file="FDA0000139533940000018.GIF" wi="207" he="54" />在P<sub>i</sub>、<img file="FDA0000139533940000019.GIF" wi="35" he="53" />和<img file="FDA00001395339400000110.GIF" wi="37" he="54" />构成的平面内求得与<img file="FDA00001395339400000111.GIF" wi="34" he="53" />垂直并与<img file="FDA00001395339400000112.GIF" wi="37" he="54" />夹角为锐角的矢量<img file="FDA00001395339400000113.GIF" wi="66" he="54" />记<img file="FDA00001395339400000114.GIF" wi="310" he="72" />令记<maths num="0001"><![CDATA[<math><mrow><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mi>i</mi></msub><mo>=</mo><msub><mover><mi>y</mi><mo>&OverBar;</mo></mover><mi>i</mi></msub><mo>&times;</mo><msub><mover><mi>z</mi><mo>&OverBar;</mo></mover><mi>i</mi></msub><mo>,</mo></mrow></math>]]></maths><maths num="0002"><![CDATA[<math><mrow><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mi>i</mi></msub><mo>=</mo><mo>[</mo><msub><mi>e</mi><mi>i</mi></msub><msub><mi>f</mi><mi>i</mi></msub><msub><mi>g</mi><mi>i</mi></msub><mo>]</mo><mo>;</mo></mrow></math>]]></maths>记上述路径点序列上以欧拉角表示的喷枪位姿序列为<img file="FDA00001395339400000117.GIF" wi="378" he="72" /><img file="FDA00001395339400000118.GIF" wi="54" he="44" />θ<sub>i</sub>、ψ<sub>i</sub>分别为局部坐标系<img file="FDA00001395339400000119.GIF" wi="158" he="56" />在基础坐标系中的偏航角、俯仰角与横滚角,求得喷枪位姿为:<img file="FDA00001395339400000120.GIF" wi="402" he="72" /><img file="FDA00001395339400000121.GIF" wi="890" he="76" /><img file="FDA00001395339400000122.GIF" wi="1312" he="76" />S4)结合喷涂工艺中对喷枪速度的要求,对喷枪位姿序列<img file="FDA00001395339400000123.GIF" wi="357" he="72" />进行插值,生成完整的喷枪运动轨迹(2)。
地址 100084 北京市海淀区100084信箱82分箱清华大学专利办公室