CN111496799A - 一种精确控制形状记忆合金复合软体驱动器的方法 - Google Patents
一种精确控制形状记忆合金复合软体驱动器的方法 Download PDFInfo
- Publication number
- CN111496799A CN111496799A CN202010534870.2A CN202010534870A CN111496799A CN 111496799 A CN111496799 A CN 111496799A CN 202010534870 A CN202010534870 A CN 202010534870A CN 111496799 A CN111496799 A CN 111496799A
- Authority
- CN
- China
- Prior art keywords
- term
- load
- driver
- sma
- actuator
- 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
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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
-
- 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/0009—Constructional details, e.g. manipulator supports, bases
-
- 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/0009—Constructional details, e.g. manipulator supports, bases
- B25J9/0015—Flexure members, i.e. parts of manipulators having a narrowed section allowing articulation by flexion
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Endoscopes (AREA)
Abstract
本发明公开了一种精确控制形状记忆合金(SMA)复合软体驱动器的方法,包括:传感器系统,电加热系统以及基于模型的误差反馈控制器。所述传感器系统通过重构SMA复合驱动器的弯曲形状,测量驱动器的实际弯曲角度。所述误差反馈控制器以驱动器的实际弯曲角度和预期弯曲角度误差作为输入,输出控制信号至电加热系统以调控SMA复合驱动器中SMA丝的加热,实现驱动器的精确运动控制。所述误差反馈补偿器包括反馈比例项、前馈补偿项、温度增量项、负载增量项和负载补偿项五个部分,能够根据驱动器实际弯曲角度迅速调整输入至驱动器中的电压信号。本发明的优点能够实现SMA复合软体驱动器动作的精准控制,以及驱动器在外载荷冲击下的快速稳定。
Description
技术领域
本发明涉及软体机器人驱动器控制领域,具体涉及一种精确控制形状记忆合金复合软体驱动器的方法。
背景技术
形状记忆合金(SMA)由于其较高的能量密度,极快的反应速度等优良的驱动特性,近年来在软体驱动器领域得到了广泛的应用。但是,由于使用的SMA丝的尺寸普遍过于细小,不易通过传感器得到实时温度,因此无法根据其本构模型得出相应的相变程度。因此,基于SMA的驱动器难以实现动作上的精准控制。在众多相关的SMA应用中,往往仅凭借简单的二值化控制(通电和断电)来实现对SMA的动作控制,使得SMA的优良驱动性能得不到充分利用,这给基于SMA的软体驱动器的实际应用带来了极大的阻碍。
发明内容
本发明的目的是提供一种精确控制形状记忆合金(SMA)复合驱动器的控制方法,使得该驱动器能够实现精准的位置控制,并且在外载荷作用下能快速重返平衡状态的控制方法。
本发明通过以下技术方案实现:一种精确控制形状记忆合金复合软体驱动器的方法,包括传感器系统,电加热系统以及基于模型的误差反馈控制器。所述传感器系统通过重构SMA复合驱动器的弯曲形状,实时测量驱动器的弯曲角度。所述误差反馈控制器是基于驱动器显式动力学模型与SMA线性相变模型建立起来的,以驱动器的实际弯曲角度和预期弯曲角度误差作为输入,输出控制信号至电加热系统以调控SMA复合驱动器中SMA丝的加热收缩,实现驱动器的精确运动控制,且能够使得驱动器在外载荷冲击下实现快速稳定。
进一步地,所述显式动力学模型为根据驱动器的结构特点构建起来的,用于反映弯曲角度与输入电压之间随时间变化的动态关系,显式动力学模型可表示为:
进一步地,由于显式动力学模型为驱动器理论运动模型,与实际情况不完全一致。为提升驱动器在外载荷作用下的位置控制精度,建立所述基于模型的误差反馈控制器,包括反馈比例项、前馈补偿项、温度增量项、负载增量项和负载补偿项五个部分,为如下形式:
式(4)中,q为误差反馈控制项的输入向量,kp为反馈比例项的系数,uD(q,t)为前馈补偿项,uT(q,t)为温度增量项,uF(q,t)为负载增量项,uFC(q,t)为负载补偿项,θd为预期弯曲角度,e为预期弯曲角度θd与实际弯曲角度θ之间的误差。
进一步地,所述前馈补偿项是期望弯曲角度的函数。由于通过传感器进行的形状重构具有一定的误差,因此需要在输入端添加一前馈补偿项,用于减少形状重构方法的位置跟踪误差。前馈补偿项可表示为:
式(5)中,kA为期望角度的前馈比例系数,kB为期望角速度的前馈比例系数,R为SMA的电阻,TRF为驱动器弯曲时的结构常数,Rλ为驱动器中硅胶软体材料的导热系数,U为电加热系统的峰值电压,T0为环境温度,Tl为SMA丝的低相变温度。
进一步地,所述温度增量项是误差e的函数。由于软体内部的温度随时间变化,且温度实时测量不便,通过添加温度补偿项来模拟软体组织的温度。温度增量项可表示为:
式(6)中,kT为温度增量系数,gt(e)为误差积分开关函数。
进一步地,在系统建模过程中,为了简化系统模型,省略了柔性机构的部分力学动态特性,会导致外载荷下系统的稳定性降低。通过增加负载增量项,能够用增加系统的稳定性。
负载增量项可以表示为:
式(7)中,kF为负载增量系数,gf(Fload)为负载增量项开关函数,η为误差积分。所述负载增量项还可减少因驱动器本身重量而增加的负载。
进一步地,所述负载补偿项是为了调节外载荷对驱动器的稳态影响而设立的,能够提升驱动器在外载荷下的稳定性。该载荷补偿项与外载荷大小,外载荷作用位置以及该驱动器的结构有关,可表示为:
与现有技术相比,本发明的有益效果为:
(1)本发明能够实现基于SMA的复合软体驱动器在无负载和有负载状况下弯曲程度的精确控制。
(2)本发明提供了基于SMA的驱动器精准控制的方法,除本发明所基于的薄板驱动器以外的SMA驱动器,也可参照本发明,实现驱动器控制效果的优化。
附图说明
图1为本发明一种精确控制形状记忆合金复合软体驱动器的方法的示意图;
图2为本发明一种精确控制形状记忆合金复合软体驱动器的方法所使用的基于模型的误差反馈控制器的示意图;
图3为一种基于形状记忆合金的感知驱动一体化薄板软体驱动器正常状态的示意图;
图4为一种基于形状记忆合金的感知驱动一体化薄板软体驱动器弯曲状态的示意图。
图中:1为固定板,2为柔性传感器阵列,3为硅胶基体,4为弹性薄片,5为SMA丝,1.a和1.b分别为自由端固定板和固定端固定板。
具体实施方式
应该指出,以下详细说明都是例示性的,旨在对本发明提供进一步的说明。除非另有指明,本发明使用的所有技术和科学术语具有与本发明所属技术领域的普通技术人员通常理解的相同含义。
需要注意的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本发明的示例性实施方式。
本发明公开了一种精确控制SMA复合软体驱动器的方法,包括传感器系统,电加热系统以及基于模型的误差反馈控制器。
如图1所示,预期弯曲角度θd输入至误差反馈控制器,使之输出对形状记忆合金加热的电压信号,并输入至电加热系统,而后电加热系统加热驱动器中的SMA丝,控制SMA丝的相变收缩程度,进而控制驱动器的运动状态。在驱动器运动过程中,传感器系统实时对驱动器的运动状态进行检测,通过形状重构得出驱动器的实际弯曲角度θ,并反馈至误差反馈控制器,进而调节误差反馈补偿器输出的控制信号。
所述误差反馈补偿器是基于驱动器显式动力学模型与SMA线性相变模型建立起来的,能够实现驱动器动作的精准控制,且能够使得驱动器在外载荷冲击下实现快速稳定。
如图2所示,基于驱动器显式动力学模型的误差反馈控制器中,输入SMA驱动器的电压信号包括反馈比例项、前馈补偿项、温度增量项、负载增量项和负载补偿项五个部分。对于该控制器,预期弯曲角度θd为输入,根据传感器系统测得的运动状态进行形状重构得出的实际弯曲角度θ为输出。
如图3所示为本发明所参考的一种基于形状记忆合金(SMA)的感知驱动一体化薄板驱动器,包括两块固定板(自由端固定板1.a和固定端固定板1.b)、柔性传感器阵列2、硅胶基体3、弹性薄片4以及SMA丝5。SMA丝5首尾两端固定在固定端固定板1.b上,并且按照一定的顺序穿过固定板1上的小孔,与固定板1一起浇筑在硅胶基体3中;弹性薄片4与硅胶基体3粘贴在一起,且背面粘贴多片柔性传感器,构成柔性传感器阵列2;驱动器工作过程中,需将固定端固定板1.b固定,通过对SMA丝5通电,使得SMA丝5发热收缩,带动驱动器弯曲至如图4所示SMA丝5拉力力矩与弹性薄片4的弹性力力矩相抵消位置;在SMA丝5断电后,弹性薄片4中积蓄的弹性势能逐渐释放,使驱动器逐渐回归图3所示正常状态;柔性传感器阵列2测得驱动器上不同位置的离散曲率,通过拉格朗日插值法,得到沿驱动器的连续曲率分布,进而通过拟合得出驱动器的重构弯曲形状,得出实际弯曲角度θ。
基于上述一种基于形状记忆合金的感知驱动一体化软体驱动器,建立基于模型的误差反馈控制器的过程包括如下步骤:
建立SMA的线性相变模型:
式(1)中,ξ为马氏体体积分数,T为SMA的温度,σ为SMA的正应力,Tl为低相变温度,Th为高相变温度,x1和x2是调整线性相变模型的两个调节变量。是马氏体相变结束温度,是马氏体相变开始温度,Cm是SMA的材料系数。其微分形式为:
该SMA线性相变模型基于SMA的示差量热扫描实验结果,线性描述马氏体体积分数与温度和应力之间的关系,并且消除了SMA的迟滞效应。
根据本实施例所用的一种基于形状记忆合金(SMA)的感知驱动一体化薄板驱动器的结构,以及SMA的线性相变模型,建立相应的显式动力学模型:
式(3.2)中,θ为弯曲角度,Fload为负载向量,为负载与驱动器固定端(近端)之间的位置向量,Rλ为硅胶软体材料的导热系数,χ、εTF、εRF、TεF和TRF为驱动器弯曲时的结构常数,T0为环境温度,T(t)为硅胶软体材料在驱动器工作时的温度变化动态,t为时间,U为电加热系统的峰值电压,R为SMA的电阻,r为电压占空比。
依据驱动器的显式动力学模型,建立误差反馈控制器如下:
式(4)中,q为误差反馈控制项的输入向量,kp为反馈比例项的系数,uD(q,t)为前馈补偿项,uT(q,t)为温度增量项,uF(q,t)为负载增量项,uFC(q,t)为负载补偿项,e为预期弯曲角度θd与实际弯曲角度θ之间的误差。
其中,前馈补偿项为:
式(5)中,kA为期望角度的前馈比例系数,kB为期望角速度的前馈比例系数。
其中,温度增量项为:
式(6)中,kT为温度增量系数,gt(e)为误差积分开关函数。
其中,负载增量项为:
式(7)中,kF为负载增量系数,gf(Fload)为负载增量项开关函数。
其中,负载补偿项为:
在本实施例中,上述过程中的参数需满足如下条件:
反馈比例系数需满足:kp>-0.1345
期望角度的前馈比例系数设定为:kA=0.1345
期望角速度的前馈比例系数设定为:kB=0.0737
负载增量系数需满足:kF>0
温度增量系数则需通过实验确定。
驱动器弯曲时的结构常数为:χ=0.0198,εTF=-0.0122,εRF=0.7441,TεF=879.61,TRF=1.23×103
所用硅胶软体材料的热导系数为:Rλ=5.89W/(m·K)
设定环境温度为:T0=25℃
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (7)
1.一种精确控制形状记忆合金复合软体驱动器的方法,其特征在于:包括传感器系统,电加热系统以及基于模型的误差反馈控制器,所述传感器系统通过重构SMA复合驱动器的弯曲形状,测量驱动器的实际弯曲角度,所述误差反馈控制器是基于驱动器显式动力学模型与SMA线性相变模型建立起来的,以驱动器的实际弯曲角度和预期弯曲角度误差作为输入,输出控制信号至电加热系统以调控SMA复合驱动器中SMA丝的加热收缩,实现驱动器的精确运动控制,且能够使得驱动器在外载荷冲击下实现快速稳定。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2020102573569 | 2020-04-03 | ||
CN202010257356 | 2020-04-03 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111496799A true CN111496799A (zh) | 2020-08-07 |
CN111496799B CN111496799B (zh) | 2022-07-15 |
Family
ID=71868794
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010534870.2A Active CN111496799B (zh) | 2020-04-03 | 2020-06-12 | 一种精确控制形状记忆合金复合软体驱动器的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111496799B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114619444A (zh) * | 2022-01-17 | 2022-06-14 | 清华大学 | 双程sma弹簧驱动的软体机器人弯曲模块及其控制方法 |
Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090099551A1 (en) * | 2007-05-09 | 2009-04-16 | Alexander Tung | Sensors and control for an interventional catheter |
US20090108779A1 (en) * | 2007-10-29 | 2009-04-30 | Olympus Corporation | Control unit of shape memory element actuator and method of controlling shape memory element actuator |
US20130296885A1 (en) * | 2012-05-01 | 2013-11-07 | Jaydev P. Desai | Actuated steerable probe and systems and methods of using same |
US20150127149A1 (en) * | 2013-11-01 | 2015-05-07 | Brain Corporation | Apparatus and methods for online training of robots |
US20150289994A1 (en) * | 2014-04-10 | 2015-10-15 | Erik D. Engeberg | Antagonistically actuated shape memory alloy manipulator |
US20160256228A1 (en) * | 2013-10-16 | 2016-09-08 | Koninklijke Philips N.V. | Interventional system |
US20170095922A1 (en) * | 2015-10-05 | 2017-04-06 | James Michael LICHT | Medical devices having smoothly articulating multi-cluster joints |
CN107870569A (zh) * | 2017-12-25 | 2018-04-03 | 北京航空航天大学 | 一种求取用于压电舵机的广义内模控制器的方法 |
CN207771832U (zh) * | 2017-06-09 | 2018-08-28 | 中国科学技术大学 | 软体机械臂 |
CN108594897A (zh) * | 2018-03-14 | 2018-09-28 | 西安电子科技大学 | 基于温度控制的形状记忆索网结构型面精度主动调节系统 |
CN108916312A (zh) * | 2018-07-31 | 2018-11-30 | 中国石油大学(华东) | 一种基于pid控制的形状记忆合金智能减震支座 |
WO2019007977A1 (en) * | 2017-07-03 | 2019-01-10 | Technische Universiteit Eindhoven | OVER-ACTIVATED HYSTERESIS SYSTEMS AND METHODS OF CONTROLLING THE SAME |
CN109176589A (zh) * | 2018-09-18 | 2019-01-11 | 广州大学 | 一种基于sma弹簧的软体机械手 |
US20190120214A1 (en) * | 2016-06-08 | 2019-04-25 | Cambridge Mechatronics Limited | Centring control of an sma actuation assembly |
CN110089021A (zh) * | 2016-09-14 | 2019-08-02 | 智能合金有限公司 | 具有应变计传感器和位置估计的形状记忆合金致动器及其制造方法 |
-
2020
- 2020-06-12 CN CN202010534870.2A patent/CN111496799B/zh active Active
Patent Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090099551A1 (en) * | 2007-05-09 | 2009-04-16 | Alexander Tung | Sensors and control for an interventional catheter |
US20090108779A1 (en) * | 2007-10-29 | 2009-04-30 | Olympus Corporation | Control unit of shape memory element actuator and method of controlling shape memory element actuator |
US20130296885A1 (en) * | 2012-05-01 | 2013-11-07 | Jaydev P. Desai | Actuated steerable probe and systems and methods of using same |
US20160256228A1 (en) * | 2013-10-16 | 2016-09-08 | Koninklijke Philips N.V. | Interventional system |
US20150127149A1 (en) * | 2013-11-01 | 2015-05-07 | Brain Corporation | Apparatus and methods for online training of robots |
US20150289994A1 (en) * | 2014-04-10 | 2015-10-15 | Erik D. Engeberg | Antagonistically actuated shape memory alloy manipulator |
US20170095922A1 (en) * | 2015-10-05 | 2017-04-06 | James Michael LICHT | Medical devices having smoothly articulating multi-cluster joints |
US20190120214A1 (en) * | 2016-06-08 | 2019-04-25 | Cambridge Mechatronics Limited | Centring control of an sma actuation assembly |
CN110089021A (zh) * | 2016-09-14 | 2019-08-02 | 智能合金有限公司 | 具有应变计传感器和位置估计的形状记忆合金致动器及其制造方法 |
CN207771832U (zh) * | 2017-06-09 | 2018-08-28 | 中国科学技术大学 | 软体机械臂 |
WO2019007977A1 (en) * | 2017-07-03 | 2019-01-10 | Technische Universiteit Eindhoven | OVER-ACTIVATED HYSTERESIS SYSTEMS AND METHODS OF CONTROLLING THE SAME |
CN107870569A (zh) * | 2017-12-25 | 2018-04-03 | 北京航空航天大学 | 一种求取用于压电舵机的广义内模控制器的方法 |
CN108594897A (zh) * | 2018-03-14 | 2018-09-28 | 西安电子科技大学 | 基于温度控制的形状记忆索网结构型面精度主动调节系统 |
CN108916312A (zh) * | 2018-07-31 | 2018-11-30 | 中国石油大学(华东) | 一种基于pid控制的形状记忆合金智能减震支座 |
CN109176589A (zh) * | 2018-09-18 | 2019-01-11 | 广州大学 | 一种基于sma弹簧的软体机械手 |
Non-Patent Citations (3)
Title |
---|
DALEY, M (DALEY, MAKELLA)等: "Experimental investigation of hybrid shape memory alloy pneumatic actuators", 《BEHAVIOR AND MECHANICS OF MULTIFUNCTIONAL MATERIALS XIII》 * |
李晓光等: "形状记忆合金驱动器的自适应滑模反步控制", 《控制理论与应用》 * |
王东云等: "软体微手鲁棒非线性控制设计", 《计算机测量与控制》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114619444A (zh) * | 2022-01-17 | 2022-06-14 | 清华大学 | 双程sma弹簧驱动的软体机器人弯曲模块及其控制方法 |
CN114619444B (zh) * | 2022-01-17 | 2024-01-26 | 清华大学 | 双程sma弹簧驱动的软体机器人弯曲模块及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111496799B (zh) | 2022-07-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Tang et al. | Temperature self-sensing and closed-loop position control of twisted and coiled actuator | |
Lan et al. | An accurate self-sensing method for the control of shape memory alloy actuated flexures | |
Ma et al. | Position control of shape memory alloy actuators with internal electrical resistance feedback using neural networks | |
Teh et al. | An architecture for fast and accurate control of shape memory alloy actuators | |
Rediniotis et al. | Development of a shape-memory-alloy actuated biomimetic hydrofoil | |
EP2868923B1 (en) | Variable negative stiffness actuation | |
Kang et al. | Robust control of ionic polymer–metal composites | |
CN108710301B (zh) | 压电陶瓷作动器迟滞非线性在线辨识和补偿的方法及系统 | |
CN111496799B (zh) | 一种精确控制形状记忆合金复合软体驱动器的方法 | |
Song | Design and control of a Nitinol wire actuated rotary servo | |
Suzuki et al. | Control of twisted and coiled polymer actuator with anti-windup compensator | |
Moallem | Deflection control of a flexible beam using shape memory alloy actuators | |
Hao et al. | A novel adaptive force control method for IPMC manipulation | |
Dickinson et al. | Feedback control using shape memory alloy actuators | |
Luong et al. | Modeling and position control of a high performance twisted-coiled polymer actuator | |
Jin et al. | Modeling and motion control of a soft SMA planar actuator | |
CN111396274B (zh) | 一种基于形状记忆合金的感知驱动一体化薄板驱动器 | |
Abdullah et al. | Accurate position control of shape memory alloy actuation using displacement feedback and self-sensing system | |
Lan et al. | Investigation on pretensioned shape memory alloy actuators for force and displacement self-sensing | |
Wu et al. | Position and force control of a twisted and coiled polymeric actuator | |
Wang et al. | Microscopic vibration suppression for a high-speed macro-micro manipulator with parameter perturbation | |
Luong et al. | Impedance control of a high performance twisted-coiled polymer actuator | |
Lin et al. | Control of ionic polymer-metal composites for active catheter systems via linear parameter-varying approach | |
Li et al. | Design and control of a novel rotary shape memory alloy actuator for two degree of freedom underwater vectored thruster | |
CN106019933B (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 |