基于RISE反馈的串联弹性驱动器最优控制方法
基于LQR最优调节器的二级倒立摆控制系统

维普资讯
2 o 年 5月 O7
安度师范学院学报 (自熊科学版)
J u l f n i e c esC l g ( a r c n eE i n o ma o A q gT a h r o e e N t a S i c d i ) n l u l e t o
收 稿 日期 : 06 0 — 8 2 0 — 7 2
作者简 介: 吴文进 ( 95 , , 17 一) 男 安徽安庆人 , 安庆师范学 院物理 与电气工程学院教 师, 硕士 , 主要研究现代控制理论及其应用 。
维普资讯
锁 良: 基于 L R最优调节器的二级倒立摆控制系统 Q 得
摘 要: 倒立摆是一个典 型的快速、 多变量 、 非线性 、 绝对不稳定系统 。 对倒立摆 系统 的稳定性研究在理论
上和方法上具有深远的意义。本文建立了二级倒立摆 的数学模型 。 并推导 出模型的状态空间表达式, 分析了系
统 的稳定性 , 能控性和能观性 。 利用 了线性 二次 型最优调节器 ( QR) L 方法实现对二级倒立摆的最优控制 , MA L B T A 仿真结果表明了该方法的有效性 。 关键词 : 二级倒立摆; 最优调节器; 最优控制
驱动约束下直线电机自适应鲁棒优化控制

May. 2022Vbl.29, No.52022年5月 第29卷第5期控制工程Control Engineering of China文章编号:1671-7848(2022)05-0813-06DOI: 10.14107/j .cnki.kzgc.20210625驱动约束下直线电机自适应鲁棒优化控制袁明星",刘馨1,张雪波I(1.南开大学人工智能学院,天津300350; 2.重庆邮电大学工业物联网与网络化控制教育部重点实验室,重庆400065).摘 要:针对直线电机系统中各类建模不确定性以及速度、推力和加加速度约束综合影响 下的最短时间动态响应和高精度稳态跟踪问题,提出了一种融合时间最优轨迹优化和非线 性自适应鲁棒控制的双环控制框架。
其中,外环时间最优轨迹优化主要处理系统速度、加 加速度以及在线更新的前馈补偿约束,从而间接保证了最短时间的动态响应;内环非线性自适应鲁棒控制算法用来抑制各类建模不确定性的影响,旨在保证高精度的稳态跟踪性 能。
仿真结果验证了所提双环控制算法的有效性和优越性。
关键词:直线电机;轨迹优化;自适应鲁棒控制;驱动约束中图分类号:TP18 文献标识码:AOptimized Adaptive Robust Control of a Linear Motors withActuating ConstraintsYUANMing-xing 1-2, LIUXin x , ZHANG Xue-bo'(1. College of A rtificial Intelligence, Nankai University, Tianjin 300350, China; 2. Key Laboratory of Industrial IoT andNetworked Control, Ministry of Education, Chongqing University of Posts and Telecommunications, Chongqing 400065, China)Abstract: To achieve the minimum-time transient response and high accurate steady-state tracking for the linear motor subjecting to various modeling uncertainties, velocity, actuating force and jerk constraints, a two-loop control framework integrating the time-optimal trajectory optimization and nonlinear adaptive robustcontrol is proposed in this paper. Specifically, in the outer loop, a time-optimal trajectory optimizationalgorithm is devised to handle the velocity, jerk and online updated feedforward constraints so that the minimum-time transient response is guaranteed indirectly. A nonlinear adaptive robust control algorithm isdesigned in the inner loop to attenuate various modeling uncertainties and thus achieve high accuratesteady ・state tracking performance. Simulation results confirm the effectiveness and superiority of the proposedtwo-loop control algorithm.Key words: Linear motor; trajectory optimization; adaptive robust control; actuating constraint1引言现代加工制造业往往要求产品兼具高质量和 高产能,这需要制造或加工单元高精度、高速度地完成运动跟踪任务。
基于动态矩阵的隔振器滞回动力自动控制系统设计

基于动态矩阵的隔振器滞回动力自动控制系统设计张璐佳【摘要】现有基于PLC的隔振器滞回动力自动控制系统存在控制误差高的不足,为此设计了一种基于动态矩阵控制算法的自动控制系统;系统的硬件部分由动态控制中心、伺服电机、动力传感器、前置信号放大器、及数据计算单元等关键的模块构成,为提高系统的控制性能在伺服电机模块中内置了STM32524A型号的单片机控制器,保证电磁控制信号的稳定输出;依据动态矩阵控制算法原理设计了自动化控制系统的主控程序,并给出了动态预测矩阵控制的基本流程,利用动态滚动预测的模式来降低控制时域内的误差,并保证滞回动力值的稳定输出;分析数据表明,提出的自动化控制系统在功能性方面可以满足批量测试及远程控制的要求,在3个稳态值条件下的系统误差都明显低于传统隔振器控制系统,最高的误差输出在±0.05之间.【期刊名称】《计算机测量与控制》【年(卷),期】2019(027)007【总页数】5页(P74-78)【关键词】动态矩阵;隔振器;滞回动力;滚动预测【作者】张璐佳【作者单位】山东科技大学济南校区,电气信息系,济南250031【正文语种】中文【中图分类】TP2730 引言无论是在自然界还是在人类的工作生活当中,物体的振动都广泛地存在。
随着工业产业、制造业和精密仪器加工产业的发展,高频率、无规则的剧烈振动现象会给车船、设备等机械结构造成损坏,同时也会损害车船驾驶者、设备操作者的身体健康。
对于车船等大型的机械动力结构而言,设备运转、动力输出乃至气流、海水压力等外界环境因素的作用,都极易产生共振现象,进而导致车船设备产生振动[1-2]。
同时振动现象也是导致系统噪声、机械噪声产生的一个主要来源,随着车船声呐探测技术及无线信息传输技术重要性的持续提高,抑制系统共振,降低噪声干扰,并提高信号采集、识别与传递精度的呼声和要求不断提高[3-4]。
在现代工程控制领域中,各种避振器、隔振器被广泛地应用,其主要原理是通过弹性元件与阻尼元件配合,避免刚性结构的直接连接,并通过软件控制算法适时调整阻尼力的控制范围。
SD-20403驱动器42BYG250B步进马达有标注的说明书

行业专用系统 数字卷绕排线专用控制系统
机械传动单元 行星齿轮减速器、直线运动单元
系统集成与服务
运动控制系统
可编程控制器、运动控制板卡、SC-D228 专用控制器、TRIO 运动控制器
制 造 商:北京和利时电机技术有限公司(原四通电机)
地 址:北京市海淀区学清路 9 号汇智大厦 A 座 10 层
·蜗轮蜗杆经过精密研配,运动舒适,空回极小
·巧妙设计的消间隙结构,可以调整因长期使用造成的间隙
·中心通孔直径有公差限制,通孔的中心与旋转中心重合,方便定位
·步进电机和蜗杆通过进口高品质弹性联轴节连接,传动同步且噪音小
SW6 OFF
SW7 OFF
电流 0.5A
弦波电流的峰值,使用串电流表的方式不能得到正确的读数。) ON
OFF
OFF
0.8A
OFF
ON
OFF
1.2A
注:用户对输出电流的更改必须给驱动器重新上电才可生效。 ON
ON
OFF
1.5A
用户有其他非标准的电流要求时需联系厂家定制。
OFF
OFF
ON
ON
OFF
ON
采用了柔性细分算法,使驱动器无论设置何种细分电机都可保持最佳的运行性能,极大的改善了低细分 下的平稳性和噪音。即使用户由于控制系统输出脉冲频率的限制不能采用较高的细分选择,也可以获得 低速平稳性和高速性的兼得,从而降低对控制系统的要求,有利于降低系统的整体成本提高性能。低震 动、低噪音和低功耗。
电源
电机时应该采用自测模式进行电机参数的自适应匹配,之后就可以将开关设定为 OFF 锁定当前参数。 当工作状态发生变化后可以重新自测寻优。自测设定只在每次驱动器上电时进行处理,因此 SW8 状态 的变化只能在驱动器重新上电后生效。
电动舵机的控制方法综述

电动舵机的控制方法综述姓名孙信星学号 **********学院宇航摘要:介绍了导弹电动舵机的发展历史和研究现状及其发展趋势,着重分析了导弹电动舵机的几种控制方法以及各自的特点,使大家对导弹电动舵机的发展有一个更加清楚的认识。
关键字:电动舵机;导弹;控制引言导弹舵机可以分为气动舵机、液压舵机、电动舵机(electro mechanical actuator ,简称EMA)等。
电动舵机以其简单可靠、工艺性好、使用维护方便、等特性在导弹上得到了广泛应用。
早在二战期间,美国的C21自动驾驶仪就采用了电动舵机。
早期的电动舵机力矩小、响应慢,控制精度相对较低,之后两项关键技术的出现极大地促进了电动舵机的发展。
一是新型稀土永磁材料和专用驱动模块,这使得电动舵机的功率质量比和可靠性大幅度上升,代表的导弹有法国的响尾蛇地空导弹等。
二是数字信号处理器(DSP)的出现,以TMS320系列为代表的DSP 芯片实现了舵机的数字化,极大地提高了实时处理能力和抗干扰性能。
无刷直流电机、交流电动机、DSP 和先进控制策略得的广泛应用,使电动舵机技术得到进一步的发展。
电动舵机的发展可以归纳为三个方面:性能上高精度、高效率、高可靠性、高适应性;功能上小型化、轻型化、多功能;层次上系统化、复合集成化。
采用以稀土永磁无刷直流电机和交流电机等为主的电动机技术,以微处理器为基础的数字控制技术,以现代控制理论为基础的控制规律,实现全数字化、智能化、综合化是未来电动舵机发展的总趋势。
舵机控制系统有位置闭环控制、速度闭环控制和转矩闭环控制,其中舵机位置闭环控制系统主要由控制器、驱动器、伺服电机、传动机构和位置检测装置等组成,如图1所示。
图1舵机位置闭环控制系统其工作原理为:给定位置信号,经过控制器整定和驱动器放大后,驱动电机转动,电机转动位置量经过位置检测装置传递给控制器,形成反馈回路。
给定位置量与实际位置量相比较,得到误差。
导弹舵机在飞行过程中是一个不确定的非线性系统,对其的控制也需要采用非线性控制方法。
【国家自然科学基金】_线性二次型最优控制器_基金支持热词逐年推荐_【万方软件创新助手】_20140803

