CN105353725B - 用于工业机器人的过辅助点姿态空间圆弧插补方法 - Google Patents

用于工业机器人的过辅助点姿态空间圆弧插补方法 Download PDF

Info

Publication number
CN105353725B
CN105353725B CN201510796042.5A CN201510796042A CN105353725B CN 105353725 B CN105353725 B CN 105353725B CN 201510796042 A CN201510796042 A CN 201510796042A CN 105353725 B CN105353725 B CN 105353725B
Authority
CN
China
Prior art keywords
msub
mrow
theta
mtd
interpolation
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201510796042.5A
Other languages
English (en)
Other versions
CN105353725A (zh
Inventor
臧秀娟
冯日月
夏正仙
王继虎
王明昕
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing Estun Robotics Co Ltd
Original Assignee
Nanjing Estun Robotics Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nanjing Estun Robotics Co Ltd filed Critical Nanjing Estun Robotics Co Ltd
Priority to CN201510796042.5A priority Critical patent/CN105353725B/zh
Publication of CN105353725A publication Critical patent/CN105353725A/zh
Application granted granted Critical
Publication of CN105353725B publication Critical patent/CN105353725B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/41—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path
    • G05B19/4105—Analog interpolation
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/42—Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/34—Director, elements to supervisory
    • G05B2219/34083—Interpolation general
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/39—Robotics, robotics to robotics hand
    • G05B2219/39001—Robot, manipulator control
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/39—Robotics, robotics to robotics hand
    • G05B2219/39054—From teached different attitudes for same point calculate tool tip position

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computing Systems (AREA)
  • Theoretical Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

本发明公开用于工业机器人的过辅助点姿态空间圆弧插补方法，包括以下步骤：机器人控制器通过通信端口确定了示教器示教的空间不共线三点；根据空间几何关系直接进行空间离散点的计算，求出空间圆弧的圆心、半径、法向量、圆心角和弧长；对姿态进行规划使运动轨迹经过辅助点姿态且轨迹光滑；速度轨迹规划模块计算出每个插补周期的插补位移；利用实时插补算法计算出每个插补周期的插补点位姿；将最终满足示教要求的位姿通过通信端口提供给机器人运动机构并执行。本发明避免了示教圆心的困难和确定圆弧方向的问题；计算效率高、插补精度高，可实现机器人的快速插补、控制精度高；运行平滑地经过辅助点姿态，拓宽了机器人的应用场合。

Description

用于工业机器人的过辅助点姿态空间圆弧插补方法
技术领域
本发明涉及一种插补方法，具体说是一种用于机器人的过辅助点姿态空间圆弧插补方法。背景技术
机器人的轨迹规划，在机器人控制中具有重要的作用，直接影响着控制的准确性和快速性。而插补算法是整个机器人轨迹规划控制过程的精华所在，占据着举足轻重的地位。通过示教机器人运动路径上的某些关键点，然后根据轨迹特征算出这些示教点之间必须到达的中间位置点，通过插补进行控制，从而实现高效率高精度的运动控制。
当曲线轨迹为圆弧时，除了示教圆弧起点和终点外，至少还应知道圆心或圆弧上一个辅助点。显然，示教圆心是很困难的，因而工业机器人终端执行器的轨迹圆弧通常由示教的圆弧起点、辅助点及圆弧终点决定，而这三点所决定的平面通常不一定平行于某一坐标平面，因而需要研究空间任意三点圆弧的插补算法。
目前普遍采用基于坐标转换的空间圆弧插补方法，即通过坐标转换将空间圆弧转化为平面圆弧，利用平面圆弧插补算法进行计算，之后再通过坐标转换把插补点从平面结果转换为空间结果。此方法需要进行多次坐标变换，计算过程复杂，计算工作量大。
目前工业机器人应用的空间圆弧插补方法未提及过辅助点姿态；随着工业发展的进步，控制指令的简便，某些特殊应用场合如焊接、涂胶等需要经过辅助点的姿态。
发明内容
本发明所要解决的技术问题，在于针对以上问题，克服现有技术存在的缺陷，提出了一种用于工业机器人的过辅助点姿态空间圆弧插补方法。该插补方法示教任意不共线的空间三点，不需要坐标转换将空间点转换成平面点进行计算，而是直接进行空间离散点的计算，并且对姿态进行规划使其过辅助点姿态，能根据给定的圆弧起点、辅助点及终点完成任意空间圆弧插补。
为实现上述发明目的，本发明采取的技术方案是：
用于工业机器人的过辅助点姿态空间圆弧插补方法，包括以下步骤：
步骤一：通过示教确定工业机器人的要求位姿，机器人控制器通过通信端口获取示教器提供的示教点信息，确定工业机器人轨迹的空间圆弧起点、辅助点及终点空间坐标及位姿，分别为：P1(x1,y1,z1,a1,b1,c1)、P2(x2,y2,z2,a2,b2,c2)、P3(x3,y3,z3,a3,b3,c3)；机器人轨迹上各点位姿由位置矢量(x,y,z)和RPY姿态矢量(α,β,γ)共同描述，组合成一个6自由度的复合矢量(x,y,z,α,β,γ)，即(x,y,z,a,b,c)。
步骤二：求出空间圆弧的圆心、半径、法向量、圆心角和弧长：
A、空间圆弧起点、辅助点及终点为不共线的空间三点，确定了空间圆弧所在的平面(简称圆弧平面)，根据圆心到三点的距离都为半径，联立方程，可求出圆心的空间坐标P0(x0,y0,z0)，进而求得半径R；
B、根据外积公式，求得垂直于圆弧平面的单位法向量
C、根据余弦定理和三个角之间的关系，求得空间圆弧的起点到辅助点、辅助点到终点、起点到终点的圆心角分别为：θ1，θ2，θ3(θ3＝θ1+θ2)；
D、根据圆弧弧长公式，求得弧长L＝Rθ3；进而求得空间圆弧插补的总位移S；
步骤三：姿态规划模块规划出经过空间圆弧辅助点的姿态；
各轴姿态随圆心角变化的变化率公式为：
分别对w(θ)积分即是各轴姿态值，故可根据极值法设计使得各轴姿态变化率连续，并求得相应的系数值k1,m1,k2,m2；
步骤四：速度轨迹规划模块计算出每个插补周期的插补位移；
速度轨迹规划模块，可以根据现有技术规划基于梯形曲线加减速控制或基于S形曲线加减速控制或其它曲线控制；根据不同的曲线控制方式，进行速度规划处理，计算圆弧段所需要的插补总时间和插补信息，最后计算出每个插补周期的插补位移；
步骤五：计算得到插补点的空间位姿；
计算空间圆弧插补点位姿Pi(xi,yi,zi,ai,bi,ci)步骤如下：
A、根据圆弧弧长公式，每个插补周期的插补位移除以半径得到空间圆弧每个插补周期的插补角度θ；
B、利用以下公式可求得插补点的空间坐标位置
C、利用以下公式可求得插补点的姿态
步骤六：机器人控制器的中央处理器将最终得到的位姿通过通信端口提供给机器人运动机构进行执行。
本发明方法可以实现工业机器人的高精高效的运动控制，经过辅助点姿态，并且运动平滑。
本发明的优点：一是，本发明方法根据空间任意三点进行圆弧插补，避免了示教圆心的困难和确定圆弧方向的问题；二是，本发明方法不需要进行坐标转换计算平面圆弧插补，而是直接计算空间角度和空间离散点得到实际空间圆弧插补点坐标，方法过程简洁方便、算法易于实现、计算效率高、插补精度高；三是，本发明方法通过姿态规划模块，使得实际空间圆弧插补点经过辅助点姿态，满足某些特殊应用场合；四是，本发明方法实现姿态变化率与插补角度的连续关系，使得各轴姿态变化连续，机器人运动平滑。
本方法利用空间几何关系直接进行离散点计算可以实现多轴快速插补、控制精度高；通过姿态规划算法经过辅助点姿态，同时实现姿态连续且姿态变化率连续的关系，可以使其更好的应用于某些特殊场合。
附图说明
图1为本发明用于工业机器人的过辅助点姿态空间圆弧插补方法的流程图。
图2为本发明中的空间圆弧示例图。
具体实施方式
下面结合附图和实施例，对本发明做进一步详细说明。
参照图1所示，本发明用于工业机器人的过辅助点姿态空间圆弧插补算法，包括如下步骤：
步骤一：通过示教确定工业机器人的要求位姿，机器人控制器通过通信端口获取示教器提供的示教点信息，确定工业机器人轨迹的空间圆弧起点、辅助点及终点空间坐标及位姿，分别为：P1(x1,y1,z1,a1,b1,c1)、P2(x2,y2,z2,a2,b2,c2)、P3(x3,y3,z3,a3,b3,c3)；机器人轨迹上各点位姿由位置矢量(x,y,z)和RPY姿态矢量(α,β,γ)共同描述，组合成一个6自由度的复合矢量(x,y,z,α,β,γ)，即(x,y,z,a,b,c)。
步骤二：求出空间圆弧的圆心、半径、法向量、圆心角和弧长：
A、空间圆弧起点、辅助点及终点为不共线的空间三点，确定了空间圆弧所在的平面(简称圆弧平面)，根据圆心到三点的距离都为半径，联立方程，可求出圆心的空间坐标P0(x0,y0,z0)，进而求得半径R；
B、根据外积公式，求得垂直于圆弧平面的单位法向量
C、根据余弦定理和三个角之间的关系，求得空间圆弧的起点到辅助点、辅助点到终点、起点到终点的圆心角分别为：θ1，θ2，θ3(θ3＝θ1+θ2)；
D、根据圆弧弧长公式，求得弧长L＝Rθ3；进而求得空间圆弧插补的总位移S；
步骤三：姿态规划模块规划出经过空间圆弧辅助点的姿态；
各轴姿态随圆心角变化的变化率公式为：
分别对w(θ)积分即是各轴姿态值，故可根据极值法设计使得各轴姿态变化率连续，并求得相应的系数值k1,m1,k2,m2；
起点到辅助点的各轴姿态线性变化率为w1，辅助点到终点的各轴姿态线性变化率为w2；当w2＝2w1时，可设计系数分别为m1＝0,k2＝0,m2＝w2，公式1可实例为进行求解各轴姿态变化率；
步骤四：轨迹速度规划模块计算出每个插补周期的插补位移s(iT)；
轨迹速度规划模块，可以根据现有技术规划基于梯形曲线加减速控制或基于S形曲线加减速控制或其它曲线控制；以下以梯形曲线加减速控制为例，介绍计算每个插补周期插补位移的具体步骤如下：
A、基于梯形曲线加减速控制的空间圆弧插补的加减速时间计算公式为：
式中，t1为空间圆弧插补的加速过程时间；t2为空间圆弧插补的匀速过程时间；t3为空间圆弧插补的减速过程时间；v为空间圆弧插补线速度，空间圆弧起点和终点的速度都设为0；a为空间圆弧插补加速度和减速度；
B、第i个插补周期的加速度计算公式为：
式中，T为空间圆弧插补周期，N1为需要的插补周期总个数，N2为需要的插补周期总个数，N3为需要的插补周期总个数，i＝0,1,2,…,N3；
C、第i个插补周期的线速度计算公式为：
D、第i个插补周期的插补位移计算公式为：
步骤五：计算得到插补点的空间位姿；
计算空间圆弧插补点位姿Pi(xi,yi,zi,ai,bi,ci)步骤如下：
A、计算空间圆弧每个插补周期的插补角度
B、利用以下公式可求得插补点的空间坐标位置
C、利用以下公式可求得插补点的姿态
步骤六：机器人控制器的中央处理器将最终得到的位姿通过通信端口提供给机器人运动机构进行执行。

Claims (1)

1.用于工业机器人的过辅助点姿态空间圆弧插补方法，包括以下步骤：
步骤一：通过示教确定工业机器人的要求位姿，机器人控制器通过通信端口获取示教器提供的示教点信息，确定工业机器人轨迹的空间圆弧起点、辅助点及终点空间坐标及位姿，分别为：P1(x1,y1,z1,a1,b1,c1)、P2(x2,y2,z2,a2,b2,c2)、P3(x3,y3,z3,a3,b3,c3)；机器人轨迹上各点位姿由位置矢量(x,y,z)和RPY姿态矢量(α,β,γ)共同描述，组合成一个6自由度的复合矢量(x,y,z,α,β,γ)，即(x,y,z,a,b,c)；
步骤二：确定空间圆弧的圆心、半径、法向量、圆心角和弧长：
A、空间圆弧起点、辅助点及终点为不共线的空间三点，确定了空间圆弧所在的平面，根据圆心到三点的距离都为半径，联立方程，求出圆心的空间坐标P0(x0,y0,z0)，进而求得半径R；
B、根据外积公式，求得垂直于圆弧平面的单位法向量
C、根据余弦定理和三个角之间的关系，求得空间圆弧的起点到辅助点、辅助点到终点、起点到终点的圆心角分别为：θ1，θ2，θ3；θ3＝θ1+θ2；
D、根据圆弧弧长公式，求得弧长L＝Rθ3；进而求得空间圆弧插补的总位移S；
步骤三：姿态规划模块规划出经过空间圆弧辅助点的姿态；
各轴姿态随圆心角变化的变化率公式为：
<mrow> <mi>w</mi> <mrow> <mo>(</mo> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>k</mi> <mn>1</mn> </msub> <mi>&amp;theta;</mi> <mo>+</mo> <msub> <mi>m</mi> <mn>1</mn> </msub> </mrow> </mtd> <mtd> <mrow> <mo>(</mo> <mn>0</mn> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>&amp;le;</mo> <msub> <mi>&amp;theta;</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>k</mi> <mn>2</mn> </msub> <mi>&amp;theta;</mi> <mo>+</mo> <msub> <mi>m</mi> <mn>2</mn> </msub> </mrow> </mtd> <mtd> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mn>1</mn> </msub> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>&amp;le;</mo> <msub> <mi>&amp;theta;</mi> <mn>3</mn> </msub> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>
分别对w(θ)积分获得各轴姿态值，根据极值法设计使得各轴姿态变化率连续，并求得相应的系数值k1,m1,k2,m2；
步骤四：轨迹速度规划模块计算出每个插补周期的插补位移；
轨迹速度规划模块，可以根据现有技术规划基于梯形曲线加减速控制或基于S形曲线加减速控制；根据不同的曲线控制方式，进行速度规划处理，计算圆弧段所需要的插补总时间和插补信息，最后计算出每个插补周期的插补位移；
步骤五：计算得到插补点的空间位姿；
计算空间圆弧插补点位姿Pi(xi,yi,zi,ai,bi,ci)，步骤如下：
A、根据圆弧弧长公式，每个插补周期的插补位移除以半径得到空间圆弧每个插补周期的插补角度θ；
B、利用以下公式可求得插补点的空间坐标位置：
<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mi>i</mi> </msub> <mo>=</mo> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>&amp;lsqb;</mo> <msub> <mi>n</mi> <mi>x</mi> </msub> <msub> <mi>n</mi> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mi>cos</mi> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>cos</mi> <mi>&amp;theta;</mi> <mo>&amp;rsqb;</mo> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>&amp;lsqb;</mo> <msub> <mi>n</mi> <mi>x</mi> </msub> <msub> <mi>n</mi> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mi>cos</mi> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>n</mi> <mi>z</mi> </msub> <mi>sin</mi> <mi>&amp;theta;</mi> <mo>&amp;rsqb;</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>&amp;lsqb;</mo> <msub> <mi>n</mi> <mi>x</mi> </msub> <msub> <mi>n</mi> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mi>cos</mi> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>n</mi> <mi>y</mi> </msub> <mi>sin</mi> <mi>&amp;theta;</mi> <mo>&amp;rsqb;</mo> <mo>+</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>y</mi> <mi>i</mi> </msub> <mo>=</mo> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>&amp;lsqb;</mo> <msub> <mi>n</mi> <mi>x</mi> </msub> <msub> <mi>n</mi> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mi>cos</mi> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>n</mi> <mi>z</mi> </msub> <mi>sin</mi> <mi>&amp;theta;</mi> <mo>&amp;rsqb;</mo> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>&amp;lsqb;</mo> <msub> <mi>n</mi> <mi>y</mi> </msub> <msub> <mi>n</mi> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mi>cos</mi> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>cos</mi> <mi>&amp;theta;</mi> <mo>&amp;rsqb;</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>&amp;lsqb;</mo> <msub> <mi>n</mi> <mi>y</mi> </msub> <msub> <mi>n</mi> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mi>cos</mi> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>n</mi> <mi>x</mi> </msub> <mi>sin</mi> <mi>&amp;theta;</mi> <mo>&amp;rsqb;</mo> <mo>+</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>z</mi> <mi>i</mi> </msub> <mo>=</mo> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>&amp;lsqb;</mo> <msub> <mi>n</mi> <mi>x</mi> </msub> <msub> <mi>n</mi> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mi>cos</mi> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>n</mi> <mi>y</mi> </msub> <mi>sin</mi> <mi>&amp;theta;</mi> <mo>&amp;rsqb;</mo> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>&amp;lsqb;</mo> <msub> <mi>n</mi> <mi>y</mi> </msub> <msub> <mi>n</mi> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mi>cos</mi> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>n</mi> <mi>x</mi> </msub> <mi>sin</mi> <mi>&amp;theta;</mi> <mo>&amp;rsqb;</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>&amp;lsqb;</mo> <msub> <mi>n</mi> <mi>z</mi> </msub> <msub> <mi>n</mi> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mi>cos</mi> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>sin</mi> <mi>&amp;theta;</mi> <mo>&amp;rsqb;</mo> <mo>+</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> </mtable> <mo>;</mo> </mrow>
C、利用以下公式可求得插补点的姿态
<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mi>a</mi> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>a</mi> <mn>1</mn> </msub> <mo>+</mo> <msubsup> <mo>&amp;Integral;</mo> <mn>0</mn> <mi>&amp;theta;</mi> </msubsup> <mi>w</mi> <mrow> <mo>(</mo> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mi>d</mi> <mi>&amp;theta;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>b</mi> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>b</mi> <mn>1</mn> </msub> <mo>+</mo> <msubsup> <mo>&amp;Integral;</mo> <mn>0</mn> <mi>&amp;theta;</mi> </msubsup> <mi>w</mi> <mrow> <mo>(</mo> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mi>d</mi> <mi>&amp;theta;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>c</mi> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>c</mi> <mn>1</mn> </msub> <mo>+</mo> <msubsup> <mo>&amp;Integral;</mo> <mn>0</mn> <mi>&amp;theta;</mi> </msubsup> <mi>w</mi> <mrow> <mo>(</mo> <mi>&amp;theta;</mi> <mo>)</mo> </mrow> <mi>d</mi> <mi>&amp;theta;</mi> </mrow> </mtd> </mtr> </mtable> <mo>;</mo> </mrow>
步骤六：机器人控制器的中央处理器将最终得到的位姿通过通信端口提供给机器人运动机构进行执行。
CN201510796042.5A 2015-11-18 2015-11-18 用于工业机器人的过辅助点姿态空间圆弧插补方法 Active CN105353725B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510796042.5A CN105353725B (zh) 2015-11-18 2015-11-18 用于工业机器人的过辅助点姿态空间圆弧插补方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510796042.5A CN105353725B (zh) 2015-11-18 2015-11-18 用于工业机器人的过辅助点姿态空间圆弧插补方法

Publications (2)

Publication Number Publication Date
CN105353725A CN105353725A (zh) 2016-02-24
CN105353725B true CN105353725B (zh) 2017-12-19

Family

ID=55329714

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510796042.5A Active CN105353725B (zh) 2015-11-18 2015-11-18 用于工业机器人的过辅助点姿态空间圆弧插补方法

Country Status (1)

Country Link
CN (1) CN105353725B (zh)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105834629B (zh) * 2016-04-11 2017-07-21 南京埃斯顿机器人工程有限公司 一种焊接机器人焊接圆弧焊缝的平面三角摆焊方法
CN105855672B (zh) * 2016-05-30 2018-07-24 科德数控股份有限公司 基于示教机器人的空间圆弧插补焊接方法
CN106863306B (zh) * 2017-03-31 2020-08-18 华南理工大学 一种机器人关节空间平滑轨迹规划方法
CN107390634B (zh) * 2017-08-31 2019-11-12 南京埃斯顿机器人工程有限公司 一种工业机器人轨迹五次多项式规划方法
CN108318581B (zh) * 2017-12-08 2020-12-18 中国兵器科学研究院宁波分院 一种不用装夹定位的圆弧面工件超声波c扫描自动检测方法
CN108453377B (zh) * 2018-01-19 2020-04-10 广州新可激光设备有限公司 一种激光设备弧形对接口的切割打标效果优化方法
CN108549322B (zh) * 2018-04-11 2019-07-02 广州启帆工业机器人有限公司 一种针对机器人圆弧轨迹运动的位姿同步方法和装置
CN108941845B (zh) * 2018-08-28 2021-08-24 苏州艾利特机器人有限公司 一种弧焊机器人空间圆弧摆焊插补方法
CN109623825B (zh) * 2018-12-30 2021-11-16 深圳市越疆科技有限公司 一种移动轨迹规划方法、装置、设备和存储介质
CN110111424B (zh) * 2019-05-07 2023-06-06 易思维（杭州）科技有限公司 基于线结构光测量的圆弧状物的三维重建方法
CN111687838B (zh) * 2020-05-29 2023-10-13 深圳科瑞技术股份有限公司 机械手轨迹跟随误差的在线补偿方法、系统及存储介质
CN111702762B (zh) * 2020-06-23 2021-11-30 南京航空航天大学 一种工业机器人作业姿态优化方法
CN112077851B (zh) * 2020-09-17 2021-06-25 南京埃斯顿自动化股份有限公司 一种基于混合空间的工业机器人过渡轨迹规划方法
CN112720492B (zh) * 2020-12-29 2022-05-10 上海节卡机器人科技有限公司 多轴机器人的复杂轨迹光顺方法、装置、介质及电子设备
CN112987740B (zh) * 2021-03-01 2023-08-18 北方工业大学 一种移动机器人路径规划控制方法
CN113791581B (zh) * 2021-08-03 2023-08-08 天津中德应用技术大学 一种基于等弦分割采样的球形灌木球面插补算法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1540469A (zh) * 2003-10-28 2004-10-27 华北电力大学 一种用于数控机床的三坐标圆弧插补方法及装置
CN102662350A (zh) * 2012-05-31 2012-09-12 东南大学 主从式多机器人协作系统的轨迹示教与规划方法
CN103676787A (zh) * 2013-12-13 2014-03-26 大连理工计算机控制工程有限公司 一种用于运动控制系统的圆心模式空间圆弧插补方法
CN104070523A (zh) * 2013-03-27 2014-10-01 深圳市生命之泉科技发展有限公司 基于空间坐标转换的工业机器人实时圆弧插补实现方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6374155B1 (en) * 1999-11-24 2002-04-16 Personal Robotics, Inc. Autonomous multi-platform robot system

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1540469A (zh) * 2003-10-28 2004-10-27 华北电力大学 一种用于数控机床的三坐标圆弧插补方法及装置
CN102662350A (zh) * 2012-05-31 2012-09-12 东南大学 主从式多机器人协作系统的轨迹示教与规划方法
CN104070523A (zh) * 2013-03-27 2014-10-01 深圳市生命之泉科技发展有限公司 基于空间坐标转换的工业机器人实时圆弧插补实现方法
CN103676787A (zh) * 2013-12-13 2014-03-26 大连理工计算机控制工程有限公司 一种用于运动控制系统的圆心模式空间圆弧插补方法

Also Published As

Publication number Publication date
CN105353725A (zh) 2016-02-24

Similar Documents

Publication Publication Date Title
CN105353725B (zh) 用于工业机器人的过辅助点姿态空间圆弧插补方法
US20190184560A1 (en) A Trajectory Planning Method For Six Degree-of-Freedom Robots Taking Into Account of End Effector Motion Error
US8774965B2 (en) Method and device for controlling a manipulator
CN107030697B (zh) 一种机器人笛卡尔空间平滑轨迹的规划方法
CN103970139B (zh) 一种机器人连续点位运动规划方法
JP2019517929A (ja) ロボット関節空間におけるポイントツーポイント移動の軌跡計画方法
US20160158936A1 (en) Collision avoidance method, control device, and program
JP6717164B2 (ja) 動作経路計画方法
JP5555838B2 (ja) 軌道生成方法および軌道生成装置
JP5380672B2 (ja) モーションプランナ、制御システム、および多軸サーボシステム
CN103676787B (zh) 一种用于运动控制系统的圆心模式空间圆弧插补方法
CN111580453B (zh) 基于plc的提高二维圆弧插补轨迹精度的实现方法
US10921772B2 (en) Equivalent-plane cross-coupling control method
CN107662205A (zh) 机器人及其关节运动控制方法和装置
CN105643619B (zh) 一种采用框架描述的工业机器人工具位姿控制方法
JP2009053926A (ja) 経路計画装置及び経路計画方法
CN103481288A (zh) 一种5关节机器人末端工具位姿控制方法
CN105856231A (zh) 一种特定构型六轴工业机器人的运动控制方法
JP2017010292A (ja) Ａｇｖ軌道計算装置及び方法
CN104070523A (zh) 基于空间坐标转换的工业机器人实时圆弧插补实现方法
CN107717985A (zh) 一种应用于六轴机械手臂的空间多直线平滑运动控制方法
KR101743795B1 (ko) 위치제어 시스템에서 곡선보간 방법
CN103529856A (zh) 5关节机器人末端工具位姿控制方法
CN106020125B (zh) 一种基于速度连续的工业机器人运动学算法
JP4146549B2 (ja) 軌跡制御方法及び軌跡制御方法を記録した記録媒体

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant