1.一种基于高阶控制障碍函数的机械臂安全避障控制方法，其特征在于，所述方法包括步骤：步骤1、建立多自由度机械臂的动力学模型，将关节空间的动力学方程变换到笛卡尔空间；

步骤2、基于任务轨迹结合反步控制方法设计稳定跟踪控制器，在笛卡尔空间进行任务轨迹规划，将非线性系统分解成一系列不超过系统阶数的子系统，逐级设计李雅普诺夫函数；

步骤3、通过高阶控制障碍函数为控制系统提供安全约束，建立基于距离的障碍物碰撞检测模型，用于描述高阶控制障碍函数，定义安全集合，引入 类函数，通过逐级求导定义辅助函数，设计高阶控制障碍函数控制约束集合；

步骤4、结合控制约束与最优控制问题，通过二次规划求解最优控制输入。

2.根据权利要求1所述的方法，其特征在于，步骤1所述的建立多自由度机械臂的动力学模型包括：步骤1.1建立机械臂关节空间和笛卡尔空间的动力学方程：对于一个自由度为n的机械臂，其运动控制方式为力矩控制，并且已辨识其动力学模型，能够在线获取时变的动力学参数；

机械臂关节空间下的动力学方程为

其中， 表示各个关节的力矩矢量， 分别表示各个关节的角度，角速度以及角加速度矢量， 表表示机械臂的对称正定质量矩阵， 表示离心力和哥氏力矢量， 表示重力矢量；

机械臂笛卡尔空间下的动力学方程为

其中， 表示作用于末端执行器上的力矩矢量， 表示末端执行器位姿的笛卡尔矢量， 表表示笛卡尔质量矩阵， 表示笛卡尔空间中的速度项矢量， 表示笛卡尔空间中的重力项矢量；

步骤1.2将机械臂关节空间的动力学方程变换到笛卡尔空间：作用于末端执行器上的虚拟力 可以用关节驱动器的驱动力τ表示：其中J(q)为雅可比矩阵；由式(3)以及 推导，式(1)和式(2)中各项系数之间的关系为：

3.根据权利要求1所述的方法，其特征在于，步骤2所述的结合反步控制方法设计稳定跟踪控制器包括：步骤2.1规划笛卡尔空间任务轨迹：

在笛卡尔空间规划起始点x0到终止点xe的一条路径，得到任务轨迹，同时设计每一时刻机械臂在路径上的期望位置、速度及加速度；

步骤2.2结合反步控制设计各阶系统的稳定跟踪控制器：选取末端执行器位置x和速度 作为状态向量，得到动力学方程(2)的一个状态空间模型实现：其中， 为系统状态， 为系统控制输入，y＝x为系统控制输出；u首次出现在输出x的二阶微分方程中，因此系统的相对阶m＝2将系统分解为一阶子系统和二阶系统；

从一阶子系统 开始反推，将x2作为系统虚拟输入，定义误差e1＝x1‑x1d，构建李雅普诺夫函数 其关于时间的导数 根据李雅普诺夫稳定性判定定理，若要系统稳定，则需保证 引入参数k1＞0，令 即 恒成立，设计x2的跟踪值x2d为

对于二阶系统，定义误差e2＝x2‑x2d，构建李雅普诺夫函数 对V2求导，并代入 以及式(6)：为了保证 引入参数k2＞0，令

又由于 代入 以及式(6)：