53 54 55 56 57 58 59
lugre摩擦力 lqr lqg基准 fuzzy logic control free-floating space flexible feedback linearization atmd结构
1 1 1 1 manipulator 1 1 1
2013年 序号 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41
推荐指数 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1
2010年 序号 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31
2009年 序号 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
科研热词 随机最优控制 轮廓误差 起落架 网络诱导时延 网络化控制系统 统计线性化 线性二次型调节器 线性二次型最优控制 稳定控制 状态控制 法向误差 最优预测状态估计 最优轮廓控制 数据包丢失 数学建模 抗扰动 弹性飞机 工作坐标系 姿态检测 多变量 双并联倒立摆 主动控制 两轮直立式自平衡机器人 lqg最优控制
科研热词 鲁棒h∞控制 线性矩阵不等式 最优控制 建筑结构 预测控制 非脆弱 线性二次型最优控制器 性能指标 lqr 飞艇航迹镇定 飞艇建模 非最小状态空间法 车辆悬架 车辆-人体振动系统 航空器结构与设计 线性二次型调节器 线性二次型最优控制 稳定平台 直接矩阵提取程序 漂浮基空间机器人 滑模 气囊和压块 柔性臂 柔性关节 振型分解 振动特性 振动控制 奇异摄动 多模型切换 四旋翼飞行器 反馈控制 压电激励 侧向风 人体模型 主动控制 主动悬架 主动前轮转向 t-s模型 rbf-arx模型 laguerre函数 "压块-浮力"驱动
利用激光跟踪仪对机器人进行标定的方法

利用激光跟踪仪对机器人进行标定的方法一、本文概述随着机器人技术的飞速发展,机器人在工业、医疗、军事等领域的应用越来越广泛。
机器人的定位精度和运动性能直接决定了其工作效率和准确性,因此,对机器人进行精确标定至关重要。
激光跟踪仪作为一种高精度测量设备,因其非接触性、高效率和高精度等特点,被广泛应用于机器人标定领域。
本文旨在介绍一种利用激光跟踪仪对机器人进行标定的方法,通过该方法可以实现对机器人位姿参数的精确测量和校准,提高机器人的定位精度和运动性能,为机器人在各领域的应用提供有力支持。
本文首先介绍了机器人标定的基本概念和重要性,以及激光跟踪仪的基本原理和优势。
接着,详细阐述了利用激光跟踪仪对机器人进行标定的具体步骤和方法,包括标定前的准备工作、标定过程中的数据采集和处理、以及标定结果的评估和应用。
本文还讨论了标定过程中可能遇到的问题和解决方法,以确保标定结果的准确性和可靠性。
通过本文的介绍,读者可以深入了解利用激光跟踪仪对机器人进行标定的基本原理和方法,掌握相关技术和应用,为机器人在各领域的应用提供有力支持。
本文也为相关领域的研究人员和技术人员提供了有益的参考和借鉴。
二、激光跟踪仪基本原理及特点激光跟踪仪是一种高精度、非接触式的测量设备,其基本原理基于激光测距和角度测量。
激光跟踪仪通过发射一束激光并追踪其反射光,测量激光发射器与目标点之间的距离。
通过内置的旋转关节和角度编码器,激光跟踪仪可以精确地测定目标点在空间中的方向。
结合距离和方向信息,激光跟踪仪能够计算出目标点在三维坐标系中的精确位置。
激光跟踪仪具有多种显著特点。
其测量精度高,可达到微米级甚至纳米级,适用于对机器人等精密设备的标定工作。
激光跟踪仪的测量速度快,能够实现实时跟踪和测量,提高工作效率。
激光跟踪仪具有非接触式测量的优点,不会对目标点产生任何机械力或热影响,从而避免了可能引起的误差。
激光跟踪仪的操作简单,只需将目标点置于激光束的照射范围内,即可进行自动跟踪和测量,无需复杂的操作和调整。
一类欠驱动系统的控制方法综述

