1.一种可控误差的工业机器人光顺运动轨迹生成方法，其特征在于，包括如下步骤：S1、生成MOVEB运动指令：MOVEB运动指令用来描述工业机器人运动轨迹，包括轨迹点和姿态，以及用户输入的轨迹点误差阈值和弦高误差阈值；

S2、机器人轨迹点的插值：将MOVEB运动指令表示的工业机器人运动轨迹导入机器人控制系统，利用高阶B样条插值算法，将高阶B样条曲线按照轨迹点误差和弦高误差阈值对轨迹点进行插值，分别实现机器人轨迹点的G2插值和G3插值，得到具有高连续性并且保证满足轨迹点误差和弦高误差要求的插值轨迹；

2 3

S3、机器人姿态的插值：通过B样条插值算法分别实现机器人姿态的分段G和G插值，并对插值后的机器人轨迹的姿态进行单位正交化处理，得到分段G2和G3连续的机器人姿态曲线；

S4、生成机器人插值后的运动轨迹：通过上述步骤S2获取的轨迹点插值曲线和步骤S3获取的机器人姿态曲线共同得到机器人插值后的运动轨迹。

2.根据权利要求1所述的可控误差的工业机器人光顺运动轨迹生成方法，其特征在于，所述步骤S1中MOVEB运动指令的数据内容包括X,Y,Z,I,J,K,U,V,W,D,E共十一个变量，其中(X,Y,Z)表示工具坐标系下的轨迹点的坐标，(I,J,K)表示上述轨迹点处建立的工具坐标系的Z轴单位矢量，(U,V,W)表示工具坐标系的X轴单位矢量，D,E分别表示弦高误差阈值和轨迹点误差阈值。

3.根据权利要求1所述的可控误差的工业机器人光顺运动轨迹生成方法，其特征在于，所述步骤S2及步骤S3中，机器人控制系统解析MOVEB运动指令时，将轨迹点误差阈值和弦高误差阈值相同的一段连续轨迹组成一组进行插值。

4.根据权利要求2所述的可控误差的工业机器人光顺运动轨迹生成方法，其特征在于，所述步骤S2中，机器人轨迹点的插值具体包括如下步骤：步骤一：初始迭代参数决定，从MOVEB运动指令中获取一组机器人原始轨迹点N≥2、弦高误差阈值D和轨迹点误差阈值E；迭代次数记为k＝0，计算初始迭代轨迹点 和初始迭代弦高误差阈值

步骤二：具体包括：

①建立每个内部轨迹点 处的桥接B样条曲线，在整个步骤二中，省略迭代次数k，即 等同于Pi， 等同于di：

桥接B样条曲线的次数为p,共有2p+1个控制点，分别为 A1,i，A2,i…Ap,i,Qi,Bp,i,…B2,i,B1,i,节点矢量为{0,0.5,1},三个节点的重复度分别为p+1,p,p+1；该桥接B样条曲线等价于两条对称的p次Bezier曲线；

②建立在Qi对称的两条p次Bezier曲线，两条Bezier曲线的控制点分别为A1,i,A2,i…Ap,i,Qi和Qi,Bp,i,…B2,i,B1,i，其中A1,i，A2,i…Ap,i与Pi-1Pi共线，Bp,i,…B2,i,B1,i与PiPi+1共线，Qi为Ap,iBp,i的中点；

③分G2和G3插值两种情形给出保证桥接B样条曲线处处G2或G3连续的控制点：设

其中T0,i为Pi-1Pi的单位向量；T1,i为的Ap,iBp,i单位向量；hi为线段Ap,iPi的长度；θi为向量T0,i和T1,i的夹角；

i)在G2插值时，G2桥接曲线的控制顶点满足以下条件：Qi＝Pi-hiT0,i+hicosθiT1,i

A3,i＝Qi-hicosθiT1,i

A2,i＝A3,i-hiT0,i

A1,i＝A2,i-βihiT0,i

ii)在G3插值时，G3桥接曲线的控制顶点满足以下条件：Qi＝Pi-hiT0,i+hicosθiT1,i

A4,i＝Qi-hicosθiT1,i

A3,i＝A4,i-αihiT0,i

A1,i＝A2,i-βihiT0,i

αi≥0.7,0<βi≤0.5

