全柔性空间机器人运动振动一体化输入受限重复学习控制

探究基座、臂、关节全柔性影响下空间机器人动力学模拟、运动控制及基座、臂、关节三重柔性振动主动抑制的问题, 设计了不基于系统模型信息的运动振动一体化输入受限重复学习控制算法. 将柔性基座与关节等效为线性弹簧与扭转弹簧, 柔性臂视为欧拉-伯努利梁模型, 利用拉格朗日方程与假设模态法建立动力学模型, 然后, 用奇异摄动理论将模型分解为包含刚性变量与臂柔性振动的慢变子系统, 包含基座、关节柔性振动的快变子系统, 并分别设计相应的子控制器, 构成了带关节柔性补偿的一体化控制算法. 针对慢变子系统, 提出输入受限重复学习控制算法, 由双曲正切函数, 饱和函数与重复学习项构成, 双曲正切函数与饱和函数实现输入力矩受限要求, 重复学习项补偿周期性系统误差, 以完成对基座姿态、关节铰周期轨迹的渐进稳定追踪. 然而, 为了同时抑制慢变子系统臂的柔性振动, 运用虚拟力的概念, 构造同时反映臂柔性振动与系统刚性运动的混合轨迹, 提出了基于虚拟力概念的输入受限重复学习控制器, 保证基座、关节轨迹精确追踪的同时, 对臂的柔性振动主动抑制. 针对快变子系统, 采用线性二次最优控制算法抑制基座与关节的柔性振动. 仿真结果表明: 控制器适用于一般柔性非线性系统, 满足输入力矩受限要求, 实现对周期信号的高精度追踪, 有效抑制基座、臂、关节的柔性振动, 证实算法的可行性.      

Dynamics analysis of 2-DOF complex planar mechanical system with joint clearance and flexible links

Joint clearance and flexible links are two important factors that affect the dynamic behaviors of planar mechanical system. Traditional dynamics studies of planar mechanism rarely take into account both influence of revolute clearance and flexible links, which results in lower accuracy. And many dynamics studies mainly focus on simple mechanism with clearance, the study of complex mechanism with clearance is a few. In order to study dynamic behaviors of two-degree-of-freedom (DOF) complex planar mechanical system more precisely, the dynamic analyses of the mechanical system with joint clearance and flexibility of links are studied in this work. Nonlinear dynamic model of the 2-DOF nine-bar mechanical system with revolute clearance and flexible links is built by Lagrange and finite element method (FEM). Normal and tangential force of the clearance joint is built by the Lankarani–Nikravesh and modified Coulomb’s friction models. The influences of clearance value and driving velocity of the crank on the dynamic behaviors are researched, including motion responses of slider, contact force, driving torques of cranks, penetration depth, shaft center trajectory, Phase diagram, Lyapunov exponents and Poincaré map of clearance joint and slider are both analyzed, respectively. Bifurcation diagrams under different clearance values and different driving velocities of cranks are also investigated. The results show that clearance joint and flexibility of links have a certain impact on dynamic behavior of mechanism, and flexible links can partly decrease dynamic response of the mechanical system with clearance relative to rigid mechanical system with clearance.     

Modeling and analysis of sliding joints with clearances in flexible multibody systems

The modeling of the sliding joint with clearance between a flexible beam and a rigid hole is investigated in this paper. The flexible beam is discretized using the three-dimensional curved Euler–Bernoulli beam element of the Absolute Nodal Coordinate Formulation, while the motion of the rigid hole is described by the Cartesian coordinates. Moreover, the cross sections of both the flexible beam and the rigid hole are assumed to be circular. The existing joints with clearances are mainly rigid joints with small clearances, and the contact detection algorithm adopted can solve only one pair of potential contact points within one section. In order to model the contact problem in the sliding joint with clearance, a new contact detection method based on the intersection of the rigid hole’s cross section and the flexible beam is proposed, which yields a two-dimensional contact detection problem. Based on the common-normal concept, the ellipse–circle contact detection problem within the hole’s cross section can be solved. The potential contact point on the hole’s cross section will be determined, and the closest point projection on the beam’s neutral axis can be defined further. The proposed contact detection method can deal with the sliding joint with large clearance and the multiple-point contact problem within one section. In addition, the penalty method is adopted to model the frictionless contact between the flexible beam and the rigid hole. Finally, two numerical examples about sliding joints with clearances, one with an initially curved beam under gravity and the other with a straight beam under zero gravity, are presented to demonstrate the influence of the clearance of sliding joint on the dynamic performance of flexible multibody systems.     

