【技术实现步骤摘要】
一种双编码器柔性关节的振动抑制方法及控制系统
本专利技术属于双编码器柔性关节振动抑制
，尤其涉及一种双编码器柔性关节的振动抑制方法及控制系统，应用于协作机器人的双编码器柔性关节的振动抑制，同时适用于其他可以直接或者间接地测得电机端和负载端运动学信息的柔性关节系统。
技术介绍
随着社会科技的发展，人机协作机器人逐步进入工业、服务业和人们的日常生活之中，但是“振动”始终是人机协作机器人中的核心问题，对于含有双编码器柔性关节的协作机器人，振动抑制的基础主要是对其关节的振动进行抑制。在现有技术中，基于等效刚体速度的振动抑制方法，其控制系统的刚体速度是通过关节电机的输入力矩等效求得的，但是对于一些关节电机输入端没有安装相应的力矩传感器的柔性关节，该方法无法获得关节电机的输入力矩，进而无法实现对刚体速度的求解，使得基于等效刚体速度的方法无法应用到未安装输入端力矩传感器的柔性关节中，这个问题亟待解决。针对以上不足，本专利技术提出的方法基于柔性关节电机端和负载端的运动学信息进行加权求和得到等效刚体速度，在刚体速度的基础上，通过刚体速度...
【技术保护点】
1.一种双编码器柔性关节的振动抑制方法，其特征在于，所述振动抑制方法包括：/n基于传感器测量电机端速度和负载端速度；/n基于刚体速度求解器根据所述传感器测得的电机端速度和负载端速度计算得到刚体速度；/n基于频率筛选器将所述电机端速度或所述负载端速度与所述刚体速度的误差经过频率筛选后得到特定频率区间的纯振动速度，并将所述纯振动速度反馈到所述速度控制器的输入；/n基于速度控制器的电机端速度或负载端速度反馈，利用频率筛选器反馈的纯振动速度来修正速度控制器的输入信号，从而得到修正后的速度控制器输出，即电机输入力矩，并将所述电机输入力矩作为双编码器柔性关节的输入；/n所述振动抑制方法...
【技术特征摘要】
1.一种双编码器柔性关节的振动抑制方法，其特征在于，所述振动抑制方法包括：
基于传感器测量电机端速度和负载端速度；
基于刚体速度求解器根据所述传感器测得的电机端速度和负载端速度计算得到刚体速度；
基于频率筛选器将所述电机端速度或所述负载端速度与所述刚体速度的误差经过频率筛选后得到特定频率区间的纯振动速度，并将所述纯振动速度反馈到所述速度控制器的输入；
基于速度控制器的电机端速度或负载端速度反馈，利用频率筛选器反馈的纯振动速度来修正速度控制器的输入信号，从而得到修正后的速度控制器输出，即电机输入力矩，并将所述电机输入力矩作为双编码器柔性关节的输入；
所述振动抑制方法通过修正所述速度控制器的输入信号来实现对柔性关节的振动抑制。
2.根据权利要求1所述的方法，被控对象关节在电机端和负载端均安装有传感器，所述传感器指任何可以直接或者间接地测得电机端和负载端的运动学信息，所述运动学信息指关节的角位移或者角速度。
3.根据权利要求1所述的方法，所述刚体速度是由电机端速度和负载端速度加权求和得到的，电机端速度的权重是电机端惯量与总惯量的比值，负载端速度的权重是负载端惯量与总惯量的比值，所述总惯量为电机端惯量与负载端惯量之和。
4.根据权利要求1所述的方法，所述频率筛选器包括高通滤波器、低通滤波器和增益调节器；所述高通滤波器和低通滤波器的截止频率设置为需要抑制的振动频率的一定范围内，从而使所述高通滤波器和所述低通滤波器形成带通滤波器；所述增益调节器用于对形成的所述带通滤波器的幅值比进行调整，将需要抑制的振动频率的幅值比保证为0db附近，同时其相位无超前和滞后，这样筛选出来的纯振动信号中的频率成分主要是对应0db附近的振动频率。
5.根据权利要求1所述的方法，所述速度控制器基于电机端速度反馈时，从输入到输出的传递函数Pm(s)的表达式如下式：
所述速度控制器基于负载端速度反馈时，从输入到输出的传递函数Pl(s)的表达式如下式：
其中，C为速度控制器的控制参数；ωr为被控对象的系统谐振点频率，即双编码器柔性关节的系统谐振点频率；ωa为被控对象的系统反谐振点频率，即双编码器柔性关节的系统反谐振点频率；s为所述传递函数在拉普拉斯域中的变量；K为频率筛选器中的增益调节器，即纯振动信号的反馈增益。
6.一种双编码...
【专利技术属性】
技术研发人员：陈庆盈，辛强，王冲冲，张驰，杨桂林，
申请(专利权)人：中国科学院宁波材料技术与工程研究所，
类型：发明
国别省市：浙江;33
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。