一种位姿同步的六轴工业机器人轨迹平顺方法，采用圆弧曲线对位置轨迹过渡，并采用四元数B样条对姿态轨迹过渡。过渡后的位置和姿态轨迹均具有高阶连续性，可同时约束位置和姿态的过渡误差，且过渡后的位置轨迹和姿态轨迹具有参数同步性。包括两个步骤：步骤1、根据位置和姿态的过渡误差阈值、连续性条件和位姿同步条件确定过渡参数；步骤2、根据过渡参数分别计算位置和姿态的过渡轨迹。本发明专利技术提出的平顺方法能够生成平滑且精度可控的六轴机器人轨迹，进而提高六轴机器人的作业效率和精度。
A path smoothing method of six axis industrial robot based on position and attitude synchronization
【技术实现步骤摘要】
一种位姿同步的六轴工业机器人轨迹平顺方法
本专利技术属于工业机器人自动控制
，具体涉及一种位姿同步的六轴工业机器人轨迹平顺方法。
技术介绍
六轴工业机器人被广泛应用于激光切割、焊接、喷涂等复杂应用中。复杂机器人轨迹大多是由离线编程软件生成的线性轨迹和圆弧轨迹组成。在每个轨迹点处，线性轨迹的位姿(位置和姿态)均不具有速度和加速度的连续性，造成机器人在执行过程中的停顿、振动和轨迹误差等问题。为了解决线性轨迹的不连续问题，目前机器人控制系统中大多采用拐角过渡方法。现有位置轨迹的拐角过渡研究中，多采用圆弧、抛物线或多项式曲线来构造过渡轨迹；姿态轨迹的拐角过渡研究中，基于四元数B样条的方法能够提高姿态的连续性。但现有研究存在两个主要问题：一是无法同时约束位置轨迹和姿态轨迹的过渡误差；二是不具备位置和姿态的参数同步性，进而导致位置和姿态的几何形状随速度的改变而改变。中国专利技术专利(申请号201610075346.7)提出了一种工业机器人应用的过渡轨迹规划方法，采用抛物线实现关节空间和笛卡尔空间的轨迹过渡；中国专利技术专利(申请号201710291306.0)提出了一种通过过渡等级来控制过渡区域大小的拟合过渡方法。但以上过渡方法均无法约束位置和姿态的过渡误差，且轨迹形状随速度改变而改变。因此，提供一种简单有效、带误差约束、位姿同步的六轴工业机器人轨迹平顺方法很有必要。
技术实现思路
本专利技术提供了一种针对六轴工业机器人的位姿同步的平顺过渡方法，采用圆弧曲线对位置轨迹过渡，并采用四元数B样条对姿态轨迹过渡，该方法计算简单，位置轨迹和姿态轨迹具有参数同步的连续性，且位置轨迹和姿态轨迹的过渡误差可控，能够有效的提高六轴工业机器人的作业效率和质量。本专利技术所采用的技术方案是：一种位姿同步的六轴工业机器人轨迹平顺方法，包括如下步骤：步骤1、根据过渡误差约束、连续性条件和位姿同步性确定每个位置点和姿态点的过渡参数，其中过渡参数用于确定过渡轨迹的起点和终点；步骤2、根据过渡参数构造位置和姿态的过渡轨迹；按上述方案，所述步骤1具体包括如下步骤：步骤1.1、将六轴工业机器人的线性轨迹的位置点用三维点Pi(xi,yi,zi)表示，姿态点用四元数qi(qi，1，qi，2，qi，3，qi，4)表示，其中序号i＝1，2，...N，N为总的轨迹点个数(N≥3)。步骤1.2、遍历除首尾端点外的内部轨迹点Pi(xi，yi，zi)，i＝2，3，...N-1，根据位置点的过渡误差阈值δp，计算每个位置点Pi(xi，yi，zi)的过渡圆弧的最大位置过渡参数：首先，计算线段Pi-1Pi的长度Li-1和线段PiPi+1的长度Li，若长度Li-1或长度Li太短(小于距离阈值)，则该轨迹段不需平顺；否则计算线段Pi-1Pi和线段PiPi+1的夹角若夹角接近0度或180度，则该轨迹段也不需平顺，将位置轨迹的不需平顺段做标记，以下先来介绍需平顺段的过渡方法；然后，设ri，1和ri，2为两个位置过渡参数，过渡圆弧的起点可表示为Ei，0＝Pi+ri，1(Pi-1-Pi)，终点可表示为Ei，1＝Pi+ri，2(Pi+1-Pi)，根据过渡的对称性条件建立两个位置过渡参数之间的关系：ri，1Li-1＝ri，2Li；最后，根据圆弧过渡误差阈值δp以及相邻过渡轨迹不相交的条件计算位置过渡参数ri，1的上界：步骤1.3、遍历除首尾端点外的轨迹点Pi，i＝2，3，...N-1，根据姿态点的过渡误差阈值δo，计算每个姿态点qi(qi，1，qi，2，qi，3，qi，4)的过渡四元数B样条的最大姿态过渡参数：首先，计算姿态点qi-1旋转到姿态点qi的旋转轴Ui-1及旋转角θi-1，并计算姿态点qi旋转到姿态点qi+1的旋转轴Ui及旋转角θi；若旋转角θi-1或旋转角θi接近0度，则该轨迹段也不需平顺，将姿态轨迹的不需平顺段做标记，以下先来介绍需平顺段的过渡方法；然后，设姿态过渡四元数B样条具有5个控制点，其中控制点fi，0，fi，1位于姿态点qi-1与姿态点qi的球面线性插值轨迹上，控制点fi，2与姿态点qi相同，控制点fi，3，fi，4位于姿态点qi-1与姿态点qi的球面线性插值轨迹上，即：以上控制点的分布能够保证过渡轨迹与原线性轨迹的G2连续性。其中si，1和si，2为两个姿态过渡参数，c为与位姿同步相关的比例系数；根据姿态过渡的对称性条件建立两个位置过渡参数之间的关系：si，1θi-1＝si，2θi；最后，根据姿态过渡误差阈值δo、姿态过渡轨迹对称、相邻过渡轨迹不相交的条件计算姿态过渡参数si，1的上界：步骤1.4、计算满足轨迹点误差且位姿同步的过渡参数ti,1,ti,2和比例系数c:首先根据位置轨迹和姿态轨迹同步条件计算比例系数然后根据位置和姿态轨迹是否可平顺的标记确定位姿同步过渡参数的取值：若位置轨迹和姿态轨迹均标记为可平顺，则取位置和姿态的过渡参数最小值作为位姿同步的过渡参数，即：ti,1＝min(ri,1,si,1),若位置轨迹和姿态轨迹均不可平顺，则不需对位置轨迹和姿态轨迹进行平顺；若位置轨迹或姿态轨迹之一可平顺，则可单独采用步骤1.2或步骤1.3的方法平顺。按上述方案，遍历除首尾端点外的轨迹点Pi,i＝2,3,...N-1，所述步骤2针对可平顺段进行平顺，具体包括如下步骤：步骤2.1、根据过渡参数构造位置轨迹的过渡圆弧，圆弧轨迹表示为：步骤2.2、根据过渡参数和比例系数构造姿态轨迹的过渡曲线，其中控制点如步骤1.3中定义，节点向量为U＝[0,0,0,0,0.5,1,1,1,1]，为四元数B样条的累加和基函数，四元数B样条曲线表示为：通过本专利技术所构思的以上技术方案，与现有技术相比，本专利技术具有的优势：1、提出的机器人位姿平顺方法能够提到机器人轨迹的连续性，其中位置轨迹为G1连续，姿态轨迹为G2连续，能够避免机器人执行过程中的停顿和振动；2、提出的考虑误差约束的平顺过渡方法能够同时控制位置轨迹和姿态轨迹的过渡误差，有利于高精度的机器人应用；3、提出的位姿同步的平顺过渡方法保证了位置轨迹和姿态轨迹的参数同步，将几何平顺和速度规划区分开，进而避免机器人轨迹随速度的改变而改变。4、提出的轨迹平顺方法适合于位置轨迹和姿态轨迹的单独过渡或同时过渡，进而适用于工业机器人的多种应用场景。附图说明图1为本专利技术实施例六轴工业机器人位置轨迹过渡示意图；图2为本专利技术实施例六轴工业机器人姿态轨迹过渡示意图。具体实施方式为了使本专利技术的目的、技术方案及优点更加清楚明白，以下结合附图及实施案例，对本专利技术进行进一步详细说明。应当理解，此处所描述的具体实施案例仅仅用以解释本专利技术，并不用于限定本专利技术。本专利技术为一种位姿同步的六轴工业机器人轨迹平顺方法，其中位置轨迹采用圆弧过渡，姿态轨迹采用四元数B样条过渡，计算过渡轨迹本文档来自技高网...
【技术保护点】
1.一种位姿同步的六轴工业机器人轨迹平顺方法，其特征在于：包括如下步骤：/n步骤1、根据过渡误差约束、连续性条件和位姿同步性确定每个位置点和姿态点的过渡参数，其中过渡参数用于确定过渡轨迹的起点和终点；/n步骤2、根据过渡参数构造位置和姿态的过渡轨迹；/n其中，所述步骤1具体包括如下步骤：/n步骤1.1、将六轴工业机器人的线性轨迹的位置点用三维点P
【技术特征摘要】
1.一种位姿同步的六轴工业机器人轨迹平顺方法，其特征在于：包括如下步骤：
步骤1、根据过渡误差约束、连续性条件和位姿同步性确定每个位置点和姿态点的过渡参数，其中过渡参数用于确定过渡轨迹的起点和终点；
步骤2、根据过渡参数构造位置和姿态的过渡轨迹；
其中，所述步骤1具体包括如下步骤：
步骤1.1、将六轴工业机器人的线性轨迹的位置点用三维点Pi(xi,yi,zi)表示，姿态点用四元数qi(qi,1,qi,2,qi,3,qi,4)表示，其中序号i＝1,2,…N,N为总的轨迹点个数(N≥3)；
步骤1.2、遍历除首尾端点外的内部轨迹点Pi(xi,yi,zi),i＝2,3,…N-1，根据位置点的过渡误差阈值δp，计算每个位置点Pi(xi,yi,zi)的过渡圆弧的最大位置过渡参数；
步骤1.3、遍历除首尾端点外的轨迹点Pi,i＝2,3,…N-1，根据姿态点的过渡误差阈值δo，计算每个姿态点qi(qi,1,qi,2,qi,3,qi,4)的过渡四元数B样条的最大姿态过渡参数；
步骤1.4、计算满足轨迹点误差且位姿同步的过渡参数ti,1,ti,2和比例系数c；
所述步骤2具体包括如下步骤：遍历除首尾端点外的轨迹点Pi,i＝2,3,…N-1，所述步骤2针对可平顺段进行平顺，具体包括如下步骤：
步骤2.1、根据过渡参数构造位置轨迹的过渡圆弧，圆弧轨迹表示为：
步骤2.2、根据过渡参数和比例系数构造姿态轨迹的过渡曲线，其中控制点如步骤1.3中定义，节点向量为U＝[0,0,0,0,0.5,1,1,1,1]，为四元数B样条的累加和基函数，四元数B样条曲线表示为：
2.根据权利要求1所述的位姿同步的六轴工业机器人轨迹平顺方法，其特征在于：所述步骤1.2的具体算法为：首先，计算线段Pi-1Pi的长度Li-1和线段PiPi+1的长度Li,若长度Li-1或长度Li太短(小于距离阈值)，则该轨迹段不需平顺；否则计算线段Pi-1Pi和线段PiPi+1的夹角若夹角接近0度或180度，则该轨迹段也不需平顺，将位置轨迹的不需平顺段做标记，以下先来介绍需平顺段的过渡方法；
然后，设ri,1和ri,2为两个位置过渡参数，过渡圆弧的起点可表示为Ei,0＝Pi+ri,1(Pi-1-Pi),终点可表示为Ei,1＝Pi+ri,2(Pi+1-Pi)，根据过渡的对称性条件建立两个位置过渡参数之间的关系：ri,1Li-1＝ri,2Li；
最后...
【专利技术属性】
技术研发人员：颜昌亚，何姗姗，唐小琦，李振瀚，周向东，卢少武，张庆祥，曾祥兵，谭辉，周少峰，马国龙，
申请(专利权)人：东莞市三姆森光电科技有限公司，
类型：发明
国别省市：广东;44
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。