四自由度圆柱坐标型码垛机器人末端残余振动抑制方法技术

本发明专利技术提出一种四自由度圆柱坐标型码垛机器人末端残余振动抑制方法，采集安装在四自由度圆柱坐标型码垛机器人大臂和末端的两个加速度传感器信号aB(t)和aT(t)，将aB(t)和aT(t)进行离散傅立叶变换得到aB(jω)和aT(jω)，将aT(jω)进行截止频率计算并得到截止频率ωc，通过aB(jω)、aT(jω)和ωc计算求得速度因子s和位置因子p，然后，通过s、p和ωc计算求得补偿力矩的参数，并得到补偿力矩F，将F作为码垛机器人腰部关节伺服电机的前馈补偿力矩对末端残余振动进行抑制。本发明专利技术的有益效果：针对四自由度圆柱坐标型码垛机器人高速定位时末端容易产生残余振动的问题，基于加速度传感器信号建立机器人腰部伺服电机补偿力矩进行振动抑制，该补偿力矩的参数通过在线整定方式进行快速优化。

Method for suppressing terminal residual vibration of cylindrical coordinate type robot with four degrees of freedom

The invention provides a method for the end of the residual vibration of four degrees of freedom cylindrical palletizing robot control, acquisition installed in two acceleration sensor signal aB four degrees of freedom cylindrical palletizing robot arm and the end (T) and aT (T), aB (T) and aT (T) to get aB discrete Fu Liye transform (J W) and aT (J W), aT (J W) of the cut-off frequency was calculated and the cut-off frequency omega C, through aB (J W), aT (J, Omega and Omega C) calculated the speed factor s and factor p position, and then, by s, P C and Omega calculated fill parameter compensation torque, and compensated torque F, F as feedforward compensation torque of the palletizing robot waist joint servo motor to suppress the residual vibration of the end. The invention has the beneficial effects for four degrees of freedom cylindrical high-speed palletizing robot positioning terminal to produce residual vibration, acceleration sensor signal robot servo motor torque compensation waist vibration suppression based on the parameters of the compensating torque through the online tuning mode fast optimization.

【技术实现步骤摘要】
用于四自由度圆柱坐标型码垛机器人的末端残余振动抑制的方法
本专利技术涉及机器人控制
，特别是涉及一种用于四自由度圆柱坐标型码垛机器人的末端残余振动抑制的方法。
技术介绍
四自由度圆柱坐标型码垛机器人是目前码垛机器人普遍采用的一种结构形式，该结构包括一个腰部旋转运动关节，一个末端旋转运动关节，一个水平直线运动关节和一个垂直直线运动关节，每个关节为一个自由度，机器人的大臂采用平行四边形的连杆机构实现机器人末端的水平和垂直直线运动。该结构的四个关节运动各自独立，不存在耦合关系，相比于其他结构形式，控制更简单，运动更高效和高速。但是，由于机器人的运动关节中采用了减速机、齿形带等器件，同时加工装配过程中存在误差，导致机器人的机械本体存在不同程度的柔性特性，会对机器人的运动性能产生一定的影响，速度越快影响越大，特别是机器人在高速定位时，其末端极易产生残余振动，残余振动会极大降低机器人的重复定位精度，延长机器人的定位时间并降低工作效率。由于运动速度是码垛机器人最关键的技术指标之一，因此，在机械本体已经无法改动的情况下，如果通过控制手段抑制机器人的末端残余振动是提高机器人性能的重要途径。专利技本文档来自技高网...

【技术保护点】
一种用于四自由度圆柱坐标型码垛机器人的末端残余振动抑制的方法，在四自由度圆柱坐标型码垛机器人的大臂和末端分别安装加速度传感器，其特征在于，包括如下步骤：步骤一、四自由度圆柱坐标型码垛机器人的末端到达某一定位点时，开始对四自由度圆柱坐标型码垛机器人的腰部旋转关节的伺服电机施加补偿力矩，连续施加第1次至第n次补偿力矩，在施加第1次至第n次补偿力矩的每一次的过程中四自由度圆柱坐标型码垛机器人的末端处于不同的定位点，补偿力矩表达式为F＝gaT(t‑τ)，其中，F为补偿力矩,g为补偿力矩的比例系数，τ为补偿力矩的时间常数，aT(t)为安装在机器人末端的加速度传感器的测量值；对四自由度圆柱坐标型码垛机器人...

【技术特征摘要】
1.一种用于四自由度圆柱坐标型码垛机器人的末端残余振动抑制的方法，在四自由度圆柱坐标型码垛机器人的大臂和末端分别安装加速度传感器，其特征在于，包括如下步骤：步骤一、四自由度圆柱坐标型码垛机器人的末端到达某一定位点时，开始对四自由度圆柱坐标型码垛机器人的腰部旋转关节的伺服电机施加补偿力矩，连续施加第1次至第n次补偿力矩，在施加第1次至第n次补偿力矩的每一次的过程中四自由度圆柱坐标型码垛机器人的末端处于不同的定位点，补偿力矩表达式为F＝gaT(t-τ)，其中，F为补偿力矩,g为补偿力矩的比例系数，τ为补偿力矩的时间常数，aT(t)为安装在机器人末端的加速度传感器的测量值；对四自由度圆柱坐标型码垛机器人的腰部旋转关节的伺服电机施加第n次补偿力矩，实现第n次抑制过程如下，四自由度圆柱坐标型码垛机器人的控制器以T为采样周期分别采集安装在机器人大臂的加速度传感器的测量值aB(t)和安装在机器人末端的加速度传感器的测量值aT(t)，采集点数为N，将aB(t)和aT(t)分别进行离散傅立叶变换，得到了第n次抑制过程中两个传感器信号的频域序列aB(n-1)(jωk)和aT(n-1)(jωk)，如下式所示，其中，aB(n-1)(nT)和aT(n-1)(nT)分别是两个传感器信号的时域离散序列，序列aT(n-1)(jωk)绝对值的最大值对应的k值记为kmax，则得到第n次抑制的截止频率为则aB(n-1)(jωc(n-1))和aT(n-1)(jωc(n-1))分别为序列aT(n-1)(jωk)和aB(n-1)(jωk)的最大值，即aB(n-1)(jωc(n-1))＝max|aB(n-1)(jωk)|aT(n-1)(jωc(n-1))＝max|aT(n-1)(jωk)|求取速度因子s第n次抑制值s(n-1)，位置因子p的第n次抑制值p(n-1)，表达式如下所示，

【专利技术属性】
技术研发人员：于清洋，黄梁松，吕新荣，
申请(专利权)人：中国石油大学华东，
类型：发明
国别省市：山东,37