Recursive Lagrangian dynamic modeling and simulation of multi-link spatial flexible manipulator arms

The dynamics for multi-link spatial flexible manipulator arms consisting of n links and n rotary joints is investigated. Kinematics of both rotary-joint motion and link deformation is described by 4 - 4 homogenous transformation matrices, and the Lagrangian equations are used to derive the governing equations of motion of the system. In the modeling the recursive strategy for kinematics is adopted to improve the computational efficiency. Both the bending and torsional flexibility of the link are taken into account. Based on the present method a general-purpose software package for dynamic simulation is developed. Dynamic simulation of a spatial flexible manipulator arm is given as an example to validate the algorithm.     

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

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

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

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

DYNAMIC ANALYSIS OF FLEXIBLE-LINK AND FLEXIBLE-JOINT ROBOTS

The dynamic modeling and simulation of an N-flexible-link and N-flexible joint robot is reported. Each flexible joint is modeled as a linearly elastic torsional spring and the approach of assumed modes is adopted to describe the deformation of the flexible-link. The complete governing equations of motion of the flexible-link-joint robots are derived via Kane's method. An illustrative example is given to validate the algorithm presented and to show the effects of flexibility on the dynamics of robots.     

Dymamics of a rotating flexible manipulator with tip load

The dynamics of a flexible manipulator is investigated in this paper. From the point of view of dynamic blance, the motion equations of a rotating beam with tip load are established by using Hamilton's principle. By taking into account the effects of dynamic stiffening and dynamic softening, the stability of the system is proved by employing Lyapunov's approach. Furthermore, the method of power series is proposed to find the exact solution of the eigenvalue problem. The effects of rotating speed and tip load on the vibration behavior of the flexible manipulator are shown in numerical results. Supported by National Natural Science Foundation. of China     

基于变形场不同离散方法的柔性机器人动力学建模与仿真

研究了基于变形场不同离散方法的柔性机器人动力学建模和仿真问题. 针对多杆空间链式柔性机器人系统,采用假设模态法、有限元法、Bezier 插值方法和B 样条插值方法对柔性杆变形场进行描述,构造统一形式,运用Lagrange 方法,结合4×4 齐次变换矩阵,在计入柔性杆横向弯曲变形引起的纵向缩短的情况下,推导得到多杆空间柔性机器人动力学方程,并编制基于4 种变形场不同离散方法的多杆空间链式柔性机器人仿真软件.通过仿真算例对柔性机器人系统的动力学问题进行研究. 仿真结果表明:有限元法的计算效率较低;假设模态法在处理较大变形问题时其精度低于Bezier 插值方法和B 样条插值方法的精度;作为新的变形体离散方法,Bezier 插值方法和B 样条插值方法可以有效地描述柔性杆的变形场,并能运用到多杆空间柔性机器人动力学建模中.      

Influence of the flexibility of links on the dynamics of a multilink robot manipulator

The influence of the distributed flexibility of links on the dynamic behavior of a cantilevered multilink robot manipulator is studied. Two dynamic models of the robot are considered. In one of the models, the effectors are flexible. It is described by a hybrid system of ordinary and partial differential equations. In the other model, the manipulator links are perfectly rigid. It is based on the Lagrange formalism and described by a system of ordinary differential equations. To estimate the positioning accuracy, the results of modeling the manipulator in both cases are compared. A three-link manipulator is examined as an example __________ Translated from Prikladnaya Mekhanika, Vol. 43, No. 5, pp. 126–137, May 2007.     

Control and Parameter Optimization of Flexible Robots*

A hierarchical control concept for flexible robot manipulators is presented. The equations of motion are derived using the multibody system method, incorporating flexible links equipped with surface bonded actuating and sensing devices. Exploiting the structure of the dynamic model, the control concept allows combination of any joint level control for the gross motion of the manipulator with decentralized linear control of the elastic deformation of each flexible link. Therefore, the approach is capable of solving both the problem of fast and precise point-to-point motion, with acceptable vibration characteristics, and the problem of accurate trajectory tracking of the end-effector. Control parameters are found through parameter optimization. In order to verify the proposed control strategy, a SCARA robot with one flexible link is considered.     

机器人粘弹性手臂的动力学有限元分析

本文用动力学虚功原理建立了一般粘弹性大阻尼结构机器人手臂的动力学有限元模型,该模型是时变的Voterra型微分积分方程。文中还提出了以结构动力学中响应计算的逐步积分法为基础的递推求解方法,从而解决了机器人粘弹性手臂动力学建模和分析的理论难题。     