漂浮基柔性两杆空间机械臂的关节运动鲁棒控制与柔性振动最优控制Robust joint motion control and vibration optimal control for a free-floating two-flexible-link space manipulator

讨论了载体位置、姿态均不受控情况下,具有有界干扰及有界未知参数的漂浮基柔性两杆空间机械臂的具有鲁棒性的关节运动控制与柔性振动最优控制算法设计问题。首先选择合理的联体坐标系,利用拉格朗日方程并结合动量守恒原理得到漂浮基柔性两杆空间机械臂系统的动力学方程。通过合理选择联体坐标系与利用奇异摄动理论,实现了两个柔性杆柔性振动之间、关节运动与两柔性杆柔性振动的解耦,得到了柔性两杆空间机械臂的慢变子系统与柔性臂快变子系统。针对两个子系统设计相应的控制规律,即增广鲁棒慢变子系统控制律与柔性臂快变子系统最优控制律,这两个相应的子系统控制规律综合到一起构成飘浮基柔性两杆空间机械臂总的关节运动与臂柔性振动控制的组合控制律。系统的数值仿真证实了方法的有效性。该控制方案不需要直接测量漂浮基的位置、移动速度和移动加速度。     

含间隙铰接的柔性航天器刚柔耦合动力学与控制研究

大型柔性航天器展开锁定后,运动副中仍存在大量无法消除的间隙. 铰链间隙直接影响柔性航天器的姿态 运动和有效载荷的指向精度及稳定度,会对航天器的动力学特性造成较大的影响. 针对这一问题, 提出一种含间隙铰 接的航天器刚柔耦合动力学建模与控制方法. 首先建立含间隙的铰链精确动力学模型,从而构建含间隙铰接的柔性结构 动力学模型. 然后利用哈密顿原理和模态离散方法,建立含间隙铰接柔性航天器离散形式的刚柔耦合非线性动力学 模型,采用 Newmark 算法对非线性动力学方程进行求解. 基于压电纤维复合材料 (macro fiber composite, MFC) 驱动器 构建航天器的刚-柔-电耦合动力学方程,采用最优控制设计控制律. 分析了铰链参数、中心刚体转动惯量、间隙尺寸和间隙数目对航天器动力学特性的影响,着重研究了铰链间隙对航天器姿态运动和结构振动的影响作用. 最后采用 MFC 驱动器对航天器施加主动控制. 结果表明,铰链参数和中心刚体转动惯量影响航天器的固有频率;随着铰链间隙尺寸的增大及间隙数目的增多,航天器的整体刚度逐渐减小,而航天器的姿态角和振动位移响应不断增大;通过基于 MFC 的主动控制,能够实现含间隙铰接航天器姿态运动与结构振动的协同控制,并缓解间隙对系统动态特性造成的影响.      

DYNAMICS AND CONTROL OF RIGID-FLEXIBLE COUPLING FLEXIBLE SPACECRAFT WITH JOINT CLEARANCE1)