在G2插值时，hi,βi为两个桥接曲线参数；在G3插值时,hi,αi,βi为三个桥接曲线参数，桥接曲线参数决定了桥接曲线控制点的位置，在以下步骤⑤中通过目标函数最优化求解得到，B1,i,B2,i,…,Bp,i由桥接B样条曲线的对称性得到；

④以桥接曲线更平缓为目标建立优化目标函数，并给出保形和弦高误差控制的约束条件：

2 3

两条Bezier曲线构造的G 桥接曲线和G 桥接曲线在交点Qi处的曲率最大，且最大曲率分别为 和 为得到更平缓的桥接曲线，要求kg2max和kg3max越小，即要求步骤③中桥接曲线参数hi越大，因此将目标函数定义为求解桥接曲线参数hi,i＝1,2,…N-1的和最大问题，即如下式(1)所示：为实现保形约束，要求两个轨迹点之间的桥接曲线不存在重合部分，其中G2连续和G3连续的桥接保形约束为：|Pi-1B1,i-1|+|A1,iPi|≤|Pi-1Pi|,i＝2,…N-1   (2)|A1,1P1|≤|P0P1|   (3)

|PN-1B1,N-1|≤|PN-1PN|   (4)为实现弦高误差约束，只需控制PiQi的距离不大于迭代弦高误差阈值di即可，即：|PiQi|≤di   (5)

⑤求解最优化问题即式(1)，同时要求桥接曲线参数满足约束条件式(2)、(3)、(4)、(5)，求解出桥接曲线参数，即得到迭代轨迹点的桥接轨迹；

步骤三：计算桥接轨迹与原始轨迹点的轨迹点误差最大值Δk，并判断Δk是否大于轨迹点误差阈值E，轨迹点误差的计算方法为计算轨迹点与两条Bezier曲线交点 的距离，本步骤三中加k上标参数与步骤二中未加k上标参数等同，为描述第k次迭代的误差检测，未省略k：其中 位于 的角平分线上，根据插值曲线的对称性，通过计算的大小和角平分线向量得到，计算方法为：

若Δk>E，说明桥接曲线未满足轨迹点误差要求，进入步骤四更新迭代轨迹点和迭代弦高误差阈值；否则，插值成功，退出迭代，导出插值轨迹；

步骤四：更新迭代参数，令迭代轨迹点的调整向量为：

调整后的迭代轨迹点为： 迭代弦高误差阈

值为： 更新迭代次数：k＝k+1，转步骤二。

5.根据权利要求1所述的可控误差的工业机器人光顺运动轨迹生成方法，其特征在于，所述步骤S3中，机器人姿态的插值具体包括如下步骤：步骤一：计算偏移点，记 处的工具坐标系的X轴单位矢量为Z轴单位矢量为 将 沿X轴偏移一段固定距离m，得到X轴偏移点记为将 沿Z轴偏移一段固定距离n，得到Z轴偏移点记为

步骤二：对X轴偏移点和Z轴偏移点插值，采用轨迹点插值的方法分别对X轴偏移点、Z轴偏移点 进行插值，得到分段插值曲线O (t),R(t)；

步骤三：计算插值后的轨迹的姿态，记机器人轨迹点的分段插值曲线为P(t)，插值后的X轴矢量：X(t)＝O(t)-P(t)，Z轴矢量：Z(t)＝R(t)-P(t)，对X轴矢量、Z轴矢量单位正交化处理，进一步计算得到插值后单位正交的X轴单位矢量、Z轴单位矢量：插值后的X轴单位矢量Xnew(t)为：

插值后的Z轴单位矢量Znew(t)为：

Znew(t)＝F(t)×Xnew(t)×F(t)其中

根据以上得到的Xnew(t)，Znew(t)描述插值后的姿态曲线，得到每个轨迹插值曲线上轨迹点对应的姿态信息。

6.根据权利要求5所述的可控误差的工业机器人光顺运动轨迹生成方法，其特征在于，所述步骤S3的步骤一中，偏移距离m，n的取值设置为轨迹点平均间距的5～10倍。

7.根据权利要求5所述的可控误差的工业机器人光顺运动轨迹生成方法，其特征在于，所述步骤S3的步骤三中，单位正交化之后的姿态分段曲线具有分段G2或G3连续性，即在分段点之间的曲线G2或G3连续，在分段点处至少具有G0连续性。