【技术实现步骤摘要】
一种面向冗余机械臂的无模型碰撞避免控制方法
本专利技术涉及冗余机械臂碰撞避免控制方法领域，更具体地，涉及一种面向冗余机械臂的无模型碰撞避免控制方法。
技术介绍
在现代制造业中，冗余机械臂已经得到了广泛的运用。而冗余机械臂的碰撞避免控制则是一种非常常见的应用场景。在冗余机械臂的任务轨迹中，经常会需要躲避各种各样的环境障碍物，如进行外科手术、组装零件等。即使无环境障碍物，碰撞避免控制也可用于躲避冗余机械臂自身或基座、躲避奇异构形或改善当前构形等。目前对于冗余机械臂的碰撞避免控制算法已经有许多研究，主要方向有两种，一是控制使得冗余机械臂与障碍物之间的距离最大化，二是将无碰撞要求视为一个等式约束，即为易受碰撞的冗余机械臂连杆产生逃离障碍物的速度，但是这些碰撞避免控制算法都需要基于冗余机械臂模型进行控制。目前，有文献中提出的基于线性变分不等式的原始对偶神经网络二次规划冗余机械臂碰撞避免控制方法。该方法提出了以下机械臂的控制方案：约束条件为：...
【技术保护点】
1.一种面向冗余机械臂的无模型碰撞避免控制方法，其特征在于，所述方法包括以下步骤：/nS1：建立冗余机械臂的逆向运动学方程；并建立碰撞避免的约束不等式；/nS2：将冗余机械臂的逆向运动学问题表示为微分方程形式；得到冗余机械臂的逆向运动学微分方程；/nS3：建立估计雅克比矩阵的微分方程；估计冗余机械臂末端的雅克比矩阵的估计值和冗余机械臂临界点处的雅克比矩阵估计值；/nS4：联立冗余机械臂的逆向运动学微分方程、冗余机械臂末端的雅克比矩阵的估计值、冗余机械臂临界点处的雅克比矩阵估计值，得到冗余机械臂的每个关节的角度随时间变化的函数；将关节角度-时间信息输入该函数，即可让机械臂按照...
【技术特征摘要】
1.一种面向冗余机械臂的无模型碰撞避免控制方法，其特征在于，所述方法包括以下步骤：
S1：建立冗余机械臂的逆向运动学方程；并建立碰撞避免的约束不等式；
S2：将冗余机械臂的逆向运动学问题表示为微分方程形式；得到冗余机械臂的逆向运动学微分方程；
S3：建立估计雅克比矩阵的微分方程；估计冗余机械臂末端的雅克比矩阵的估计值和冗余机械臂临界点处的雅克比矩阵估计值；
S4：联立冗余机械臂的逆向运动学微分方程、冗余机械臂末端的雅克比矩阵的估计值、冗余机械臂临界点处的雅克比矩阵估计值，得到冗余机械臂的每个关节的角度随时间变化的函数；将关节角度-时间信息输入该函数，即可让机械臂按照躲避障碍物的轨迹运动。
2.根据权利要求1所述面向冗余机械臂的无模型碰撞避免控制方法，其特征在于，S1中所述冗余机械臂的逆向运动学方程具体为：
其中，是待实时求解的决策变量，也即冗余机械臂的关节的角速度；n是冗余机械臂的自由度；系数矩阵W是n*n维的单位矩阵；系数向量q＝4(θ-θ(0))，其中θ(0)是每个关节的初始角度，θ是t时刻的关节角度。
3.根据权利要求2所述面向冗余机械臂的无模型碰撞避免控制方法，其特征在于，S1中所述碰撞避免的约束不等式为：
其中，Je是冗余机械臂末端的雅可比矩阵；是冗余机械臂的末端执行器在任务空间的期望轨迹的时间导数，也即末端执行器的速度；
矩阵A和向量b分别由下式推导得出：
sgn函数为符号函数，其输出值为1或-1；Jc是冗余机械臂临界点处的雅可比矩阵；d2为警戒距离，当机械臂与障碍物的距离小于该值时开始避障计算；d1为极限距离，我们一般认为当机械臂与障碍物的距离小于该值时发生碰撞；xo、yo、zo分别为障碍物点O在x轴、y轴、z轴的坐标；xc、yc、zc分别为机械臂临界点C在x轴、y轴、z轴的坐标；
ξ-和ξ+都是n维向量，分别表示冗余机械臂的关节的物理最小极限和最大极限。
4.根据权利要求3所述面向冗余机械臂的无模型碰撞避免控制方法，其特征在于，假设冗余机械臂的关节具有速度极限和角度极限：
θ-≤θ≤θ+
则ξ-的具体定义如下：
β是调节参数，用于调节关节极限转换之后的可行域的大小；θ-、θ+为关节角度的最小、最大极限，为关节角速度的最小、最大极限。
5.根据权利要求4所述面向冗余机械臂的无模型碰撞避免控制方法，其特征在于，
ξ+的具体定义如下：
6.根据权利要求4所述面向冗余机械臂的无模型碰撞避免控制方法，其特征...
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。