大型柔性航天器展开锁定后,运动副中仍存在大量无法消除的间隙. 铰链间隙直接影响柔性航天器的姿态 运动和有效载荷的指向精度及稳定度,会对航天器的动力学特性造成较大的影响. 针对这一问题, 提出一种含间隙铰 接的航天器刚柔耦合动力学建模与控制方法. 首先建立含间隙的铰链精确动力学模型,从而构建含间隙铰接的柔性结构 动力学模型. 然后利用哈密顿原理和模态离散方法,建立含间隙铰接柔性航天器离散形式的刚柔耦合非线性动力学 模型,采用 Newmark 算法对非线性动力学方程进行求解. 基于压电纤维复合材料 (macro fiber composite, MFC) 驱动器 构建航天器的刚-柔-电耦合动力学方程,采用最优控制设计控制律. 分析了铰链参数、中心刚体转动惯量、间隙尺寸和间隙数目对航天器动力学特性的影响,着重研究了铰链间隙对航天器姿态运动和结构振动的影响作用. 最后采用 MFC 驱动器对航天器施加主动控制. 结果表明,铰链参数和中心刚体转动惯量影响航天器的固有频率;随着铰链间隙尺寸的增大及间隙数目的增多,航天器的整体刚度逐渐减小,而航天器的姿态角和振动位移响应不断增大;通过基于 MFC 的主动控制,能够实现含间隙铰接航天器姿态运动与结构振动的协同控制,并缓解间隙对系统动态特性造成的影响.     

基于干扰观测器的柔性关节空间机器人退步自适应控制

研究了载体位置、姿态均不受控的情况下,系统参数不确定的柔性关节空间机器人轨迹跟踪的控制问题.结合系统动量、动量矩守恒关系,利用拉格朗日法推导出系统的动力学模型.为减小系统柔性关节对系统控制精度的影响,采用关节柔性补偿器来等效降低系统关节的柔性.再借助奇异摄动法,针对系统参数不确定的情况,设计了柔性关节空间机器人基于干扰观测器的退步自适应滑模控制方案.该方案不需要对系统惯性参数进行线性化处理,控制器结构简单,且实现了空间机器人期望轨迹的精确跟踪控制.通过平面两杆空间机器人的数值仿真证明了该方法的有效性.     

Screw theoretic view on dynamics of spatially compliant beam

Beams with spatial compliance can be deformed as bending in a plane, twisting, and extending. In terms of the screw theory on rigid body motions, the concept of ＂deflection screw＂ is introduced, a spatial compliant beam theory via the deflection screw is proposed, and the spatial compliance of such a beam system is presented and analysed based on the material theory and fundamental kinematic assumptions. To study the dynamics of the spatially compliant beam, the potential energy and the kinetic energy of the beam are discussed by using the screw theory to obtain the Lagrangian. The Rayleigh-Ritz method is used to compute the vibrational frequencies based on discussions of boundary conditions and shape functions. The eigenfrequencies of the beam with spatial compliance are compared with those of individual deformation cases, pure bending, extension, or torsion. Finally, dynamics of a robot with two spatial compliant links and perpendicular joints is studied using the spatial compliant beam theory. Coupling between the joint rigid body motions and the deformations of spatial compliant links can easily be found in dynamic simulation. The study shows the effectiveness of using the screw theory to deal with the problems of dynamic modeling and analysis of mechanisms with spatially compliant links.     

基于虚拟力概念的柔性臂空间机器人模糊退步自适应控制算法设计

讨论了漂浮基柔性臂空间机器人系统的动力学模拟、运动轨迹跟踪控制算法设计及柔性振动主动抑制。采用多体动力学建模方法并结合假设模态法,建立了漂浮基柔性臂空间机器人的系统动力学模型。基于该模型,针对系统惯性参数未知情况,提出了刚性运动基于模糊基函数网络自适应调节的退步控制算法,以完成柔性臂空间机器人载体姿态及机械臂各关节铰的协调运动。然后,为了主动抑制系统柔性振动,运用虚拟力的概念,构造了同时反映柔性模态和刚性运动轨迹的混合期望轨迹,通过改造原有的控制算法,提出了基于虚拟力概念的模糊退步自适应控制算法;这样不但保证了之前刚性运动控制方案对模型不确定的鲁棒性,而且能主动抑制柔性振动,从而提高了轨迹跟踪性能。理论分析及数值仿真算例均表明了控制方法的可行性。     

考虑热应变的柔性并联空间机械臂动力学

