CN111590579B - 一种仿人柔性手臂共振抑制方法 - Google Patents
一种仿人柔性手臂共振抑制方法 Download PDFInfo
- Publication number
- CN111590579B CN111590579B CN202010454058.9A CN202010454058A CN111590579B CN 111590579 B CN111590579 B CN 111590579B CN 202010454058 A CN202010454058 A CN 202010454058A CN 111590579 B CN111590579 B CN 111590579B
- Authority
- CN
- China
- Prior art keywords
- arm
- controller
- frequency
- resonance
- ntf
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1635—Programme controls characterised by the control loop flexible-arm control
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/04—Arrangements or methods for the control of AC motors characterised by a control method other than vector control specially adapted for damping motor oscillations, e.g. for reducing hunting
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本发明提供一种仿人柔性手臂共振抑制方法,具体提供一种基于PR控制器的仿人柔性手臂共振抑制方法,属于振动控制领域。仿人柔性手臂关节电机端输出轴和手臂连杆固定端由谐波减速器连接,谐波减速器柔轮的固有柔性,引入共振频率点,引发仿人机器人手臂产生共振问题,本发明将PR控制器引入仿人柔性手臂的控制系统,利用PR控制器在特定频率点处的扰动抑制能力,避免控制器输出信号频率等于仿人柔性手臂谐振频率引发的共振,提高了仿人柔性手臂的操作性能和稳定性。
Description
技术领域
本发明涉及振动控制领域,具体提供了一种适用于仿人柔性关节手臂共振抑制方法。
背景技术
与传统的刚性机械臂相比,仿人柔性手臂采用谐波减速器作为手臂的传动部件,既可以获得高的负载自重比,又使得手臂关节具备柔性,增加了手臂发生碰撞时的缓冲作用,减小对手臂结构的损坏,然而,由于谐波减速器固有柔性引入系统共振频率点,当驱动系统的频率与仿人柔性手臂谐振频率相等时,激发手臂共振,严重影响柔性手臂的操作性能及使用寿命。通常情况下对共振的抑制主要是陷波滤波器法,但是陷波滤波器的通带范围过宽会导致较大的相角滞后,而采用窄通带又导致谐振频率辨识影响加剧,抑制共振效果一般。因此,有必要采取有效的措施对仿人柔性手臂的共振现象进行抑制。
发明内容
针对上述现有技术中存在的缺陷,本发明提供一种基于PR控制器的共振抑制方法,解决仿人柔性手臂存在的共振问题。本发明基于PR控制器在特定频率点处的扰动抑制能力,避免逆变器输出信号频率等于手臂谐振频率引起自激振荡。其技术内容包括:
一种仿人柔性手臂共振抑制方法,具体提供一种基于PR控制器的仿人柔性手臂共振抑制方法;其特征在于:
所述基于PR控制器的仿人柔性手臂共振抑制方法,当PR控制器谐振频率ω0设置为手臂系统谐振频率ωNTF时,逆变器输出电流信号与干扰量传递函数表示为:
其中,Gc(s)为PR控制器传递函数,Ginv(s)为逆变器传递函数;s表示时间变量t经拉普拉斯变换后产生的频域内的拉氏变量;j为虚数单位,jωNTF代表一个实部为零、虚部为ωNTF的虚数,则表示在复频域内传递函数F(s)的自变量取值为jωNTF,即逆变器输出电流信号的频率等于系统谐振频率;i为逆变器输出电流信号,i(s)为逆变器输出电流信号经拉普拉斯变换后的形式;ud为控制器电流闭环扰动信号,将驱动电机与手臂连杆均等效为驱动系统负载,控制器电流闭环扰动量ud为手臂运动状态变化引起的驱动电机电压波动,ud(s)为控制器电流闭环扰动信号经拉普拉斯变换后的形式;
PR控制器传递函数Gc(s)表示为:
其中,Kp为比例增益系数,Ki为积分增益系数,ω0表示谐振频率。
ωNTF为手臂系统谐振频率,由仿人柔性手臂动力学模型可以得出:
其中,Jm、Ja分别为电机和手臂转动惯量,K为弹簧弹性系数。
该发明有益之处在于,本发明提出了一种基于PR控制器的仿人柔性手臂共振抑制方法,PR控制器针对特定频率点下的扰动有较强的抑制能力,避免逆变器输出信号频率等于手臂谐振频率引起自激振荡,且不改变其他频率点处的动态特性,控制过程易于实现。
附图说明
图1是基于PR控制器的仿人柔性手臂系统框图;
图2是PR控制器的传递函数框图;
图3是引入PR控制器后手臂驱动系统电流闭环。
具体实施方式
下面结合附图对本发明作进一步说明:
仿人机器人柔性手臂动力学方程为:
式中,Jm、Ja分别为关节电机和手臂连杆的转动惯量,θm、分别为电机的输出转角、角速度、角加速度,θa、分别为手臂连杆的输出转角、角速度、角加速度,K为弹簧弹性系数,D为关节阻尼系数,τm为电机输出力矩。
由于手臂关节的阻尼很小,因此可忽略仿人手臂系统阻尼,则式(1)简化为:
根据式(2),手臂连杆转角相对于电机转角的传递函数为:
电机输出转角相对于电机输入力矩的传递函数为:
在上述传递函数中,包含一对共轭零点和一对共轭极点,共轭零、极点的存在使仿人柔性关节手臂的闭环驱动系统的稳定性受到影响。其中,共轭零点对应反谐振频率ARF(Anti-ResonanceFrequency);共轭极点引入了系统自然振荡频率,即谐振频率NTF(Natural Torsional Frequency),ARF和NTF分别表示为:
分别对式(3)(4)所示的系统传递函数进行幅频特性分析可以得出结论:由共轭零点引起的系统振动属于自由振动,即发生ARF谐振时,电机端转速固定而负载端转速振荡,且呈现振荡衰减趋势的现象,不会受外部扰动激发;而由共轭极点引起的系统振动属于自激振动,是由驱动控制系统的激励引起的共振,即当控制频率接近NTF共振频率时,系统出现急剧震荡,且不呈现出收敛状态的现象。
由上述分析可以看出,ARF引起的系统振动表现为由关节柔性元件固有特性引起的系统运动状态变化的残余振动,而NTF引起的系统振动表现为由控制系统激励引起的系统共振。
当控制频率接近仿人柔性手臂自然振荡角频率时,手臂产生共振现象。手臂和电机运动状态存在耦合关系,手臂运动状态的变化引起驱动电机电压波动。电机作为驱动系统负载,其状态变化量在给定输入电流情况下可视为驱动系统扰动量。因此,由手臂运动状态变化引起的驱动电机电压波动可视为控制器电流闭环扰动量。
积分器的传递函数分别为:
其中,Ki为积分增益系数;s表示时间变量t经拉普拉斯变换后产生的频域内的拉氏变量。
将积分器从同步坐标系转换为静止坐标系的等效传递函数为:
GAC(s)=GDC(s-jω0)+GDC(s-jω0) (7)
其中,ω0为谐振频率;j为虚数单位,jω0代表一个实部为零、虚部为ω0的虚数。
得到广义积分器的传递函数:
为增加系统的快速性,将上述积分器与比例项Kp进行分组,得到抑制仿人柔性手臂共振的PR控制器:
当PR控制器谐振频率ω0设置为手臂系统谐振频率ωNTF时,逆变器输出电流与干扰量传递函数表示为:
其中,jωNTF代表一个实部为零、虚部为ωNTF的虚数,则表示在复频域内传递函数F(s)的自变量取值为jωNTF,即逆变器输出电流信号的频率等于系统谐振频率;i为逆变器输出电流信号,i(s)为逆变器输出电流信号经拉普拉斯变换后的形式;ud为控制器电流闭环扰动信号,将驱动电机与手臂连杆均等效为驱动系统负载,控制器电流闭环扰动量ud为手臂运动状态变化引起的驱动电机电压波动,ud(s)为控制器电流闭环扰动信号经拉普拉斯变换后的形式。Ginv(s)表示逆变器的传递函数:
由于开关频率较高,为分析方便,忽略功率变换延迟和采样延迟,逆变器传递函数用简化的增益环节KPWM代替。
Claims (1)
1.一种仿人柔性手臂共振抑制方法,具体提供一种基于PR控制器的仿人柔性手臂共振抑制方法,其特征在于:
所述基于PR控制器的仿人柔性手臂共振抑制方法,当PR控制器谐振频率ω0设置为手臂系统谐振频率ωNTF时,逆变器输出电流信号与干扰量传递函数表示为:
其中,Gc(s)为PR控制器传递函数,Ginv(s)为逆变器传递函数;s表示时间变量t经拉普拉斯变换后产生的频域内的拉氏变量;j为虚数单位,jωNTF代表一个实部为零、虚部为ωNTF的虚数,则表示在复频域内传递函数F(s)的自变量取值为jωNTF,即逆变器输出电流信号的频率等于系统谐振频率;i为逆变器输出电流信号,i(s)为逆变器输出电流信号经拉普拉斯变换后的形式;ud为控制器电流闭环扰动信号,将驱动电机与手臂连杆均等效为驱动系统负载,控制器电流闭环扰动量ud为手臂运动状态变化引起的驱动电机电压波动,ud(s)为控制器电流闭环扰动信号经拉普拉斯变换后的形式;
PR控制器传递函数Gc(s)表示为:
其中,Kp为比例增益系数,Ki为积分增益系数,ω0表示谐振频率;
ωNTF为手臂系统谐振频率,由仿人柔性手臂动力学模型可以得出:
其中,Jm、Ja分别为电机和手臂转动惯量,K为弹簧弹性系数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010454058.9A CN111590579B (zh) | 2020-05-26 | 2020-05-26 | 一种仿人柔性手臂共振抑制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010454058.9A CN111590579B (zh) | 2020-05-26 | 2020-05-26 | 一种仿人柔性手臂共振抑制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111590579A CN111590579A (zh) | 2020-08-28 |
CN111590579B true CN111590579B (zh) | 2022-09-13 |
Family
ID=72188699
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010454058.9A Active CN111590579B (zh) | 2020-05-26 | 2020-05-26 | 一种仿人柔性手臂共振抑制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111590579B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113414769B (zh) * | 2021-07-15 | 2022-11-22 | 中国科学院长春光学精密机械与物理研究所 | 柔性六自由度运动平台保护方法 |
CN115085467B (zh) * | 2022-08-19 | 2022-11-22 | 中国科学院宁波材料技术与工程研究所 | 驱动装置及叉车 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103732364A (zh) * | 2012-03-15 | 2014-04-16 | 奥林巴斯医疗株式会社 | 机械手装置 |
CN104723340A (zh) * | 2015-03-07 | 2015-06-24 | 哈尔滨工业大学 | 基于连接和阻尼配置的柔性关节机械臂的阻抗控制方法 |
CN108818539A (zh) * | 2018-08-02 | 2018-11-16 | 安徽工程大学 | 一种柔性操作臂弹性振动自抗扰控制装置及方法 |
CN109715349A (zh) * | 2016-07-15 | 2019-05-03 | 快砖知识产权私人有限公司 | 安装在柔性臂上的机器人臂的动态补偿 |
WO2020001742A1 (en) * | 2018-06-26 | 2020-01-02 | Franka Emika Gmbh | Device for controlling a robot manipulator |
EP3623115A1 (en) * | 2018-09-06 | 2020-03-18 | Kabushiki Kaisha Toshiba | Hand control device |
CN110977969A (zh) * | 2019-11-29 | 2020-04-10 | 东北大学 | 一种基于机械臂位姿变换的柔性负载伺服驱动系统的谐振抑制方法 |
-
2020
- 2020-05-26 CN CN202010454058.9A patent/CN111590579B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103732364A (zh) * | 2012-03-15 | 2014-04-16 | 奥林巴斯医疗株式会社 | 机械手装置 |
CN104723340A (zh) * | 2015-03-07 | 2015-06-24 | 哈尔滨工业大学 | 基于连接和阻尼配置的柔性关节机械臂的阻抗控制方法 |
CN109715349A (zh) * | 2016-07-15 | 2019-05-03 | 快砖知识产权私人有限公司 | 安装在柔性臂上的机器人臂的动态补偿 |
WO2020001742A1 (en) * | 2018-06-26 | 2020-01-02 | Franka Emika Gmbh | Device for controlling a robot manipulator |
CN108818539A (zh) * | 2018-08-02 | 2018-11-16 | 安徽工程大学 | 一种柔性操作臂弹性振动自抗扰控制装置及方法 |
EP3623115A1 (en) * | 2018-09-06 | 2020-03-18 | Kabushiki Kaisha Toshiba | Hand control device |
CN110977969A (zh) * | 2019-11-29 | 2020-04-10 | 东北大学 | 一种基于机械臂位姿变换的柔性负载伺服驱动系统的谐振抑制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111590579A (zh) | 2020-08-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111590579B (zh) | 一种仿人柔性手臂共振抑制方法 | |
CN109560736B (zh) | 基于二阶终端滑模的永磁同步电机控制方法 | |
CN108459497B (zh) | 一种基于adrc和nlpid的稳瞄伺服系统的控制方法 | |
CN107800343B (zh) | 异步电机自抗扰控制器的设计方法 | |
CN107394784B (zh) | 一种陷波滤波器在线谐振抑制参数优化方法 | |
CN109062060B (zh) | 一种基于加速度计和ccd融合的快反镜稳定方法 | |
CN101741297B (zh) | 无轴承同步磁阻电机径向位置模糊补偿逆控制方法及装置 | |
CN108321843B (zh) | 谐波电网电压下双馈风力发电系统的控制方法 | |
Zhang et al. | Robust plug-in repetitive control for speed smoothness of cascaded-PI PMSM drive | |
CN111162710A (zh) | 一种永磁轮毂电机转矩脉动抑制方法 | |
CN111865182B (zh) | 基于lc滤波器与自适应陷波器的高速pmsm谐波抑制控制方法 | |
CN112953328A (zh) | 一种电动汽车永磁同步电机自抗扰控制方法 | |
CN110994617A (zh) | 一种虚拟同步机电流谐波抑制方法及虚拟同步机控制系统 | |
Ma et al. | Backlash vibration suppression control of torsional system by novel fractional order PIDk controller | |
CN113098335A (zh) | 基于模糊qpr控制和电压补偿的永磁同步电机谐波抑制方法 | |
CN111082720B (zh) | 一种直驱式航空电动燃油泵鲁棒控制器 | |
CN100574091C (zh) | 基于无功电流补偿的电机振荡抑制方法 | |
CN116404933A (zh) | 基于改进型扰动观测器的永磁同步电机电流鲁棒控制方法 | |
Li et al. | High-order Fully Actuated Control Approach for Flexible Servo Systems Using Dynamical Compensator | |
CN110995110B (zh) | 一种单相永磁直线压缩机抗扰动控制系统及方法 | |
CN111969899B (zh) | 一种永磁直驱伺服电机的低速运行控制方法 | |
CN118123812B (zh) | 一种基于机械臂关节伺服系统的多模态主动振动抑制方法 | |
CN109150004A (zh) | 一种超声波电机伺服控制系统神经网络控制方法 | |
Pang et al. | Anti-disturbance Control Scheme based on Cascade GPIO for Induction Motor | |
Zheng et al. | Mechanical resonance suppressing method for PMSM system based on high-order sliding modes |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |