CN111590579A - 一种仿人柔性手臂共振抑制方法 - Google Patents

一种仿人柔性手臂共振抑制方法 Download PDF

Info

Publication number
CN111590579A
CN111590579A CN202010454058.9A CN202010454058A CN111590579A CN 111590579 A CN111590579 A CN 111590579A CN 202010454058 A CN202010454058 A CN 202010454058A CN 111590579 A CN111590579 A CN 111590579A
Authority
CN
China
Prior art keywords
arm
controller
resonance
frequency
flexible arm
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.)
Granted
Application number
CN202010454058.9A
Other languages
English (en)
Other versions
CN111590579B (zh
Inventor
杜钦君
张伟玲
宋传明
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shandong University of Technology
Original Assignee
Shandong University of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shandong University of Technology filed Critical Shandong University of Technology
Priority to CN202010454058.9A priority Critical patent/CN111590579B/zh
Publication of CN111590579A publication Critical patent/CN111590579A/zh
Application granted granted Critical
Publication of CN111590579B publication Critical patent/CN111590579B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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时，逆变器输出电流信号与干扰量传递函数表示为：
Figure RE-GDA0002574806510000011
其中，Gc(s)为PR控制器传递函数，Ginv(s)为逆变器传递函数；i为逆变器输出电流信号；ud为控制器电流闭环扰动信号，将驱动电机与手臂连杆均等效为驱动系统负载，控制器电流闭环扰动量ud为手臂运动状态变化引起的驱动电机电压波动。
PR控制器传递函数Gc(s)表示为：
Figure RE-GDA0002574806510000012
其中，Kp为比例增益系数，Ki为积分增益系数，ω0表示谐振频率。
ωNTF为手臂系统谐振频率，由仿人柔性手臂动力学模型可以得出：
Figure RE-GDA0002574806510000021
其中，Jm、Ja分别为电机和手臂转动惯量，K为弹簧弹性系数。
当控制器输出信号频率与手臂谐振频率相等时，手臂产生共振，
Figure RE-GDA0002574806510000022
表明引入PR控制器后，逆变器输出电流不受手臂在谐振频率ωNTF处振动状态的影响，避免逆变器输出信号频率等于手臂谐振频率引起的自激振荡。
该发明有益之处在于，本发明提出了一种基于PR控制器的仿人柔性手臂共振抑制方法，PR控制器针对特定频率点下的扰动有较强的抑制能力，避免逆变器输出信号频率等于手臂谐振频率引起自激振荡，且不改变其他频率点处的动态特性，控制过程易于实现。
附图说明
图1是基于PR控制器的仿人柔性手臂系统框图；
图2是PR控制器的传递函数框图；
图3是引入PR控制器后手臂驱动系统电流闭环。
具体实施方式
下面结合附图对本发明作进一步说明：
仿人机器人柔性手臂动力学方程为：
Figure RE-GDA0002574806510000023
式中，Jm、Ja分别为关节电机和手臂连杆的转动惯量，θm、
Figure RE-GDA0002574806510000024
分别为电机的输出转角、角速度、角加速度，θa、
Figure RE-GDA0002574806510000025
分别为手臂连杆的输出转角、角速度、角加速度，K为弹簧弹性系数，D为关节阻尼系数，τm为电机输出力矩。
由于手臂关节的阻尼很小，因此可忽略仿人手臂系统阻尼，则式(1)简化为：
Figure RE-GDA0002574806510000026
根据式(2)，手臂连杆转角相对于电机转角的传递函数为：
Figure RE-GDA0002574806510000031
电机输出转角相对于电机输入力矩的传递函数为：
Figure RE-GDA0002574806510000032
在上述传递函数中，包含一对共轭零点和一对共轭极点，共轭零、极点的存在使仿人柔性关节手臂的闭环驱动系统的稳定性受到影响。其中，共轭零点对应反谐振频率 ARF(Anti-ResonanceFrequency)；共轭极点引入了系统自然振荡频率，即谐振频率NTF(Natural Torsional Frequency)，ARF和NTF分别表示为：
Figure RE-GDA0002574806510000033
分别对式(3)(4)所示的系统传递函数进行幅频特性分析可以得出结论：由共轭零点引起的系统振动属于自由振动，即发生ARF谐振时，电机端转速固定而负载端转速振荡，且呈现振荡衰减趋势的现象，不会受外部扰动激发；而由共轭极点引起的系统振动属于自激振动，是由驱动控制系统的激励引起的共振，即当控制频率接近NTF共振频率时，系统出现急剧震荡，且不呈现出收敛状态的现象。
由上述分析可以看出，ARF引起的系统振动表现为由关节柔性元件固有特性引起的系统运动状态变化的残余振动，而NTF引起的系统振动表现为由控制系统激励引起的系统共振。
当控制频率接近仿人柔性手臂自然振荡角频率时，手臂产生共振现象。手臂和电机运动状态存在耦合关系，手臂运动状态的变化引起驱动电机电压波动。电机作为驱动系统负载，其状态变化量在给定输入电流情况下可视为驱动系统扰动量。因此，由手臂运动状态变化引起的驱动电机电压波动可视为控制器电流闭环扰动量。
积分器的传递函数分别为：
Figure RE-GDA0002574806510000034
其中，Ki为积分增益系数。
将积分器从同步坐标系转换为静止坐标系的等效传递函数为：
GAC(s)＝GDC(s-jω0)+GDC(s-jω0) (7)
其中，ω0为谐振频率。
得到广义积分器的传递函数：
Figure RE-GDA0002574806510000041
为增加系统的快速性，将上述积分器与比例项Kp进行分组，得到抑制仿人柔性手臂共振的PR控制器：
Figure RE-GDA0002574806510000042
当PR控制器谐振频率ω0设置为手臂系统谐振频率ωNTF时，逆变器输出电流与干扰量传递函数表示为：
Figure RE-GDA0002574806510000043
其中，i为逆变器输出电流信号；ud为控制器电流闭环扰动信号，将驱动电机与手臂连杆均等效为驱动系统负载，控制器电流闭环扰动量ud为手臂运动状态变化引起的驱动电机电压波动。Ginv(s)表示逆变器的传递函数：
Figure RE-GDA0002574806510000044
由于开关频率较高，为分析方便，忽略功率变换延迟和采样延迟，逆变器传递函数用简化的增益环节KPWM代替。
当控制器输出信号频率与手臂谐振频率相等时，手臂产生共振，
Figure RE-GDA0002574806510000045
表明引入PR控制器后，逆变器输出电流不受手臂在谐振频率ωNTF处振动状态的影响，避免逆变器输出信号频率等于手臂谐振频率引起的自激振荡。

Claims (1)

1.一种仿人柔性手臂共振抑制方法，具体提供一种基于PR控制器的仿人柔性手臂共振抑制方法，其特征在于：
所述基于PR控制器的仿人柔性手臂共振抑制方法，当PR控制器谐振频率ω0设置为手臂系统谐振频率ωNTF时，逆变器输出电流信号与干扰量传递函数表示为：
Figure FDA0002508581660000011
其中，Gc(s)为PR控制器传递函数，Ginv(s)为逆变器传递函数；i为逆变器输出电流信号；ud为控制器电流闭环扰动信号，将驱动电机与手臂连杆均等效为驱动系统负载，控制器电流闭环扰动量ud为手臂运动状态变化引起的驱动电机电压波动；
当控制器输出信号频率与手臂谐振频率相等时，手臂产生共振，
Figure FDA0002508581660000012
表明引入PR控制器后，逆变器输出电流不受手臂在谐振频率ωNTF处振动状态的影响，避免逆变器输出信号频率等于手臂谐振频率引起的自激振荡；
PR控制器传递函数Gc(s)表示为：
Figure FDA0002508581660000013
其中，Kp为比例增益系数，Ki为积分增益系数，ω0表示谐振频率；
ωNTF为手臂系统谐振频率，由仿人柔性手臂动力学模型可以得出：
Figure FDA0002508581660000014
其中，Jm、Ja分别为电机和手臂转动惯量，K为弹簧弹性系数。
CN202010454058.9A 2020-05-26 2020-05-26 一种仿人柔性手臂共振抑制方法 Active CN111590579B (zh)

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 true CN111590579A (zh) 2020-08-28
CN111590579B 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)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113414769A (zh) * 2021-07-15 2021-09-21 中国科学院长春光学精密机械与物理研究所 柔性六自由度运动平台保护方法
CN115085467A (zh) * 2022-08-19 2022-09-20 中国科学院宁波材料技术与工程研究所 一体式电机、驱动装置及叉车

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20140074290A1 (en) * 2012-03-15 2014-03-13 Olympus Medical Systems Corp. Manipulator device
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 东北大学 一种基于机械臂位姿变换的柔性负载伺服驱动系统的谐振抑制方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20140074290A1 (en) * 2012-03-15 2014-03-13 Olympus Medical Systems Corp. Manipulator device
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 东北大学 一种基于机械臂位姿变换的柔性负载伺服驱动系统的谐振抑制方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113414769A (zh) * 2021-07-15 2021-09-21 中国科学院长春光学精密机械与物理研究所 柔性六自由度运动平台保护方法
CN115085467A (zh) * 2022-08-19 2022-09-20 中国科学院宁波材料技术与工程研究所 一体式电机、驱动装置及叉车