研究考虑热应变的柔性并联空间机械臂动力学性态。用Jourdain速度变分原理建立各机械臂的动力学变分方程,在此基础上根据各物体之间的运动学约束关系,建立柔性多体系统的微分代数混合动力学方程。数值仿真结果表明,当温度升高时,机械臂的轴向约束力和中心刚体的质心运动速度均出现显著振荡,而适当减小温度变化率,可以有效地控制振幅。     

柔性圆柱涡激振动流体力系数识别及其特性

涡激振动是诱发海洋立管、浮式平台系泊缆和海底悬跨管道等柔性圆柱结构疲劳损伤的重要因素.目前,海洋工程中用于柔性圆柱涡激振动预报的流体力系数主要来源刚性圆柱横流向受迫振动的实验数据,存在一定缺陷和误差.本文综合考虑横流向与顺流向振动耦合作用,建立了柔性圆柱涡激振动流体力模型,运用有限元法和最小二乘法确定升力系数、脉动阻力系数和附加质量系数.为了准确识别柔性圆柱涡激振动流体力系数,设计并开展了拖曳水池模型实验,实验用柔性圆柱模型的质量比为1.82,长径比为195.5.通过与刚性圆柱流体力系数对比,深入分析了柔性圆柱流体力系数的特性.结果表明:柔性圆柱在一阶模态控制区,流体力系数随约化速度变化趋势与刚性圆柱大致相似;二阶模态控制区,升力系数和脉动阻力系数显著增大;附加质量系数在响应频率较低时与振动位移的相关性增强;当响应频率较低时,振动位移较大区域为能量耗散区,当响应频率较高时,振动位移较大区域为能量输入区.     

A chassis-based kinematic formulation for flexible multi-body vehicle dynamics

This research proposed an efficient implicit integration method for the real-time simulation of flexible multi-body vehicle dynamics models. The equations of motion for the flexible bodies were formulated with respect to the moving chassis-body reference frame instead of the fixed inertial reference frame. The proposed approach does not require evaluation of system Jacobian and its LU-decomposition in time loof of simulation. This is one of the key aspects that enable high computational efficiency of the proposed method. The numerical simulation results of the proposed approach were matched up with those of the conventional approach but the computation time can be reduced by applying the proposed method. The joint constraint and generalized force equations are the same as the equations for rigid vehicle dynamics models because the joints and forces between flexible bodies are connected by the RBE (rigid body element). On the various driving conditions, the numerical simulation results show that the proposed approach yields almost exact solutions compared to the conventional approach. And the proposed approach spends only 22.9% of conventional approach on computation time under CPU 3.2 GHz personal computer.     

Dynamic modeling of a revolute-prismatic flexible robot arm fabricated from advanced composite materials

A dynamic model for a two degree-of-freedom planar robot arm is derived in this study. The links of the arm, connected to prismatic and revolute joints, are considered to be flexible. They are assumed to be fabricated from either aluminum or laminated composite materials. The model is derived based on the Timoshenko beam theory in order to account for the rotary inertia and shear deformation. These effects are significant in modeling flexible links connected to prismatic joints. The deflections of the links are approximated by using a shear-deformable beam finite element. Hamilton's principle is implemented to derive the equations describing the combined rigid and flexible motions of the arm. The resulting equations are coupled and highly nonlinear. In view of the large number of equations involved and their geometric nonlinearity (topological and quadratic), the solution of the equations of motion is obtained numerically by using a stiff integrator.The digital simulation studies examine the interaction between the flexible and the rigid body motions of the robot arm, investigate the improvement in the accuracy of the model by considering the flexibility of all rather than some of the links of the arm, assess the significance of the rotary inertia and shear deformation, and illustrate the advantages of using advanced composites in the structural design of robotic manipulators.     

带有末端集中质量的双连杆柔性机械臂主动控制

对带有末端集中质量的双连杆柔性机械臂的主动控制进行了研究,给出系统的动力学方程,采用非线性解耦反馈控制方法分别得出系统大范围运动方程和柔性臂的动力学方程,采用机械臂逆动力学方法和LQR方法分别设计大范围运动控制律和压电作动器控制律.仿真结果显示,本文控制方法能够有效地进行机械臂的轨迹跟踪,柔性臂的弹性振动可以得到有效抑制.     

