A multi-stage regulation strategy of space manipulators with a free-swinging joint failure

To ensure tasks can be completed after a free-swinging joint failure occurs, a multi-stage regulation strategy of space manipulators is proposed. Considering all terms of the dynamics equation, an evaluation model of the regulation ability (EMRA) of active joints over the fault joint is established based on the fuzzy entropy. And then a multi-stage regulation strategy based on the EMRA is designed to regulate the fault joint. The strategy divides the regulation process into several stages, and select a certain active joint to regulative the fault joint in every stage. With this multi-stage regulation strategy, the fault joint can be regulated to the desired angle without huge torque on regulative joints. The simulation is carried out with a 7-DOF space manipulator, verifying the correctness and effectiveness of the multi-stage regulation strategy. The strategy has three advantages: Coriolis and centrifugal terms are both considered for the first time in selecting the regulative joint, making the selection result more in line with the actual regulation process; The influence of the model uncertainty is eliminated in establishing the EMRA, making the evaluation of regulative ability more precise; The fault joint is successfully regulated to the desired angle without huge torque on regulative joints.     

Failure treatment strategy and fault-tolerant path planning of a space manipulator with free-swinging joint failure

Aiming at a space manipulator with free-swinging joint failure, a failure treatment strategy and fault-tolerant path planning method is proposed in this paper. This method can realize failure treatment of a space manipulator with free-swinging joint failure through determination of the optimal locked joint angle and dynamics model reconfiguration. Fault-tolerant path planning is realized by the establishment of the degraded workspace with integrated kinematics performance (DWWIKP) and an improved A-Star (A1) algorithm. This paper has the following contributions. The determination of the optimal locked joint angle can ensure that the manipulator is able to continue follow-up tasks while maximizing the workspace of the manipulator after locking the fault joint. Underactuated control of a high degree-of-freedom (DOF) manipulator can be effectively solved through dynamics model reconfiguration. The analysis process of the dynamics coupling relationship can be applied to cases where the active joint and the passive joint are parallel or perpendicular to each other. The establishment of the DWWIKP can demonstrate the kinematics performance of the manipulator in both joint space and operation space comprehensively. The improved A1 algorithm based on the integrated kinematics performance index (IKPI) can search a fault-tolerant task trajectory that satisfies the requirements of reachability and the overall kinematics performance simultaneously. The method proposed in this paper is verified by a 7-DOF manipulator, and it is available to any DOF manipulator with free-swinging joint failure.     

欠驱动机器人的动力学耦合奇异研究

欠驱动机械臂的运动只能从动力学水平进行控制,从动关节的运动是通过主动关节的动力学耦合间接控制的。主、被动关节之间的动力学耦合特征与机械臂关节空间的位形有关,因此在欠驱动机械臂运动过程中可能发生动力学耦合奇异,某些被动关节的运动变得不可控。从关节空间和操作空间两个角度分析了欠驱动机械臂的动力学耦合问题,给出从以上两种工作空间度量系统动力学耦合的指标。提出一种基于输入变量非线性变换的滑模变结构控制方法,用于实现欠驱动机械臂操作空间中的连续轨迹控制。通过平面二连杆欠驱动机械臂和只有一个主动关节的平面三连杆欠驱动机械臂进行了仿真,仿真结果证明提出的控制方法是可行的。     

基于阻抗内环的新型力外环控制策略

对于空间装配等与环境进行交互的任务,迫切要求空间机器人具有力控制的能力。利用机器人的关节力矩传感器,提出了一种新型的基于阻抗内环的力外环控制策略。在该方法中,内环采用阻抗控制代替传统的位置控制。阻抗控制内环使机器人具有一定的柔顺性,力外环通过期望力与实际力的误差对内环的参考轨迹进行修正,实现了机器人的力跟踪控制。另外,为了验证利用关节力矩传感器间接测量末端接触力的效果,机器人末端安装了一个高精度的JR3腕力传感器用来直接测量实际接触力。在基于位置内环和阻抗内环的力外环控制方式下,进行了机器人接触刚度变化较大环境（海绵、泡沫和铁块）的力跟踪实验。实验表明,当环境刚度变化较大时,相对于传统的力外环方法,本文提出的方法能够实现稳定的力跟踪性能。尤其对于铁块这种刚度很大的环境,该方法的有效性更加明显。     

欠驱动机械臂的光滑时变指数稳定

 针对一般欠驱动机械臂的运动规划和控制问题进行研究。从二阶漂移非完整约束系统的一般控制模型出发，基于李代数扩展理论，提出了二阶非完整约束系统的光滑多项式扩展概念，并进一步提出了一种二阶漂移非完整约束系统控制的指数稳定控制方法。针对欠驱动机械臂中从动关节不多于主动关节的情况，给出了一个指数稳定控制定理，并以平面2R和3R欠驱动机械臂进行了仿真。仿真结果证明了提出的指数稳定控制方法的有效性。     

Analysis of reaction torque-based control of a redundant free-floating space robot

Owing to the dynamics coupling between a free-floating base and a manipulator,the non-stationary base of a space robot will face the issue of base disturbance due to a manipulator's motion.The reaction torque acted on the satellite base's centroid is an important index to measure the satellite base's disturbance.In this paper,a comprehensive analysis of the reaction torque is made,and a novel way to derive the analytical form of the reaction torque is proposed.In addition,the reaction torque null-space is derived,in which the manipulator's joint motion is dynamically decoupled from the motion of the satellite base,and its novel expression demonstrates the equivalence between the reaction torque null-space and the reaction null-space.Furthermore,the reaction torque acted as an optimization index can be utilized to achieve satellite base disturbance minimization in the generalized Jacobian-based end-effector Cartesian path tracking task.Besides,supposing that the redundant degrees of freedom are abundant to achieve reaction torque-based active control,the reaction torque can be used to realize satellite base attitude control,that is,base attitude adjustment or maintenance.Moreover,because reaction torque-based control is a second-order control scheme,joint torque minimization can be regarded as the optimization task in reaction torque-based active or in-active control.A real-time simulation system of a 7-DOF space robot under Linux/RTAI is developed to verify and test the feasibility and reliability of the proposed ideas.Our extensive empirical results demonstrate that the corresponding analysis about the reaction torque is correct and the proposed methods are feasible.     

基于RBF网络的航空发动机 terminal滑模控制

针对现代航空发动机是一个具有不确定性的强非线性系统,结合滑模控制和神经网络控制的优点,提出了一种基于径向基函数(radical basis function,简称RBF)网络的航空发动机terminal滑模控制方法.分析了传统指数趋近律的不足,提出了一种改进的指数趋近律来削弱抖振.该控制器采用terminal滑模面,并且利用径向基函数神经网络在线实时补偿未知干扰和不确定项的影响.仿真结果表明,所设计的控制器取得了令人满意的控制效果,能有效地抑制干扰和参数不确定性的影响,削弱了抖振.      

Gaussian mixture model based adaptive control for uncertain nonlinear systems with complex state constraints

This paper addresses an uncertain nonlinear control system problem with complex state constraints and mismatched uncertainties. A novel Gaussian Mixture Model(GMM) based adaptive PID-Nonsingular Terminal Sliding Mode Control(NTSMC)(GMM-adaptive-PID-NTSMC)method is proposed. It is achieved by combining a GMM based adaptive potential function with a novel switching surface of PID-NTSMC. Next, the stability of the closed-loop system is proved.The main contribution of this paper is that the GMM meth...     

基于干扰观测器的柔性空间机器人在轨精细操作控制方法

由于强非线性、强耦合和强时变等特征,柔性空间机器人的稳定精细控制问题一直是一个重大挑战。轻质小型化机器人受空间及重量限制,其关节柔性通常不可忽略,这部分柔性主要是由谐波减速器和力矩传感器的柔性造成的。传统的运动学控制在空载时能保持稳定,但是对大负载、快速运动时的适应性差,严重时机械臂抖动剧烈甚至发散。针对以上特征,提出了一种基于非线性干扰观测器和动力学极点配置的柔性空间机器人在轨精细操作控制方法。仿真实验证明,该方法可以有效地抑制柔性激振,保证响应的快速性和准确性,同时有较好的鲁棒性,能够适应不同类型扰动的影响和末端环境柔顺控制的要求,对工程应用具有一定的参考意义。     

主被动复合驱动空间探测柔性伸杆机构的参数匹配

基于主被动复合驱动的思想提出一种大伸展/收拢比、高载荷/自重比的新型伸缩式伸杆机构,以满足微纳探测器的实际应用需求,用于支撑各类探测载荷远离航天器本体,避免本体剩磁对空间待测信号的干扰,保证探测数据的准确性。首先,探索描述被动驱动源（弹簧铰链）的力矩驱动特性;然后,分析柔性伸杆的弯曲、扭转、压平和卷曲等力学性能。在此基础上,结合建立的柔性伸杆伸展速度、负载动能、弹簧铰链势能及主动驱动（电动机）力矩等参数的能量流约束方程,进行主、被动驱动和柔性伸杆的参数匹配研究;最后,利用有限元软件仿真和样机平台实验验证了参数匹配的合理性。仿真与实验结果表明,针对主被动复合驱动的空间探测柔性伸杆机构,通过合理的参数匹配,可实现柔性伸杆无褶皱地平稳伸展和收拢,为后续的机构设计和控制方案奠定了基础。     

平面柔性欠驱动机械臂的非线性动力学分析

研究了平面柔性欠驱动机械臂中被动关节对系统动态特性的影响 ,在动力学分析的基础上 ,提出了一种基于内共振原理的柔性欠驱动机械臂振动控制方法。在对系统的稳态周期运动进行分析研究的基础上 ,发现处于自由摆动状态的被动关节的平衡位置随系统结构的振动而发生漂移 ,并且被动关节平衡位置的漂移速度和方向与周期输入的振幅有关。提出利用结构柔性产生的振动实现被动关节位置控制的方法 ,通过平面二连杆柔性欠驱动机械臂进行了仿真计算     

基于Leader-Follower的多无人机编队轨迹跟踪设计

针对四旋翼无人机（UAV）群在轨迹跟踪过程中易受外界干扰而引起跟踪误差的问题，设计了基于Leader-Follower的多无人机协同编队轨迹跟踪控制方法。在该系统中，首先通过积分反步法（IBS）对所建四旋翼飞行器模型设计Leader无人机的轨迹跟踪控制器。其次设计了滑模控制（SMC）器，以控制Leader与Follower无人机实现期望的编队队形并同时跟踪参考轨迹。然后通过数值仿真验证了算法的有效性，仿真结果表明，系统具有良好的控制精度。最后通过视觉定位系统进行实验，结果表明所设计的控制器能够实现多个无人机轨迹跟踪和编队控制，所设计的算法具有可行性。     

Fractional order adaptive robust formation control of multiple quad-rotor UAVs with parametric uncertainties and wind disturbances

In recent times, multiple Unmanned Aerial Vehicles (UAVs) are being widely utilized in several areas of applications such as agriculture, surveillance, disaster management, search and rescue operations. Degree of robustness of applied control schemes determines how accurate a swarm of UAVs accomplish group tasks. Formation and trajectory tracking controllers are required for the swarm of multiple UAVs. Factors like external environmental effects, parametric uncertainties and wind gusts make the controller design process as a challenging task. This article proposes fractional order formation and trajectory tacking controllers for multiple quad-rotors using Super Twisting Sliding Mode Control (STSMC) technique. To compensate the effects of the disturbances due to parametric uncertainties and wind gusts, Lyapunov function based adaptive controllers are formulated. Moreover, Lyapunov theorem is used to guarantee the stability of the proposed controllers. Three types of controllers, namely fixed gain STSMC and fractional order Adaptive Super Twisting Sliding Mode Control (ASTSMC) methods are tested for the swarm of UAVs by performing the numerical simulations in MATLAB/Simulink environment. From the presented results, it is verified that in presence of wind disturbances and parametric uncertainties, the proposed fractional order ASTSMC technique showed improved robustness as compared to the fixed gain STSMC and integer order ASTSMC.     

欠驱动非完整机械系统的鲁棒控制

讨论了一类不确定欠驱动非完整机械系统的跟踪控制问题。基于所定义的误差方程,提出了新的鲁棒控制器。该控制器不但对系统惯性参数的不确定具有鲁棒性,而且保证了系统的跟踪误差渐近趋于零。数字仿真验证了所提出控制器的有效性。     

加速度计组合件高精度两级鲁棒温度控制

 将存在多个工作环境的加速度计组合件两级温度控制系统的受控对象描述为存在有界干扰和非线性不确定性(包括系统的建模误差和两个控制通道间的相互耦合)的两输入两输出非线性时变不确定系统,提出了一种基于信号补偿的鲁棒温度控制方法。该方法设计的控制器由标称控制器和鲁棒补偿器组成。此控制器为线性定常的,易于物理实现。证明了闭环系统的鲁棒控制特性,实验结果显示所设计的控制系统能够在多个工作环境下实现加速度计组合件内部和外部的高精度鲁棒温度控制。     

基于状态观测器的空间机械臂关节故障诊断

为了实时检测空间机械臂关节故障的发生并获得有效的故障信息,提出一种基于状态观测器的关节故障诊断方法。通过结合滑模变结构控制理论设计滑模状态观测器,获得机械臂各运行状态的残差信息,并将其与设定的阈值比较,实现关节故障的检测。进而引入不同的故障模式,构建故障数据库,将实际关节故障所导致的机械臂故障残差信息与故障数据库对比,完成故障发生位置及其故障程度的识别。所提诊断方法考虑了空间机械臂系统内部强耦合特性,能够及时检测故障的发生并获取有效的故障信息。最后以7自由度空间机械臂为对象开展数值仿真研究,验证了所提关节故障诊断方法的有效性。     