Robust Tracking of a Lightweight Manipulator System

A robust control design for high performance joint trajectory tracking of a flexible lightweight manipulator system is proposed. The design is based on a combined controller-observer scheme involving the sliding manifold approach and the optimal interpolation technique. This controller provides the designer with an enhanced joint tracking performance when the system is subject to parametric variations due to structural disturbances caused by link flexibility and load uncertainties. The parametric variations are handled by sliding control and the estimation of the nonlinearly excited elastic dynamics by an optimal interpolator of the structure's dynamic responses. The design procedure is progressive, i.e., we start with a basic controller and then modify it in order to improve the performance. Closed loop simulations with the various designed controllers are used to validate the analytical results and to help choosing the most suitable one.     

刚弹耦合的机器人机构动力学方程及其解

本文给出了一般开链弹性机器人机构动力学方程。该方程是由关节广义坐标和杆件模态坐标联立的非线性微分方程组。对方程的刚性性质作了讨论,根据Rosenbrock的二级二阶半隐式Runge—Kutta公械,导出了一种求解弹性机器人机构动力学方程的算法。对一平面二杆操作手机构作了计算。对该例同时也用Gill方法作了计算,验证了上述算法的精度和效率。     

刚-柔耦合多体系统动力学建模与数值仿真

柔性多体系统动力学传统的混合坐标建模方法忽略了变形位移的高次耦合变形量，是一种零次近似方法，其适用范围受到限制。本文以中心刚体、柔性粱及末端质量组成的刚柔耦合系统为对象，考虑了有粘性阻尼及风阻的情况。在柔性粱的纵向变形位移中计及了横向位移引起的轴向变形，并采用有限元方法和Hamilton变分原理导出了系统的刚柔耦合一次近似的动力学方程。该方程充分计及了中心刚体的大范围运动与柔性粱的弹性变形运动的相互耦合，并采用一致的方法引入了阻尼因素。文中最后提供了一个比“动力刚化”问题更具有一般性的仿真计算反例，进一步说明了零次近似方法在处理某些刚一柔耦合动力学问题时的缺陷，同时表明了由一次近似模型可得到正确合理的结论。     

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

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

柔性多体系统动力学实验研究综述

介绍了国内外柔性多体系统动力学实验研究现状,分为三个方面,即理论模型验证实验、动力学特性的实验研究和其它实验.柔性多体系统动力学建模理论的发展经历了3个阶段:运动-弹性动力学(KED)方法、传统混合坐标方法和计及了动力刚化效应的各种非线性理论.关于这些理论的模型验证实验均在本文中作了重点介绍.文中还对柔性多体系统动力学性态的研究实验也作了介绍,包括系统模态特性和共振等非线性力学行为.关于机械臂控制和碰撞研究实验虽有提及,但不作为重点.随后,着重介绍了柔性体弹性振动位移的测量和阻尼因素的处理这两个在实验不可避免但又难以解决的问题,尤其是结构阻尼和大范围运动引起的空气阻力.最后指出了今后的研究方向.文中对一些较为重要的实验装置也着重予以介绍,并给出了部分实验图片及数据曲线,以给读者一个更好的理解和参考.      

Systematic modeling of a chain of N-flexible link manipulators connected by revolute–prismatic joints using recursive Gibbs-Appell formulation

The main intent of this paper is to represent a systematic algorithm capable of deriving the equations of motion of N-flexible link manipulators with revolute–prismatic joints. The existence of the prismatic joints together with the revolute ones makes the derivation of governing equations difficult. Also, the variations of the flexible parts of the links, with respect to time cause the associated mode shapes of the links to vary instantaneously. So, to derive the kinematic and dynamic equations of motion for such a complex system, the recursive Gibbs-Appell formulation is applied. For a comprehensive and accurate modeling of the system, the coupling effects due to the simultaneous rotating and reciprocating motions of the flexible arms as well as the dynamic interactions between large movements and small deflections are also included. In this study, the links are modeled based on the Euler–Bernoulli beam theory and the assumed mode method. Also, the effects of gravity as well as the longitudinal, transversal and torsional vibrations have been considered in the formulations. Moreover, a recursive algorithm based on 3 ×  3 rotational matrices has been applied in order to derive the system’s dynamic equations of motion, symbolically and systematically. Finally, a numerical simulation has been performed by means of a developed computer program in order to demonstrate the ability of this algorithm in deriving and solving the equations of motion related to such systems.     