A review for the control of a class of underactuated systems
SUN Ning,FANG Yongchun
( Institute of Robotics and Automatic Information System,Nankai University,Tianjin 300071 ,China)
· 202·
智
能
系
统
学
报பைடு நூலகம்
第6 卷
动系统相比更具有挑战性.
2
控制方法及研究现状
Abstract: Recently,research on underactuated systems has become a hot topic in the robotics and automation fields. The research status for the control of a class of underactuated systems ( termed as underactuated link systems) was reviewed in this paper. Specifically,the system dynamics was presented first,and two basic control modes were introduced. Subsequently,the main control strategies,which include optimal control methods,motion based methods,state dimension reducing methplanning methods,partial feedback linearization methods,energyods,hierarchical control design methods,and intelligent schemes,were analyzed. Finally,some major issues associated with the control system design for underactuated link systems,such as robustness,practicability,rapidness and so on,were sketched,and corresponding prospects including robust strategy,saturation control and finite time control etc. were proposed for future work. Keywords: underactuated systems; robotics; intelligent control 所谓欠驱动系统, 是指独立的控制输入维数少 于系统自由度的一类系统, 其本质为非线性系统. 在 现实中的很多系统都被设计为欠驱动形式 , 主要是 因为: 1 ) 系统本身的运动受到某种约束, 如常见的 非完整约束; 2 ) 省去部分驱动器后, 一方面可以减 提高系统的灵活性, 另一方面可 少设计的复杂程度, 有效节约成本, 降低系统自身的重量与体积, 并减少 能耗. 根据上述 2 种不同的原因, 可以将欠驱动系统 [1 ] 大致分为 2 类: 第一类是运动受限欠驱动系统 , 如移动机器人、 航天飞行器、 欠驱动水面和水下航行
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
基于RISE反馈的串联弹性驱动器最优控制方法孙雷;孙伟超;王萌;刘景泰【摘要】串联弹性驱动器 (Series elastic actuator, SEA) 是机器人交互系统中的一种理想力源.本文针对非线性SEA的力矩控制问题提出一种基于RISE (Robust integral of the sign of the error) 反馈的最优控制方法, 能够克服模型参数不确定和有界扰动, 实现SEA输出力矩在交互过程中快速平稳地收敛到期望值.具体来说, 首先对SEA的模型进行分析和变换;然后假设模型参数和扰动均已知, 并在此基础上基于二次型指标设计最优控制律;之后基于RISE反馈重新设计控制律抵消模型参数不确定性和有界扰动, 基于Lyapunov理论分析控制器的收敛性和信号的有界性, 实验结果表明这种基于RISE反馈的最优控制方法具有良好的控制性能和对有界扰动的鲁棒性.%Series elastic actuator (SEA) is an ideal power source in robots interaction systems. Aiming at SEA torque control, an optimization scheme with an RISE (robust integral of the sign of the error) feedback structure is proposed to ensure the output of SEA asymptotically tracks a desired time-varying torque despite uncertainties in the dynamics like bounded disturbance or parametric uncertainty. Specifically, the generic dynamics of SEA system is described and some analysis and transformation operations are performed. The system in which all terms are assumed to be known is feedback linearized and a control law is developed using the optimization method for a given quadratic performance index. Then the control law is modified to contain the RISE feedback term for identifying the uncertainty. At last, a Lyapunov stability analysis is included to show that the tracking error converges to zero withall signals bounded. Experiment results show that the suggested controller achieves satisfactory control performance and strong robustness to disturbance.【期刊名称】《自动化学报》【年(卷),期】2018(044)012【总页数】9页(P2170-2178)【关键词】串联弹性驱动器;最优控制;RISE;力矩控制【作者】孙雷;孙伟超;王萌;刘景泰【作者单位】南开大学机器人与信息自动化研究所天津 300350;天津市智能机器人技术重点实验室天津 300350;南开大学机器人与信息自动化研究所天津300350;天津市智能机器人技术重点实验室天津 300350;南开大学机器人与信息自动化研究所天津 300350;天津市智能机器人技术重点实验室天津 300350;南开大学机器人与信息自动化研究所天津 300350;天津市智能机器人技术重点实验室天津 300350【正文语种】中文近年来,采用串联弹性驱动器(Series elastic actuator,SEA)的柔性关节机器人由于具有良好的柔顺性和安全交互能力而得到关注.SEA是一种将弹性组件串联于电机和负载之间的柔性驱动器,弹性组件的引入,使得机器人的输出呈现被动柔性,进而确保机器人与环境和人能够进行安全的物理接触.另外,弹性组件的形变量与输出力矩呈对应关系,通过对弹性组件的测量与控制可以使系统具有高精度的力/力矩输出.基于以上优点,串联弹性驱动器可以被当做理想力源应用于机器人交互系统[1−5].针对SEA的力/力矩控制问题,国内外研究学者已经提出了很多控制策略.首先,Pratt 等在提出SEA概念的时候提出了一种前馈补偿与PID反馈相结合的控制策略[6].随后,Pratt等又提出了级联PID控制方法[7],其中位置控制和力矩控制分别作为控制的内外环.之后,很多改进的级联PID控制策略相继被提出[8−10].由于结构简单,便于应用,级联PID控制方法目前被广泛应用于SEA的力/力矩控制[1,11].为了提升系统的鲁棒性,Kong等[12−13]提出了基于线性扰动观测器(Linear disturbance observer,LDOB)的控制方法;Yoo等[14]提出了基于内部补偿器(Robust internal-loop compensator,RIC)的控制方法,其原理类似于LDOB.除此之外,一系列先进控制策略,例如自适应控制[15]、滑模控制[16]、H2最优控制[17]、神经网络[18]等,也都被应用于SEA的控制问题上,并取得了不错的效果.值得指出的是,包括上述列举的方法在内,已有的绝大多数SEA力/力矩控制方法都是针对线性SEA模型,即SEA的输出力矩与电机和负载端的相对转角呈线性关系.然而,一些非线性SEA具有更高的能量密度和仿生特性,其力/力矩输出与电机和负载的相对转角呈现非线性关系,在一些文献中,该类驱动器也被称作Variable stiffness/impedance actuator(VSA/VIA)[19−21].显然,非线性SEA 的力/力矩控制问题更具挑战性,目前该方面的研究相对较少.文献[22−25]应用级联PID控制方法来控制非线性SEA,对于复杂模型来说,PID控制是一种简单有效的控制方法,但该方法缺少理论分析;文献[24−25]提出一种模型线性化的方法,将表示SEA力矩输出特性的非线性函数进行局部线性化,之后再利用线性系统理论分别设计LDOB和控制器使系统稳定,但是该控制方法最大的不足在于只能确保系统在局部稳定;文献[26−27]分别针对投掷和敲击任务,提出了基于最优控制理论的控制方法,该方法在分析过程中假定负载端的动力学模型已知,所以无法应对在碰撞等交互应用中负载端动力学模型剧烈变化的情况;文献[28−29]提出了一种基于延时估计的控制方法,但该类方法只能保证控制误差全局最终一致有界(Globally,uniformly,ultimately bounded,GUUB);文献[30]提出了一种基于非线性扰动观测器(Nonlinear disturbance observer,NDOB)的滑模控制方法,但该方法对SEA动力学建模中潜在的内外扰动缺乏有效分析.考虑到上述问题,本文提出一种基于RISE(Robust integral of the sign of the error)反馈的最优控制方法,保证在存在模型参数不确定和有界扰动的情况下,SEA 的输出力矩在交互过程中能够快速达到期望值.具体来说,首先对SEA的模型进行分析和变换;然后假设模型参数和扰动均已知,并在此基础上基于HJB最优控制理论设计最优控制律;之后基于RISE反馈重新设计控制器抵消模型参数不确定性和有界扰动,基于Lyapunov理论分析控制器的收敛性和信号的有界性;最后与级联PID的控制性能进行实验对比.本文的其他部分组织如下:第1节通过对SEA的动力学模型进行分析和变换,对其控制问题进行详尽描述;第2节假设系统模型完全已知,并在此基础上设计最优控制律;第3节基于RISE反馈来修正控制输入,使得模型的不确定项能被抵消掉;第4节稳定性和信号有界性分析;第5节给出与级联PID的实验对比结果,验证算法的有效性;第6节是对本文主要工作的总结和展望.1 问题描述本文的研究对象为旋转型非线性SEA,即SEA的输出力矩与转角差之间呈非线性关系.模型如下:其中,θM和θL分别表示电机端和负载端的转角,ϕ表示电机端和负载端的转角差,JM和JL分别表示电机端和负载端的转动惯量,cM和cL分别表示电机端和负载端的科氏力等因素,τSEA表示SEA的输出力矩,与ϕ呈非线性关系,q1(t)和q2(t)分别表示电机端和负载端的未建模项、参数摄动项和扰动项,有界且其各阶导数也有界,τ表示控制输入,如图1所示.图1 SEA示意图Fig.1 Structure of SEA控制任务为:存在模型参数不确定和有界扰动时,设计合适的控制器,使得τSEA→τSEA,d.为此,做如下合理假设:假设1. τSEA与ϕ之间为一一对应的映射关系,对应关系f有界,且f的导数也有界; 假设2. 期望力矩及其1,2,3,4阶导数均有界.由于输出力矩与转角差一一对应,因此有ϕd=f−1(τSEA,d),进而有基于以上分析,可将力矩控制和跟踪问题转化为转角差的控制和跟踪问题.因此相应地将模型变化为如下形式:令,则有在实际交互场景中,负载端模型中的JL和cL等参数会发生不确定性变化,上述变换后的模型不包括负载端信息,可以从理论上消除负载端模型的不确定性对于系统的影响.不论负载端如何变化,控制任务始终是ϕ→ϕd(τSEA→ τSEA,d).上述模型中的集总扰动项d(t)包括负载的速度和加速度、模型误差等信息,弹性元件的引入使系统呈现出低阻抗和能量缓冲特性,这使得在实际物理交互过程中,扰动项的变化并非瞬间完成,尤其是在人机交互过程中,交互产生的扰动的频率及幅值都相对较小,因此对于扰动项有以下说明:假设3. 集总扰动项d(t)及其1阶和2阶变化率均有界.综上,控制问题描述为:针对系统(3),设计合适的控制律,使得系统能在克服扰动项d(t)的同时实现ϕ→ϕd.2 最优控制律设计前面的分析已将力矩跟踪转化为转角差跟踪,因此定义跟踪误差e1及辅助变量e2为其中,α1为待计算的正常数.其中,α2为正常数.将控制误差变换为状态空间表达式.由式(3)~(5)可得其中,暂时假设动态模型(3)中各项均已知,设计控制律如下:则有结合式(5)和式(10)有在此基础上,引入二次型控制指标其中,Q>0,R>0.控制问题转化为设计u使得J(u)最小,记最优控制律为u∗(t).上述指标不包含重力及扰动项,因为在实际中很难获得这些项.上述最优控制问题有解,即u∗(t)存在的充要条件是存在V=V(z,t)满足HJB方程[31]其中,而可以证明满足上述HJB方程,其中,K为待计算的参数.证明如下:由于u无约束,因此取最小值时,有将式(11),(14)和(15)代入上式,得解得对哈密顿函数求二次偏导,可知即哈密顿函数关于u的一阶偏导单调递增,进而可知u∗是其最小值点.另外值得注意的是,被控对象为多关节SEA,仍然有此结论,推导过程类似.从上述推导过程可以看出,V(z,t)的存在性依赖于式(13)有解,即矩阵P需存在,下面证明P应满足的条件和其存在性.由式(13)可得联立L(z,u)的表达式和式(11),(15),(21),可得而,代入式(22),得由上式知,若矩阵P为代数里卡蒂方程的解,则其满足式(23).将A,B,P,Q的表达式代入上式,得上述矩阵方程意味着,矩阵Q半正定的前提下,应有显然存在这样的参数.因此,当式(25)得到满足时,式(19)所示的控制律能使式(12)中的J(u)最小.3 基于RISE反馈的控制输入修正上一节中的控制律(19)能使式(12)达到最小,但是式(9)中,τ的表达式中d是未知的,因此控制律(9)无法直接应用.因此做如下修正:由式(6)和式(7),可得设计控制输入代入式(26),得其中,对式(28)求导,得其中,根据假设1和假设2及的表达式,可知存在全局可逆非减的正函数ρ(kyk)∈R+和正常数ζ1,ζ2,使得控制输入修正部分为其中,sgn(·)表示符号函数,β满足ks为正常数控制增益.将上式代入式(29),可得闭环系统的动态方程为4 稳定性分析可以证明,式(19),(27)和(31)构成的控制输入可以使同时,控制输入有界.证明如下:首先引入辅助变量L(t)为则有定义定义向量选取Lyapunov候选函数为则有对Lyapunov候选函数求导,可得其中,λ3=min{2α1−1,α2−1,1+R−1}.为保证λ3为正数,要求为保证U(Φ)半正定,即常数c>0,则应有kyk.为此,定义区域于是,当Φ∈D时,VL(Φ,t)∈L∞,进而推得e1(t)∈L∞,e2(t)∈L∞,r(t)∈L∞.由式(5)和式(6)可知1(t)∈L∞,2(t)∈L∞;由式(4),(5)和(6)可知ϕ∈L∞,∈L∞,∈L∞;由式(3)可知τ∈L∞;由式(19)可知u∈L∞,进而∈L∞且η∈L∞;由式(31)可得∈L∞;由式(9)可知h∈L∞;由式(8)可计算得∈L∞;由式(33)可知∈L∞.所以U(Φ)在D上一致连续. 定义区域由类不变定理可知则∀y(0)∈S,有则由e2(t)和r(t)的定义式可知由式(19)可知进而由式(26)可知可以调整ks的值,使得y(0)∈S.综上所述,即使存在模型参数不确定和未知有界扰动,由式(19),(27)和(31)构成的控制输入,当其参数满足式(25),(32)和(40)的约束时,能够实现最优控制且跟踪误差以及跟踪误差的1阶和2阶导数都渐近收敛至0.5 实验验证本文整合了最优控制原理与RISE控制策略,其中RISE方法具有辨识系统未知模型并且消除系统扰动的作用,在上面分析中使用李雅普诺夫方法证明了RISE反馈能够渐近辨识系统未知项和扰动项,从理论上证明了系统控制律最终精确收敛到最优控制律.下面用一组仿真实验来验证系统存在扰动时控制策略的最优性.在SEA系统中加入扰动d(t)=0.1+0.5sin(2πt)之后进行阶跃信号响应测试,图2是阶跃信号跟随情况,图3是RISE反馈项与实际的h(t)+d(t)的对比结果.仿真结果中RISE反馈项能够有效修正h(t)+d(t),误差收敛于零.验证了最终控制律会收敛于最优控制律,系统在考虑了不确定干扰之后仍具有最优性.图2 阶跃信号仿真结果Fig.2 Simulink result of step signal为了进一步验证本文方法的有效性,本节在自主搭建的单关节SEA平台上进行实验验证.如图4所示,本文的SEA系统由Maxon直流伺服电机驱动(减速比N=100:1),电机端安装增量式编码器(4000PPR),负载端安装有绝对值编码器(4096PPR).弹性装置安装在电机与负载之间,弹性主要有三个压簧提供.当电机与负载发生相对转动时,滚轮会沿着圆弧轨道运动,压缩三个弹簧,弹簧的压缩会对负载产生力矩,详见图5.根据图5,该SEA系统的输出力矩和相对转角的关系如下:图3 RISE反馈项与实际未知项对比结果Fig.3 Comparison result of RISEfeedback term with disturbance term图4 SEA实验平台Fig.4 SEA testbed图5 SEA弹性结构Fig.5 Elastic structure of SEA由此可得SEA输出力矩与转角差的关系为式中,θ表示滚轮在圆弧轨道滚动的角度;R,r分别表示圆弧轨道和滚轮的半径;∆y表示弹簧的压缩量;F表示三个弹簧压缩产生的合力.该模型的正确性已经在文献[32]中得到实验验证,为SEA力矩控制打下了基础.为了体现本文方法的有效性,在实验时与文献[20]中的级联PID控制方法进行了比较(级联PID控制方法作为一种简单有效的输出反馈控制策略,被广泛用于SEA的力矩控制中).本文应用的SEA相关机械参数如表1所示,实验采用NI CompactRIO 控制器,控制周期1ms,经过调节,本文设计的控制器参数为α1=30,α2=5,β=20,ks=5;级联PID力矩控制参数为kop=10,koi=3,kod=0.5,速度环控制参数为kip=3,kii=1,kid=0.表1 SEA机械参数Table 1 Mechanical parameter of SEAParameter Value UnitJM0.082 kgm2cM0.75 kgm2/sKs13600 N/mc0.018 mR0.020 mr0.005 m 实验1. 环境交互模拟在本组试验中,模拟串联弹性驱动器负载端与环境交互的情形,与传统的级联PID控制策略进行了实验对比.具体操作如下:负载在初始时刻被挡板挡住,之后输入阶跃信号,待负载稳定后撤去挡板,负载在SEA驱动下短暂运动一段时间后与另一挡板发生碰撞.通过分析可以发现,在挡板没被撤掉之前的过程可以看作系统对阶跃信号的调节控制,系统集总扰动项d(t)未知,可用来验证存在模型不确定情况下的系统的响应能力.在之后的释放和碰撞过程中,负载端动力学模型中的JL,cL等参数会发生两次突变,系统模型发生不确定性变化,可用来描述SEA与环境发生物理交互时的情形.在t=0s时输入幅值为0.2rad的阶跃信号,从实验结果图6可以看出,在阶跃响应阶段,本文提出的控制策略调节时间为0.2s,超调量约为4%,级联PID控制策略调节时间约为0.4s,超调量约为20%,本文控制方法较级联PID控制策略收敛速度更快,且超调较小.在释放与碰撞阶段,面对相同扰动时,本文方法输出波动较小,能够更快地恢复到期望值;而级联PID控制策略控制器性能明显下降,SEA输出力矩波动明显且需要较长的时间才能恢复到期望值.本组实验充分说明了本文方法能够更好地应对存在模型不确定性与环境交互时负载端模型剧烈变化的情况,拥有更强的鲁棒性,更适用于交互式机器人系统.图6 环境交互实验结果Fig.6 Experiment result of robotenvironment-interaction实验2. 人机交互模拟在人机交互情景中,零阻抗控制常用来评价控制器的性能指标,在本组试验中采用零阻抗控制来模拟人机交互.在实验过程中,驱动器输出力矩设定为零,人手持负载做无规则往复运动,控制策略的性能表现为电机对负载的跟随效果.从实验结果可以看出,负载跟随人做无规则往复运动时,电机能够有效地跟随负载,跟随误差约为0.01rad,转角差ϕ被控制在很小的范围内,对应SEA输出力矩很小,并且输入较为平滑合理,表现出控制系统对于误差和输入的优化.图7和图8是负载与人交互时的运动情况与电机的跟随效果.实验结果表明,本文提出的控制方法具有良好的顺应性与低阻抗特性,在实际SEA交互系统中具有良好的应用价值.6 结论针对SEA的力矩控制问题,本文提出一种基于RISE反馈的最优控制策略.首先假设系统模型参数和扰动均已知,在此基础上基于最优控制理论设计最优控制律,之后基于RISE反馈对控制律进行修正,文中对跟踪误差的收敛性及信号的有界性进行了严格的数学分析.通过仿真实验验证了RISE反馈项能够渐近辨识模型未知参数和有界扰动,系统控制律最终收敛到最优控制律,算法在存在未知扰动情况下仍具有最优性.最后通过环境交互实验与人机交互实验,验证了算法在实际平台上的有效性.在接下来的工作中,我们将对多关节SEA机器人的力矩控制问题及其应用展开研究.图7 电机与负载运动情况Fig.7 Motion result of motor and load图8 人机交互实验结果Fig.8 Experiment result of human-robot-interaction References【相关文献】1 Veneman J F,Ekkelenkamp R,Kruidhof R,Van Der Helm F C,Van Der Kooij H.A series elastic-and Bowdencable-based actuation system for use as torque actuator in exoskeleton-type robots.International Journal of Robotics Research,2006,25(3):261−2812 Vallery H,Veneman J F,Van Asseldonk E,Buss R M,Van Der Kooij pliant actuation of rehabilitation robots.IEEE Robotics and Automation Magazine,2008,15(3):60−693 Sulzer J S,Roiz R A,Peshkin M A,Patton J L.A highly backdrivable,lightweight knee actuator for investigating gait in stroke.IEEE Transactions on Robotics,2009,25(3):539−5484 Mathijssen G,Lefeber D,Vanderborght B.Variable recruitment of parallel elastic elements:series-parallel elastic actuators(SPEA)with dephased mutilated gears.IEEE/ASME Transactions on Mechatronics,2015,20(2):594−6025 Pfeifer S,Pagel A,Riener R,Vallery H.Actuator with angledependent elasticity for biomimetic transfemoral prostheses.IEEE/ASME Transactions onMechatronics,2015,20(3):1384−13946 Pratt G A,Williamson M M.Series elastic actuators.In:Proceedings of the 1995 IEEE/RSJ International Conference on Intelligent Robots and Systems95.Pittsburgh,PA,USA:IEEE,1995.399−4067 Pratt G A,Willisson P,Bolton C,Hofman te motor processing in low-impedance robots:impedance control of series-elastic actuators.In:Proceedings of the 2004 American Control Conference.Boston,MA,USA:IEEE,2004.3245−32518 Wyeth G.Control issues for velocity sourced series elastic actuators.In:Proceedings of the 2006 Australasian Conference on Robotics and Automation.Auckland,NewZealand:Australian Robotics and Automation Association Inc.,2006.1−69 Wyeth G.Demonstrating the safety and performance of a velocity sourced series elastic actuator.In:Proceedings of the 2008 IEEE International Conference on Robotics and Automation(ICRA).Pasadena,CA,USA:IEEE,2008.3642−364710 Vallery H,Ekkelenkamp R,Van der Kooij H,Buss M.Passive and accurate torque control of series elastic actuators.In:Proceedings of the 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems(IROS).San Diego,CA,USA:IEEE,2007.3534−353811 Tagliamonte N L,Accoto D.Passivity constraints for the impedance control of series elastic actuator.Proceedings of Institution of Mechanical Engineers,Part I:Journal of Systems and Control Engineering,2013,228(3):138−15312 Kong K,Bae J,Tomizuka M.Control of rotary series elastic actuator for ideal force-mode actuation in humanrobot interaction applications.IEEE/ASME Transactions on Mechatronics,2009,14(1):105−11813 Kong K,Bae J,Tomizuka M.A compact rotary series elastic actuator for human assistive systems.IEEE/ASME Transactions on Mechatronics,2012,17(2):288−29714 Yoo S,Chung W K.SEA force/torque servo control with model-based robust motion control and link-side motion feedback.In:Proceedings of the 2015 IEEE International Conference on Robotics and Automation(ICRA).Seattle,WA,USA:IEEE,2015.1042−104815 Calanca A,Fiorini P.Human-adaptive control of series elasticactuators.Robotica,2014,32(8):1301−131616 Bae J,Kong K,Tomizuka M.Gait phase-based smoothed sliding mode control for a rotary series elastic actuator installed on the knee joint.In:Proceedings of the 2010 American Control Conferen ce(ACC).Baltimore,MD,USA:IEEE,2010.6030−603517 Misgeld B J E,Pomprapa A,Leonhardt S.Robust control of compliant actuators using positive realH2-controller synthesis.In:Proceedings of the 2014 American Control Conference(ACC).Portland,OR,USA:IEEE,2014.5477−548318 Zhu Qiu-Guo,Xiong Rong,Lv Cheng-Jie,Mao Yi-Chao.Novel series elastic actuator design and velocity control.Electric Machines and Control,2015,19(6):83−88(朱秋国,熊蓉,吕铖杰,毛翊超.新型串联弹性驱动器设计与速度控制.电机与控制学报,2015,19(6):83−88)19 Wolf S,Hirzinger G.A new variable stiffness design:matching requirements of the next robot generation.In:Proceedings of the 2008 IEEE International Conference on Robotics and Automation(ICRA).Pasadena,CA,USA:IEEE,2008.1741−174620 Jafari A,Tsagarakis N G,Caldwell D G.A novel intrinsically energy efficient actuator with adjustable stiffness(AwAS).IEEE/ASME Transactions on Mechatronics,2013,18(1):355−365 21 Mooney L,Herr H.Continuously-variable series-elastic actuator.In:Proceedings of the 2013 IEEE International Conference on RehabilitationRobotics(ICORR).Seattle,WA,USA:IEEE,2013.1−622 Paine N,Sentis L.A new prismatic series elastic actuator with compact size and high performance.In:Proceedings of the 2012 IEEE International Conference on Robotics and Biomimetics(ROBIO).Guangzhou,China:IE EE,2012.1759−176623 Laffranchi M,Chen L S,Kashiri N,Lee J,Tsagarakis N G,Caldwell D G.Development and control of a series elastic actuator equipped with a semi active friction damper for human friendly robots.Robotics and Autonomous Systems,2014,62(12):1827−183624 Austin J,Schepelmann A,Geyer H.Control and evaluation of series elastic actuators with nonlinear rubber springs.In:Proceedings of the 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems(IROS).Hamburg,Germany:IEEE,2015.6563−656825 Yu H Y,Huang S N,Chen G,Pan Y P,Guo Z.Human-robot interaction control of rehabilitation robots with series elastic actuators.IEEE Transactions onRobotics,2015,31(5):1089−110026 Garabini M,Passaglia A,Belo F,Salaris P,Bicchi A.Optimality principles in stiffness control:the VSA kick.In:Proceedings of the 2012 IEEE International Conference on Robotics and Automation(ICRA).Saint Paul,MN,USA:IEEE,2012.3341−334627 Braun D J,Howard M,Vijayakumar S.Optimal variable stiffness control:formulation and applic ation to explosive movement tasks.Autonomous Robots,2012,33(3):237−25328 Lee J,Laffranchi M,Kashiri N,Tsagarakis N G,Caldwell D G.Model-free force tracking control of piezoelectric actuators:application to variable damping actuator.In:Proceedings of the 2014 IEEE International Conference on Robotics and Automation(ICRA).Hong Kong,China:IEEE,2014.2283−228929 Lee J,Jin M L,Tsagarakis N G,Caldwell D G.Terminal sliding-mode based force tracking control of piezoelectric actuators for variable physical damping system.In:Proceedings of the 2014 IEEE/RSJ International Conference on Intelligent Robots andSystems(IROS).Chicago,IL,USA:2014.2407−241330 Wang M,Sun L,Yin W,Dong S,Liu J T.A novel sliding mode control for series elastic actuator torque tracking with an extended disturbance observer.In:Proceedings of the 2015 IEEE International Conference on Robotics andBiomimetics(ROBIO).Zhuhai,China:IEEE,2015.2407−241231 Dupree K,Patre P M,Wilcox Z D,Dixon W E.Optimal control of uncertain nonlinear systems using RISE feedback.In:Proceedings of the 47th IEEE Conference on Decision and Control(CDC).Cancun,Mexico:IEEE,2008.2154−215932 Wang Meng,Sun Lei,Yin Wei,Dong Shuai,Liu Jing-Tai.Series elastic actuator torque control approach for interaction application.Actia Automa tica Sinca,2017,43(8):1319−1328 (王萌,孙雷,尹伟,董帅,刘景泰.面向交互应用的串联弹性驱动器力矩控制方法.自动化学报,2017,43(8):1319−1328)。