主权项 |
一种小曲率转弯处的涂胶控制方法,其特征在于:所述涂胶控制方法包括以下步骤:1)选好胶水型号,测出在距离中心点r处的胶膜累积速率为G=f(r,h)=A(R<sup>2</sup>‑r<sup>2</sup>);2)测出待涂胶对象的喷涂轨迹转弯处的曲率半径;3)建立胶膜累积模型为:h<sub>y</sub>=(1+tanθ<sub>1</sub>tanθ<sub>2</sub>)×(cosθ<sub>2</sub>‑sinθ<sub>2</sub>×tanθ<sub>1</sub>)×h+r×tanθ<sub>2</sub><maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mi>q</mi><mrow><mo>(</mo><msub><mi>r</mi><mi>x</mi></msub><mo>,</mo><msub><mi>h</mi><mi>y</mi></msub><mo>)</mo></mrow><mo>=</mo><mn>4</mn><mi>A</mi><mo>[</mo><mfrac><mn>2</mn><mn>3</mn></mfrac><msup><mrow><mo>(</mo><msub><mi>h</mi><mi>y</mi></msub><mo>·</mo><mi>tan</mi><msub><mi>θ</mi><mn>1</mn></msub><mo>)</mo></mrow><mn>3</mn></msup><mo>-</mo><msup><mrow><mo>(</mo><msub><mi>h</mi><mi>y</mi></msub><mo>·</mo><msub><mrow><mi>tan</mi><mi>θ</mi></mrow><mn>1</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mi>r</mi><mo>+</mo><mfrac><mn>1</mn><mn>3</mn></mfrac><msup><mi>r</mi><mn>3</mn></msup><mo>]</mo><mfrac><msqrt><msup><mrow><mo>(</mo><msub><mi>h</mi><mi>y</mi></msub><mo>·</mo><msub><mrow><mi>tan</mi><mi>θ</mi></mrow><mn>1</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>-</mo><msup><mi>r</mi><mn>2</mn></msup></msqrt><mi>υ</mi></mfrac></mrow>]]></math><img file="FDA0000597808950000011.GIF" wi="1430" he="171" /></maths>式中:θ<sub>1</sub>为喷枪在喷胶时的扩展角度;θ<sub>2</sub>为优化目标,即在转弯处需要调整机械臂的角度;h为标准走直线喷涂时,喷枪中心与工作面之间的距离;r为距离喷涂轨迹中心线的距离;υ为机器人末端执行器沿轨迹方向移动的速度;A为常数,通过在平面上针对点的喷涂实验测定数据得到累计模型的系数;4)根据胶膜累积模型以及曲率半径和胶膜所需要的宽度,通过控制模型计算出机械臂需要调整的角度及其运行速度,所述机械臂上安装喷枪;5)根据调整后的运动角度和移动速度,控制机械臂进行喷涂。 |