Modal test and analysis of cantilever beam with tip mass

The phenomenon of dynamic stiffening is a research field of general interest for flexible multi-body systems. In fact, there are not only dynamic stiffening but also dynamic softening phenomenon in the flexible multi-body systems. In this paper, a non-linear dynamic model and its linearization characteristic equations of a cantilever beam with tip mass in the centrifugal field are established by adopting the general Hamilton Variational Principle. Then, the problems of the dynamic stiffening and the dynamic softening are studied by using numerical simulations. Meanwhile, the modal test is carried out on our centrifuge. The numerical results show that the system stiffness will be strengthened when the centrifugal tension force acts on the beam (i.e. the dynamic stiffening). However, the system stiffness will be weakened when the centrifugal compression force acts on the beam (i.e. the dynamic softening). Furthermore, the equilibrium position of the system will lose its stability when the inertial force reaches a critical value. Through theoretical analysis, we find that this phenomenon comes from the effect of dynamic softening resulting from the centrifugal compression force. Our test results verify the above conclusions and confirm that both dynamic stiffening and softening phenomena exist in flexible multi-body systems. The project supported by the National Natural Science Foundation of China (19972002) and the Doctoral Programme from The State Education Commission China (20010001011)     

A new approach for dynamic analysis of flexible manipulator systems

In this paper, a new approach for dynamic analysis of the flexible multibody manipulator systems is described. The organization of the computer implementations which are used to automatically construct and numerically solve the system of loosely coupled dynamic equations expressed in terms of the absolute, joint and elastic coordinates is discussed. The main processor source code consists of three main modules: constraint module, mass module and force module. The constraint module is used to numerically evaluate the relationship between the absolute and joint accelerations. The mass module is used to numerically evaluate the system mass matrix as well as the non-linear Coriolis and centrifugal forces associated with the absolute, joint and elastic coordinates. At the same time, the force module is used to numerically evaluate the generalized external and elastic forces associated with the absolute, joint and elastic coordinates. Computational efficiency is achieved by taking advantage of the structure of the resulting system of loosely coupled equations. The absolute, joint and elastic accelerations are integrated forward in time using direct numerical integration methods. The absolute positions and velocities can then be determined using the kinematic relationships. The flexible 2-DOF double-pendulum and spatial manipulator systems are used as illustrated examples to demonstrate and verify the application of the computational procedures discussed in this paper.     

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

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

径向基点插值法在旋转柔性梁动力学中的应用

将无网格径向基点插值法用于旋转柔性梁的动力学分析. 利用无网格方法对柔性梁的变形场进行离散,考虑梁的纵向拉伸变形和横向弯曲变形,并计入横向弯曲变形引起的纵向缩短,即非线性耦合项,运用第二类拉格朗日方程推导得到系统刚柔耦合动力学方程. 将无网格径向基点插值法的仿真结果有限元法和假设模态法进行比较分析,说明假设模态法的局限性,并表明其作为一种柔性体离散方法在刚柔耦合多体系统动力学的研究中具有可推广性,并讨论了径向基形状参数的影响. 同时运用3 种求解系统动力学方程的方法:纽马克方法、4阶龙格库塔法、亚当姆斯预报校正法,并比较各方法的计算效率, 结果表明纽马克方法最快.      

A HIGH-ORDER RIGID-FLEXIBLE COUPLING MODEL OF A ROTATING FLEXIBLE BEAM UNDER LARGE DEFORMATION

对在平面内做大范围转动的中心刚体-柔性梁系统的刚柔耦合建模理论进行了深入研究,建立了系统的高次耦合动力学模型. 该动力学模型考虑了柔性梁横向弯曲变形和纵向伸长变形,且在纵向位移中计及由于横向变形而引起的纵向缩短项,即非线性耦合变形项,并保留了与非线性耦合项相关的一些高阶项,最终得到了系统的高次刚柔耦合动力学方程. 由此得到的动力学方程不仅能适用于柔性梁的小变形问题,也同样适用于大变形问题,弥补了一次近似耦合模型在处理柔性梁大变形问题上的不足. 通过与绝对节点坐标法以及一次近似耦合模型的对比验证了高次耦合模型的正确性.