柔性关节-柔性臂空间机器人的神经网络自适应反演控制及双重柔性振动抑制

空间机器人系统的柔性主要体现在空间机器人的臂杆和连接各臂杆之间的铰关节。由于空间机器人系统结构的复杂性,以往研究人员对同时具有柔性关节和柔性臂的系统关注不够。为此探讨了参数未知柔性关节-柔性臂空间机器人系统的动力学模拟、轨迹跟踪控制算法设计和关节、臂杆双重柔性振动的主动抑制问题。首先,采用多体动力学建模方法并结合漂浮基空间机器人固有的线动量和角动量守恒动力学特性,推导了系统的动力学方程。以此为基础,考虑到空间机器人实际应用中各关节铰具有较强柔性的情况,引入一种关节柔性补偿控制器解决了传统奇异摄动法应用受关节柔性限制问题,导出了适用于控制系统算法设计的数学模型。然后,利用该模型,基于反演思想在慢时标子系统中设计神经网络自适应控制算法来补偿系统参数未知和柔性关节引起的转动误差,实现系统运动轨迹跟踪性能;针对快时标子系统,设计了鲁棒最优控制算法抑制因柔性关节及柔性臂引起的系统双重弹性振动,保证系统的稳定性。最后,通过仿真对比实验验证了所设计控制算法的有效性。     

Control structure interaction in the nonlinear analysis of flexible mechanical systems

The effect of the control structure interaction on the feedforward control law as well as the dynamics of flexible mechanical systems is examined in this investigation. An inverse dynamics procedure is developed for the analysis of the dynamic motion of interconnected rigid and flexible bodies. This method is used to examine the effect of the elastic deformation on the driving forces in flexible mechanical systems. The driving forces are expressed in terms of the specified motion trajectories and the deformations of the elastic members. The system equations of motion are formulated using Lagrange's equation. A finite element discretization of the flexible bodies is used to define the deformation degrees of freedom. The algebraic constraint equations that describe the motion trajectories and joint constraints between adjacent bodies are adjoined to the system differential equations of motion using the vector of Lagrange multipliers. A unique displacement field is then identified by imposing an appropriate set of reference conditions. The effect of the nonlinear centrifugal and Coriolis forces that depend on the body displacements and velocities are taken into consideration. A direct numerical integration method coupled with a Newton-Raphson algorithm is used to solve the resulting nonlinear differential and algebraic equations of motion. The formulation obtained for the flexible mechanical system is compared with the rigid body dynamic formulation. The effect of the sampling time, number of vibration modes, the viscous damping, and the selection of the constrained modes are examined. The results presented in this numerical study demonstrate that the use of the driving forees obtained using the rigid body analysis can lead to a significant error when these forces are used as the feedforward control law for the flexible mechanical system. The analysis presented in this investigation differs significantly from previously published work in many ways. It includes the effect of the structural flexibility on the centrifugal and Coriolis forces, it accounts for all inertia nonlinearities resulting from the coupling between the rigid body and elastic displacements, it uses a precise definition of the equipollent systems of forces in flexible body dynamics, it demonstrates the use of general purpose multibody computer codes in the feedforward control of flexible mechanical systems, and it demonstrates numerically the effect of the selected set of constrained modes on the feedforward control law.     

链状柔性多体机器人系统动力学研究

本文基于Ｊｏｕｒｄａｉｎ变分原理建立了具有链状拓扑结构柔性多体机器人系统动力学通用模型，用在一致质量有限单元法及正则模态分析基础上引入的模态坐标描述构件的弹性形，用独立坐标描述相邻板件间的大位移运动，每个铰容许１－６个自由度，组强非线性惯性耦合的封闭形式的系统动力学微分方程组，文末对单弹性臂和双弹性臂机器人操作手进行动力学仿真。     

Dynamics of flexible multibody systems with tree topologies

