主权项 |
1.一种双曲线轨迹定向切线恒速焊接机器人装置,其特征在于:包括机械臂、Z轴转台(3)、控制器(4)、焊接电源(5)和焊枪(6);所述机械臂包括依次串联起来的X轴平移组件(1)和Y轴平移组件(2);待焊工件的焊缝中心线为双曲线轨迹;所述X轴平移组件包括第一基座(11)、X轴电机(12)、X轴传动机构(13)和第一滑块(14);所述第一基座与底座(8)固接,所述X轴电机与第一基座固接,所述X轴电机的输出轴与X轴传动机构的输入端相连,所述X轴传动机构的输出端与第一滑块相连,所述第一滑块滑动镶嵌在第一基座上;所述Y轴平移组件包括第二基座(21)、Y轴电机(22)、Y轴传动机构(23)和第二滑块(24);所述第二基座与第一滑块固接;所述Y轴电机与第二基座固接,所述Y轴电机的输出轴与Y轴传动机构的输入端相连,所述Y轴传动机构的输出端与第二滑块相连,所述第二滑块滑动镶嵌在第二基座上;所述Z轴转台包括第三基座(31)、Z轴电机(32)、Z轴传动机构(35)、关节轴(33)和工件安装台(34);所述第三基座与底座(8)固接;所述Z轴电机与第三基座固接,所述Z轴电机的输出轴与Z轴传动机构的输入端相连,所述Z轴传动机构的输出端与关节轴相连,所述关节轴活动套设在第三基座中,所述工件安装台固定套接在关节轴上;所述焊枪固定安装在第二滑块上;所述控制器通过控制线路分别与X轴电机、Y轴电机和Z轴电机相连,控制X轴电机、Y轴电机和Z轴电机同时转动;所述控制器与焊接电源相连;需要焊接的工件固定安装在工件安装台上;工件上具有双曲线轨迹的焊缝;设所述第一滑块相对于第一基座的滑动方向为直线q;设所述第二滑块相对于第二基座的滑动方向为直线s;设所述关节轴的中心线为直线u;直线q、直线s和直线u三者两两垂直;设直线q与直线s构成平面Q<sub>1</sub>,设工件上焊缝中心线的双曲线轨迹所在平面为平面Q<sub>2</sub>,平面Q<sub>1</sub>与平面Q<sub>2</sub>重合;建立世界坐标系{C},所述世界坐标系{C}的原点为关节轴的中心O<sub>C</sub>,世界坐标系{C}的横轴x<sub>C</sub>与直线q平行,x<sub>C</sub>轴的正方向为离开双曲线轨迹的方向,也是第一滑块相对于第一基座滑动的正方向,世界坐标系{C}的纵轴y<sub>C</sub>与直线s平行,y<sub>C</sub>轴的正方向为离开双曲线轨迹的方向,也是第二滑块相对于第二基座滑动的正方向,该世界坐标系{C}与第三基座固接;建立双曲线坐标系{A},所述双曲线坐标系{A}的原点为双曲线轨迹的中心O<sub>A</sub>,双曲线坐标系{A}的纵轴y<sub>A</sub>与双曲线对称轴重合,双曲线坐标系{A}的横轴x<sub>A</sub>过双曲线坐标系{A}的原点与纵轴垂直且和双曲线在同一平面内,所述双曲线坐标系{A}与带双曲线轨迹焊缝的工件固接;点O<sub>C</sub>在双曲线坐标系{A}中的坐标值为(d<sub>x</sub>,d<sub>y</sub>),(d<sub>x</sub>,d<sub>y</sub>)为已知常量;设焊接速度为预设值v<sub>w</sub>,设工件绕关节轴逆时针转动角速度为ω;抛物线上任意一点坐标(X<sub>A</sub>,Y<sub>A</sub>)均满足抛物线在抛物线坐标系中的轨迹方程为<img file="FDA00002222396900011.GIF" wi="272" he="59" />p>0为一常数;双曲线上任意一点坐标(X<sub>A</sub>,Y<sub>A</sub>)均满足双曲线在双曲线坐标系中的轨迹方程<img file="FDA00002222396900021.GIF" wi="282" he="115" />Y<sub>A</sub><0,其中a>0为一常数,b>0为一常数;设所述双曲线坐标系的x<sub>A</sub>轴与x<sub>C</sub>轴的夹角为θ,0≤θ≤90;所述焊枪的中心线与y<sub>C</sub>轴平行,焊枪的中心线与双曲线轨迹的交点为焊点P;所述焊点P在世界坐标系{C}中的坐标为(X<sub>C</sub>,Y<sub>C</sub>);设焊枪的末端点T在世界坐标系{C}中的坐标为(X<sub>TC</sub>,Y<sub>TC</sub>);β为焊点P与关节轴中心O<sub>C</sub>的连线与x<sub>C</sub>轴所夹的锐角;所述焊枪的末端点T与焊点P的距离为预设值L<sub>a</sub>;焊枪的末端点T和焊点P沿x<sub>C</sub>轴的速度相等,均为v<sub>1</sub>,相对世界坐标系{C}而言;焊枪的末端点T和焊点P沿y<sub>C</sub>轴的速度相等,均为v<sub>2</sub>,相对世界坐标系{C}而言;控制器通过控制工件和焊枪满足下列关系:<maths num="0001"><![CDATA[<math><mrow><msub><mi>X</mi><mi>C</mi></msub><mo>=</mo><mfrac><mrow><mrow><mo>(</mo><msup><mi>a</mi><mn>2</mn></msup><mo>-</mo><msup><mi>b</mi><mn>2</mn></msup><mo>)</mo></mrow><mi>sin</mi><mi>θ</mi></mrow><msqrt><mo>-</mo><msup><mi>a</mi><mn>2</mn></msup><msup><mi>tan</mi><mn>2</mn></msup><mi>θ</mi><mo>+</mo><msup><mi>b</mi><mn>2</mn></msup></msqrt></mfrac><mo>-</mo><msub><mi>d</mi><mi>x</mi></msub><mi>cos</mi><mi>θ</mi><mo>+</mo><msub><mi>d</mi><mi>y</mi></msub><mi>sin</mi><mi>θ</mi><mo>,</mo></mrow></math>]]></maths><maths num="0002"><![CDATA[<math><mrow><msub><mi>Y</mi><mi>C</mi></msub><mo>=</mo><mo>-</mo><msqrt><mo>-</mo><msup><mi>a</mi><mn>2</mn></msup><msup><mi>tan</mi><mn>2</mn></msup><mi>θ</mi><mo>+</mo><msup><mi>b</mi><mn>2</mn></msup></msqrt><mi>cos</mi><mi>θ</mi><mo>-</mo><msub><mi>d</mi><mi>x</mi></msub><mi>sin</mi><mi>θ</mi><mo>-</mo><msub><mi>d</mi><mi>y</mi></msub><mi>cos</mi><mi>θ</mi><mo>,</mo></mrow></math>]]></maths>X<sub>TC</sub>=X<sub>C</sub>,Y<sub>TC</sub>=Y<sub>C</sub>+L<sub>a</sub>,<maths num="0003"><![CDATA[<math><mrow><mi>β</mi><mo>=</mo><mi>arctan</mi><mrow><mo>(</mo><mfrac><msub><mi>Y</mi><mi>C</mi></msub><msub><mi>X</mi><mi>C</mi></msub></mfrac><mo>)</mo></mrow><mo>,</mo></mrow></math>]]></maths><maths num="0004"><![CDATA[<math><mrow><mi>ω</mi><mo>=</mo><mfrac><msub><mi>v</mi><mi>w</mi></msub><msqrt><msup><mrow><mo>(</mo><mi>M</mi><mo>+</mo><msqrt><msubsup><mi>X</mi><mi>C</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>Y</mi><mi>C</mi><mn>2</mn></msubsup></msqrt><mi>sin</mi><mi>β</mi><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mi>N</mi><mo>-</mo><msqrt><msubsup><mi>X</mi><mi>C</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>Y</mi><mi>C</mi><mn>2</mn></msubsup></msqrt><mi>cos</mi><mi>β</mi><mo>)</mo></mrow><mn>2</mn></msup></msqrt></mfrac><mo>,</mo></mrow></math>]]></maths>v<sub>1</sub>=Mω,v<sub>2</sub>=Nω,其中,<maths num="0005"><![CDATA[<math><mrow><mi>M</mi><mo>=</mo><mfrac><mrow><mrow><mo>(</mo><msup><mi>a</mi><mn>2</mn></msup><mo>-</mo><msup><mi>b</mi><mn>2</mn></msup><mo>)</mo></mrow><mrow><mo>(</mo><msup><mi>b</mi><mn>2</mn></msup><mo>+</mo><msup><mi>a</mi><mn>2</mn></msup><msup><mi>tan</mi><mn>4</mn></msup><mi>θ</mi><mo>)</mo></mrow><mi>cos</mi><mi>θ</mi></mrow><mrow><mrow><mo>(</mo><mo>-</mo><msup><mi>a</mi><mn>2</mn></msup><msup><mi>tan</mi><mn>2</mn></msup><mi>θ</mi><mo>+</mo><msup><mi>b</mi><mn>2</mn></msup><mo>)</mo></mrow><msqrt><mo>-</mo><msup><mi>a</mi><mn>2</mn></msup><msup><mi>tan</mi><mn>2</mn></msup><mi>θ</mi><mo>+</mo><msup><mi>b</mi><mn>2</mn></msup></msqrt></mrow></mfrac><mo>+</mo><msub><mi>d</mi><mi>x</mi></msub><mi>sin</mi><mi>θ</mi><mo>+</mo><msub><mi>d</mi><mi>y</mi></msub><mi>cos</mi><mi>θ</mi><mo>,</mo></mrow></math>]]></maths><maths num="0006"><![CDATA[<math><mrow><mi>N</mi><mo>=</mo><mfrac><mrow><mrow><mo>(</mo><msup><mi>a</mi><mn>2</mn></msup><mo>+</mo><msup><mi>b</mi><mn>2</mn></msup><mo>)</mo></mrow><mi>sin</mi><mi>θ</mi></mrow><msqrt><mo>-</mo><msup><mi>a</mi><mn>2</mn></msup><msup><mi>tan</mi><mn>2</mn></msup><mi>θ</mi><mo>+</mo><msup><mi>b</mi><mn>2</mn></msup></msqrt></mfrac><mo>-</mo><msub><mi>d</mi><mi>x</mi></msub><mi>cos</mi><mi>θ</mi><mo>+</mo><msub><mi>d</mi><mi>y</mi></msub><mi>sin</mi><mi>θ</mi><mo>,</mo></mrow></math>]]></maths>所述θ与时间t的关系是ω的积分;在预设了初始时刻的初始角度后,可以基于上述公式通过逐点计算方法计算得到θ与时间t的关系。 |