将式(9)代入式(8)，系统的稳定跟踪控制器(也称为标称控制器 为其中k1和k2为可调的控制参数，且为正数。

4.根据权利要求1所述的方法，其特征在于，步骤3所述的通过高阶控制障碍函数为控制系统提供安全约束，包括：步骤3.1建立基于距离的障碍物碰撞检测模型，描述高阶控制障碍函数：对于一个仿射控制系统：

其中， 为系统状态， 为局部Lipschitz函数，(U表示一个封闭控制约束集)，初始状态x(t0)，式(11)的解x(t),t≥t0是前向完备的；特别的，式(5)中，首先为机械臂及其工作环境中的障碍物建立简化的几何模型，使用平面或包络球来近似表示障碍物，将机械臂与障碍物之间的碰撞检测转化为判断最小距离是否为正的问题，有效降低计算复杂度；定义一个候选高阶控制障碍函数(HOCBF)：m＝2阶连续可微函数b(x)：b(x)＝dsafe‑dmin(x) (12)其中，dmin(x)为机械臂末端执行器到障碍物的最小距离，dsafe为设定的安全距离，当b(x)≥0时系统是安全的；

步骤3.2定义安全集合：

安全性在强制集合不变性的背景下构建，即不离开安全集合；将安全集合C定义为连续可微函数b(x)： 的超零水平集如果从任意x(t0)∈C开始的解满足 则集合C是前向不变的，即系统(11)对于集合C是安全的；

步骤3.3引入 类函数，通过逐级求导定义辅助函数：如果一个Lipschitz连续函数α:[0,a)→[0,∞),a＞0是严格递增的，且α(0)＝0，则称该函数属于 类函数；选取 类函数α1(·)，α2(·)，通过对b(x,t)依次求时间的导数，定义辅助函数为对应的安全集合序列Ci为：

步骤3.4设计高阶控制障碍函数控制约束集合：若存在 类函数α1(·)，α2(·)使

对于所有(x,t)∈C1(t)∩C2(t)∩C3(t)×[t0,∞)成立，则函数b(x,t)是系统(11)的一个HOCBF，其中 和 分别表示沿f和g的关于x的Lie导数，O(b(x,t))具体如下表示ψ1作为α1(·)的自变量，即α1(ψ1)；

HOCBF控制约束集合为：

在集合Khocbf内的控制输入u，能够保证系统安全性。

5.根据权利要求1所述的方法，其特征在于，步骤4所述的结合控制约束与最优控制问题，通过二次规划求解最优控制输入，包括：步骤4.1结合控制约束与最优控制问题：

为了最小化控制输入的变化，以跟踪任务轨迹，将约束(18)与最优控制问题相结合，得到HOCBF‑QP：*

其中，u 为目标函数，满足不等式约束，u为待求解的优化变量，unorm为标称控制器的控*制输入；当系统状态在安全集合C内时，问题的解为u＝unorm，这表明系统控制输入由标称控制器决定；当系统状态离开安全集合C时，加入强制的控制约束，牺牲跟踪性能以满足安全性，直到机械臂远离危险区域；

步骤4.2求解二次规划，得到实时的最优控制输入：该问题在每个时间步长处进行求解，将时间区间[t0,tf]分成一系列不等的时间间隔{[t0,t0+Δt1),[t0+Δt1,t0+Δt1+Δt2),...}(20)其中Δti＞0；在每个区间保持状态恒定为在其区间开始时的值，并且假设控制是恒定的，将优化问题表示为QP序列；具体地，在 求解QP：QP的标准形式为

对于对称正定矩阵H和常数向量F，由于

忽略最后一项常数项，H＝2In，

将不等式约束转化为Ax≤B的形式，则

将H,F,A,B代入二次规划求解器，得到的解向量即为当前时间段在笛卡尔空间下的机械臂末端执行器虚拟控制力矩 再将其转换到关节空间，就是关节驱动器的最优控制输*入力矩τ ，即机械臂的安全控制器为

6.一种基于高阶控制障碍函数的机械臂安全避障控制系统，其特征在于，包括：动力学模型建立模块，用于建立多自由度机械臂的动力学模型，将关节空间的动力学方程变换到笛卡尔空间；

稳定跟踪控制器设计模块，基于任务轨迹结合反步控制方法设计稳定跟踪控制器，在笛卡尔空间进行任务轨迹规划，将非线性系统分解成一系列不超过系统阶数的子系统，逐级设计李雅普诺夫函数；

高阶控制障碍函数约束建立模块，建立基于距离的障碍物碰撞检测模型，用于描述高阶控制障碍函数，为控制系统提供安全约束，定义安全集合，引入 类函数，通过逐级求导定义辅助函数，设计高阶控制障碍函数控制约束集合；

最优控制输入求解模块，结合控制约束与最优控制问题，通过二次规划求解最优控制输入。

7.一种基于高阶控制障碍函数的机械臂安全避障控制装置，其特征在于，包括存储器和一个或多个处理器，所述存储器中存储有可执行代码，所述一个或多个处理器执行所述可执行代码时，用于实现权利要求1‑5中任一项所述的一种基于高阶控制障碍函数的机械臂安全避障控制方法。

8.一种计算机可读存储介质，其特征在于，其上存储有程序，该程序被处理器执行时，实现权利要求1‑5中任一项所述的一种基于高阶控制障碍函数的机械臂安全避障控制方法。