冗余铺丝机械手自运动流形分析及优化

针对传统位姿分离式铺丝机械手灵活性不足的特点,为了提高航空复合材料铺丝过程的灵活性和避障碍能力,提出一种位姿耦合式冗余铺丝机械手自运动流形的新算法。由于冗余铺丝机械手各关节之间的强耦合性增加了逆解的求解难度,该算法将冗余铺丝机械手的关节逆解分解为已知的Paden-Kahan旋量子问题以及由位置关节组成的特殊旋量子问题,并针对特殊旋量子问题进行求解得到冗余铺丝机械手全部逆解,这样相对于位姿分离式解法有效提高了冗余铺丝机械手逆解的求解效率以及求解直观性。由于冗余铺丝机械手的逆解呈现出流形的结构,所以根据冗余铺丝机械手自运动流形的多维特性,将冗余铺丝机械手的自运动流形分别映射到位置关节空间和姿态关节空间得到其三维仿真曲线。由于冗余铺丝机械手逆解流形中的优化流形在实际控制中更具应用价值,所以在铺丝机械手末端执行器沿芯模轨迹运动速度平稳的前提下为了使机械手各关节速度变化最小,提出以冗余铺丝机械手关节速度组成的约束泛函为目标得到相应的运动学优化流形,并为后续的最优控制奠定了基础。最后以某型号飞机S形进气道为例验证了所提方法的可行性。     

主被动复合驱动空间探测柔性伸杆机构的参数匹配简

 基于主被动复合驱动的思想提出一种大伸展/收拢比、高载荷/自重比的新型伸缩式伸杆机构,以满足微纳探测器的实际应用需求,用于支撑各类探测载荷远离航天器本体,避免本体剩磁对空间待测信号的干扰,保证探测数据的准确性。首先,探索描述被动驱动源（弹簧铰链）的力矩驱动特性;然后,分析柔性伸杆的弯曲、扭转、压平和卷曲等力学性能。在此基础上,结合建立的柔性伸杆伸展速度、负载动能、弹簧铰链势能及主动驱动（电动机）力矩等参数的能量流约束方程,进行主、被动驱动和柔性伸杆的参数匹配研究;最后,利用有限元软件仿真和样机平台实验验证了参数匹配的合理性。仿真与实验结果表明,针对主被动复合驱动的空间探测柔性伸杆机构,通过合理的参数匹配,可实现柔性伸杆无褶皱地平稳伸展和收拢,为后续的机构设计和控制方案奠定了基础。     

Parameterization and adaptive control of space robot systems

In space application, robot system are subject to unknown or unmodeled dynamics, for example, in the tasks of transporting an unknown payload or catching an unmodeled moving object. We discuss the parameterization problem in dynamic structure and adaptive control of a space robot system with an attitude-controlled base to which the robot is attached. We first derive the system kinematic and dynamic equations based on Lagrangian dynamics and the linear momentum conservation law. Based on the dynamic model developed, we discuss the problem of linear parameterization in term of dynamic parameters, and find that in joint space, the dynamics can be linearized by a set of combined dynamic parameters; however, in inertial space linear parameterization is impossible in general. Then we propose an adaptive control scheme in joint space, and present a simulation study to demonstrate its effectiveness and computational procedure. Because most takes are specified in inertial space instead of joint space, we discuss the issues associated to adaptive control in inertial space and identify two potential problem: unavailability of joint trajectory because the mapping from inertial space trajectory is dynamic-dependent and subject to uncertainty; and nonlinear parameterization in inertial space. We approach the problem by making use of the proposed joint space adaptive controller and updating the joint trajectory by the estimated dynamic parameters and given trajectory in inertial space     

A modified forward and backward reaching inverse kinematics based incremental control for space manipulators

Forward and backward reaching inverse kinematics (FABRIK) is an efficient two-stage iterative solver for inverse kinematics of spherical-joint manipulator without the calculation of Jacobian matrix. Based on FABRIK, this paper presents an incremental control scheme for a free-floating space manipulator consists of revolute joints and rigid links with the consideration of joint constraints and dynamic coupling effect. Due to the characteristics of FABRIK, it can induce large angular movements on specific joints. Apart from that, FABRIK maps three dimensional (3D) problem into two dimensional (2D) problem by a simple geometric projection. This operation can cause infinite loops in some cases. In order to overcome these issues and apply FABRIK on space manipulators, an increments allocation method is developed to constrain the angular movements as well as to re-orient the end-effector. The manipulator is re-positioned based on the momentum conservation law. Instead of pure target position tracking, the orientation control of the end-effector is also considered. Numerical simulation is performed to testify and demonstrate the effectiveness and reliability of the proposed incremental control approach.