The dynamic equations of flexible multibody systems with tree topological configuration are derived by using the Jourdain's principle. The independent joint coordinates are introduced to describe the large displacements of the bodies, and the modal coordinates are used to describe small deformations of flexible bodies based on the consistent mass finite element method and normal vibration mode analysis. The minimum differential equations are developed, which are compatible with the equations of multi-rigid body systems or structural dynamics. The stiff problem in the numerical integration is thus alleviated effectively. The method used in this paper can be extended to deal with systems with other topological configurations. Finally, the validity and feasibility of the presented mathematical model are demonstrated by a numerical example of a manipulator with two elastic links. The project supported by National Natural Science Foundation of China     

柔性铰柔性杆机器人动力学建模、仿真和控制

本文探究了铰柔性对机器人动力学响应和动力学控制的影响. 首先, 建立由$n$个柔性铰和$n$个柔性杆组成的空间机器人模型, 运用递推拉格朗日动力学方法, 得到柔性机器人系统的刚柔耦合动力学方程. 在动力学建模过程中, 除了考虑杆件的拉伸变形、弯曲变形、扭转变形以及非线性耦合变形对机器人系统动力学行为的影响, 还考虑了铰的柔性对机器人动力学响应和控制的影响. 其中, 柔性铰模型是基于Spong的柔性关节简化模型, 将柔性铰看成线性扭转弹簧, 不仅考虑了铰阻尼的存在, 还考虑了柔性铰的质量效应. 其次, 编写了空间柔性铰柔性杆机器人仿真程序, 研究铰的刚度系数和阻尼系数对系统动力学响应的影响. 研究表明: 随着柔性铰刚度系数的增大, 柔性机器人的动态响应幅值减小, 振动频率变大. 随着柔性铰阻尼系数的增大, 柔性机器人的动态响应幅值减小, 振动幅值的衰减速度变快. 可通过调节柔性铰的刚度和阻尼来减小柔性铰柔性杆机器人的振动, 因此铰阻尼的研究具有重要工程意义. 最后, 研究了铰柔性在机器人系统动力学控制中的影响. 在刚性铰机械臂和柔性铰机械臂完成相同圆周运动时, 通过逆动力学方法求解得到两种情况下的关节驱动力矩. 研究表明: 引入柔性铰会使控制所需的驱动力矩变小, 对机器人控制的影响显著.      

DYNAMICS MODELING,SIMULATION, AND CONTROL OF ROBOTS WITH FLEXIBLE JOINTS AND FLEXIBLE LINKS$^{\bf 1)}$

本文探究了铰柔性对机器人动力学响应和动力学控制的影响. 首先, 建立由$n$个柔性铰和$n$个柔性杆组成的空间机器人模型, 运用递推拉格朗日动力学方法, 得到柔性机器人系统的刚柔耦合动力学方程. 在动力学建模过程中, 除了考虑杆件的拉伸变形、弯曲变形、扭转变形以及非线性耦合变形对机器人系统动力学行为的影响, 还考虑了铰的柔性对机器人动力学响应和控制的影响. 其中, 柔性铰模型是基于Spong的柔性关节简化模型, 将柔性铰看成线性扭转弹簧, 不仅考虑了铰阻尼的存在, 还考虑了柔性铰的质量效应. 其次, 编写了空间柔性铰柔性杆机器人仿真程序, 研究铰的刚度系数和阻尼系数对系统动力学响应的影响. 研究表明: 随着柔性铰刚度系数的增大, 柔性机器人的动态响应幅值减小, 振动频率变大. 随着柔性铰阻尼系数的增大, 柔性机器人的动态响应幅值减小, 振动幅值的衰减速度变快. 可通过调节柔性铰的刚度和阻尼来减小柔性铰柔性杆机器人的振动, 因此铰阻尼的研究具有重要工程意义. 最后, 研究了铰柔性在机器人系统动力学控制中的影响. 在刚性铰机械臂和柔性铰机械臂完成相同圆周运动时, 通过逆动力学方法求解得到两种情况下的关节驱动力矩. 研究表明: 引入柔性铰会使控制所需的驱动力矩变小, 对机器人控制的影响显著.