Also Published As

Publication number Publication date
CN111590579B (zh) 2022-09-13

Similar Documents

Publication Publication Date Title
CN111590579B (zh) 一种仿人柔性手臂共振抑制方法
CN109062060B (zh) 一种基于加速度计和ccd融合的快反镜稳定方法
CN108459497B (zh) 一种基于adrc和nlpid的稳瞄伺服系统的控制方法
US20030017910A1 (en) Apparatus and method for smoothing of vehicle drivelines
CN110518601A (zh) 基于宽频带和改进自抗扰控制的风电并网低频振荡抑制方法
CN102820844A (zh) 一种柔性臂振动抑制方法
Zhang et al. Robust plug-in repetitive control for speed smoothness of cascaded-PI PMSM drive
CN111162710A (zh) 一种永磁轮毂电机转矩脉动抑制方法
CN111865182B (zh) 基于lc滤波器与自适应陷波器的高速pmsm谐波抑制控制方法
CN110609470A (zh) 一种基于过渡过程的抗积分饱和设计方法
CN112821827B (zh) 一种cmg框架系统谐波减速器扰动抑制系统
CN204597818U (zh) 一种超声电机变频驱动系统
CN109462358A (zh) 一种电动汽车主动减振控制方法
Ma et al. Backlash vibration suppression control of torsional system by novel fractional order PIDk controller
CN113098335A (zh) 基于模糊qpr控制和电压补偿的永磁同步电机谐波抑制方法
Hasegawa et al. Robot joint angle control based on Self Resonance Cancellation using double encoders
CN111082720A (zh) 一种直驱式航空电动燃油泵鲁棒控制器
WO2022174488A1 (zh) 无轴承永磁同步电机神经网络带通滤波器振动补偿控制器
CN110995110B (zh) 一种单相永磁直线压缩机抗扰动控制系统及方法
CN111673734B (zh) 一种机器人关节伺服系统振动抑制控制方法
Fu et al. Analysis and suppression of torsional vibrations for the permanent magnet synchronous motor-load system
Zhang et al. Resonance suppression strategy for humanoid robot arm
Liao et al. Vibration suppression in a harmonic drive system
Zawirski et al. Experimental analysis of selected control algorithms of electromechanical object with backlash and elastic joint
CN116032170A (zh) 一种抑制扰动的电机速度控制方法、存储介质和处理器

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