1.一种基于力矩控制的工业机器人避障轨迹规划方法，其特征在于：

首先，通过辨识各关节运动学以及惯性参数建立机器人动力学模型；

然后，通过逆运动学求解得到运动到终点姿态时各关节角的位移；

最后，以关节角位移作为运动路程，采用一种正弦加加速度规划方法进行各关节的速度加速度规划，将速度和加速度代入动力学模型即可求解运动路径中的控制力矩；

对于运行过程中可能发的碰撞，采用一种检测关节投影干涉情况然后判断关键点距离的方法进行碰撞检测：将机器人关节向速度向量的法平面投影，若关节投影发生干涉则对关节轴线上各关键点最短距离进行判断，若小于运行时的安全距离则认为存在碰撞的风险；检测到碰撞可能发生，然后对危险关节施加一种阻抗加速度降低关节运动速度从而实现避障。

2.如权利要求1所述的基于力矩控制的工业机器人避障轨迹规划方法，其特征在于：所述规划方法包括以下步骤：步骤1：工业机器人的动力学参数辨识

采用对机器人整体进行试验的整体辨识法对机器人的动力学参数进行辨识，为了使机器人能实现任意轨迹规划，采用周期性轨迹，每个关节的激励轨迹是正弦和余弦函数的代数和，即有限的傅立叶级数函数，则机器人每个关节的关节位置q规划如下：其中q表示关节转角，ai、bi表示轨迹的常系数，ωf为轨迹的基频，iωf表示第i阶的频率，t＝kTs表示采样时刻，k表示采样个数，Ts表示采样周期；

以有限的傅立叶级数函数为机器人待辨识关节的辨识激励轨迹，机器人沿预设轨迹运动过程中，通过测电流法采集关节的驱动力矩；通过安装在电机上的编码器采集关节转角，对转角微分得到动态参数中的角速度 和角加速度 以最小二乘法作为辨识算法可以求解出惯性参数的值：从而求得精确地动力学模型： 其中τ为机器人的驱动力矩；

向量D(q)称为机械臂的质量矩阵； 为科氏力及离心力项；G(q)为重力项；

步骤2：工业机器人运动学逆解

采用解析解法求解机器人从初始位置到末端位置各关节运动角位移，对于逆运动学求解出现多解和奇异解的问题，除了通过设定各个关节的旋转范围限制来去除无效解和避免奇异解的方法以外，还根据运动能量最小原则选择消耗能量最小的逆解值作为关节的执行量，计算方法如下：计算与前一个关节差的平方和，选择计算结果最小的一组关节位置作为下一个关节执行的位置，逆解选择的表达式如下：步骤3：正弦加加速度关节轨迹规划

采用正弦加加速度规划方法能够对各关节轨迹进行高速、平滑的规划，完成从起点到终点的姿态规划；

为了能够实现运动速度以及加速度控制的能力，对于机器人末端操作器的速度，加速度的边界进行限制，有如下三点：

1)运动角位移：D；

2)运动学上边界：最大角速度ωmax，最大角加速度αmax，最大角加加速度Jmax；

3)运动学下边界：

将加加速度设定为正弦函数曲线：

在运动轨迹的限制条件下，运动距离具有两个临界点，其分别为Dmin和Dmin2，在维持加加速度不变的情况下，最大速度和最大加速度都能够达到，运动位移有一个临界最小值，称为Dmin：其中dmin为初速为零时加速到ωmax时的运动距离daccinc表示加速到最大速度时的运动距离；daccdec表示加ω速度减小到最小值时运动的距离；如果最大加速度未能够达到但是恰好达到了最大速度，运动位移有另一个临界值最小值，被称为Dmin2：其中dt′为重新计算后的加速运动时间，然后根据运动边界值的不同计算出不同阶段的运动时间，通过对正弦曲线的加加速度积分得到加速度、速度以及位移的运动轨迹；

步骤4：碰撞检测

对于两个机器人同时作业，按照关节几何形状，采用半球端面圆柱体包络两个关节从而得到标准化后的关节边界，两球面端点连线为关节轴线，长度为li，i＝1,2；圆柱体半径为ri，在各轴线按等间距取 个点作为计算关节距离的关键点记为 根据关节轴线上所取关键点可得两关节碰撞时的临界距离：根据dhit设定碰撞检测的极限距离dlim＝k1*dhit以及安全距离dsafe＝k2*dhit，k1,k2为安全系数；

根据关节角位移以及瞬时角速度可由正运动学求解得各关键点的笛卡尔坐标以及关节末端速度向量VF，将 投影到VF向量的法平面得到关键点的投影点判断各投影点之间的最小距离若：则说明两个关节在速度向量法平面的投影发生干涉，则进一步判断各关节关键点之间最短距离，若有：d＝min{‖P11-P21‖,‖P11-P22‖,‖P11-P23‖…‖P11-P24‖}

步骤5：阻抗控制避障规划

如果步骤4中的关键点之间最短距离ddsafe则更新角速度为当前运动角速度ωi以及路径距离Di，然后继续按步骤3的正弦加加速度方法进行速度和加速度规划。

3.如权利要求2所述的基于力矩控制的工业机器人避障轨迹规划方法，其特征在于：所述步骤3中，如果任务要求的执行距离D大于最大加速度和最大速度同时能够达到的最小距离Dmin，D≥Dmin2，那么将根据如下公式：Taccinc表示加速到最大速度时的运动时间；Taccdec表示加ω速度减小到最小值时运动的时间；Tacc表示在加速度增加到最大值恒定阶段时加速过程中运动的时间，Tret表示在负加速度增加到最大值恒定阶段时减速过程中运动的时间，Tvel表示恒速运动的时间。

4.如权利要求2所述的基于力矩控制的工业机器人避障轨迹规划方法，其特征在于：所述步骤3中，如果任务要求的运动距离D小于满足最大加速度的最小距离Dmin，但是大于能够达到最大速度距离，D≥Dmin2；这时运动达到的最大加速度以及加速运动时间需要重新计算得：Taccinc＝Taccdec＝dt′,Tretinc＝Tretdec＝dt,Tacc＝0,

5.如权利要求2所述的基于力矩控制的工业机器人避障轨迹规划方法，其特征在于：所述步骤3中，如果任务给定的运动距离D不足以使得速度和加速度都达到给定的速度和加速度，D≤Dmin2，那么采取先匀速后减速的运动策略：当D>αmaxdt，

当D<αmaxdt时减速运动时间和最大加速度需要根据距离重新计算：利用正弦加加速度轨迹规划根据当前速度以及路径距离，对后续运动的加速度以及速度进行平滑地规划从而实现运行过程中的平稳力矩控制。