Optimal path planning of redundant free-floating revolute-jointed space manipulators with seven links

The path planning of free-floating manipulators is of great interest in space operations. The manipulators in the free-floating mode exhibit nonholonomic characteristics due to the nonintegrability of the angular momentum, which makes the problem complicated. This paper analyzes the path planning of redundant, free-floating space manipulators with revolute joints and 7 degrees of freedom. The primary task of manipulators is to move the manipulator arms so that the desired end-effector position and orientation can be achieved. The motion of the manipulators can produce an attitude disturbance of the base, which has an adverse impact on the spacecraft operation. Thus, it is necessary to minimize the base attitude disturbance in order to reduce the fuel consumption for attitude maintenance. Practically, the path planning of redundant free-floating manipulators with higher degrees of freedom (7 degrees of freedom in this paper) in three-dimensional space is more complicated than path planning with fewer degrees of freedom, including planar or fixed base cases. This paper provides a tractable planning method to solve this problem, which could avoid the pseudo inverse of the Jacobian matrix. The sine functions, whose arguments are the polynomial functions with unknown coefficients, are used to specify the joint paths. The PSODE algorithm (particle swarm optimization combined with differential evolution) is applied to optimize the unknown coefficients of the polynomials in order to achieve the desired end-effector position and orientation and simultaneously minimize the base attitude disturbance. The simulations demonstrate that this method could provide satisfactory smooth paths for redundant free-floating space manipulators.     

Reaction torque control of redundant free-floating space robot

This paper presents the reaction torque based satellite base reactionless control or base disturbance minimization of a redundant free-floating space robot. This subject is of vital importance in the study of the free-floating space robot because the base disturbance minimization will result in less energy consumption and prolonged control application. The analytical formulation of the reaction torque is derived in this article, and the reaction torque control can achieve reactionless control and satellite base disturbance minimization. Furthermore, we derive the reaction torque based control of the space robot for base disturbance minimization from both the non-strict task priority and strict task priority control strategy. The dynamics singularity in the proposed algorithm is avoided in this paper. Besides, a real time simulation system of the space robot under Linux/real time application interface (RTAI) is developed to verify and test the feasibility and reliability of the method. The experimental results demonstrate the feasibility of online reaction torque control of the redundant free-floating space robot.     

Study on Non-holonomic Cartesian Path Planning of a Free-Floating Space Robotic System

The non-holonomic characteristic of a free-floating space robotic system is used to plan the path of the manipulator joints, by whose motion the base attitude and the inertial pose (the position and orientation with respect to the inertial frame) of the end-effector attain the desired values. First, the kinematic equations of a free-floating space robot are simplified and the system state variables are transformed to another form composed of base attitude and joint angles. Then, the joint trajectories are parameterized using sinusoidal functions, whose arguments are seven-order polynomials. Third, the planning problem is transformed to an optimization problem; the cost function, defined according to the accuracy requirements of system variables, is the function of the parameters to be determined. Finally, the Particle Swarm Optimization (PSO) algorithm is used to search the solutions of the parameters that determine the joint trajectories. The presented method meets three typical applications: (i) point-to-point maneuver of the end-effector without changing the base attitude, (ii) attitude maneuver of the base without changing the end-effector's pose and (iii) point-to-point maneuver of the end-effector with adjusting the base attitude synchronously. The simulation results of a spacecraft with a 6-d.o.f. manipulator verify the performance and the validity of the proposed method.     

Path-constrained control of a redundant manipulator in a task space

This study addresses the problem of controlling a redundant manipulator with both state and control dependent constraints. The task of the robot is to follow by the end-effector a prescribed geometric path given in the task space. The control constraints resulting from the physical abilities of robot actuators are also taken into account during the robot movement. Provided that a solution to the aforementioned robot task exists, the Lyapunov stability theory is used to derive the control scheme. The numerical simulation results, carried out for a planar manipulator whose end-effector follows a prescribed geometric path given in a task space, illustrate the trajectory performance of the proposed control scheme.     

Path following by the end-effector of a redundant manipulator operating in a dynamic environment

This paper addresses the problem of generating at the control-loop level a collision-free trajectory for a redundant manipulator operating in dynamic environments which include moving obstacles. The task of the robot is to follow, by the end-effector, a prescribed geometric path given in the work space. The control constraints resulting from the physical abilities of robot actuators are also taken into account during the robot movement. Provided that a solution to the aforementioned robot task exists, the Lyapunov stability theory is used to derive the control scheme. The numerical simulation results for a planar manipulator whose end-effector follows a prescribed geometric path, given in both an obstacle-free work space and a work space including the moving obstacles, illustrate the trajectory performance of the proposed control scheme.     

A direct algorithm for continuous path control of manipulators

This paper presents an algorithm for positioning and orientation of the hand for a redundant or non-redundant manipulator along a continuous path in space. This algorithm minimizes the distance between the actual position of the tip of the end-effector and the desired path. The algorithm does not use the Jacobian matrix for the inverse kinematics of the robot. It takes full advantage of the resolution of the joint drives, avoids singularity problems, and can be used for both redundant manipulators. The algorithm can be used in any situation where continuus motion of the end-effector is required in an open loop mode.     

基于虚拟样机技术的空间机器人系统的建模与仿真

首次采用虚拟样机技术对空间机器人系统进行建模和仿真,得出了反映机器人与卫星本体间运动学和动力学耦合情况的一些重要结果、为保持本体姿态稳定和驱动机器人按预定轨迹运动所需的控制力矩等．该方法可方便地用于验证固定基座、自由飞行、自由飘浮机器人的路径规划、控制算法、奇异空间等．与其它建模和仿真方法相比,该方法建模简单、可视化强、后处理功能极其强大,可实现多刚体系统闭环控制的仿真．     

Non-holonomic Path Planning of a Free-Floating Space Robotic System Using Genetic Algorithms

In this paper, the non-holonomic characteristic of a free-floating space robotic system is used to plan the path of the manipulator joints, by whose motion the base attitude and the manipulator joints attain the desired states. Here, we parameterize the joint trajectory using sinusoidal functions, whose arguments are high-order polynomials. Then, we define the cost function for optimization according to the constraint conditions and the accuracy of the space robot. Finally, genetic algorithms (GAs) are used to search for the solutions of the parameters. Compared with others, our approach has advantages as follows. (i) The motion of the manipulator and the disturbance on the base are practically constrained. (ii) The dynamic singularities cannot affect the algorithm since only the direct kinematic equations are utilized. (iii) The planned path is smooth and more applicable for the control of the manipulator. (iv) The convergence of the algorithm is not affected by the attitude singularity since the orientation error is represented by quaternion, which is globally singularity-free. The simulation results of the spacecraft with a 6-d.o.f. manipulator verify the performance and the validity of the proposed method.     

Torque Optimizing Control with Singularity-Robustness for Kinematically Redundant Robots

A new control method for kinematically redundant manipulators having the properties of torque-optimality and singularity-robustness is developed. A dynamic control equation, an equation of joint torques that should be satisfied to get the desired dynamic behavior of the end-effector, is formulated using the feedback linearization theory. The optimal control law is determined by locally optimizing an appropriate norm of joint torques using the weighted generalized inverses of the manipulator Jacobian-inertia product. In addition, the optimal control law is augmented with fictitious joint damping forces to stabilize the uncontrolled dynamics acting in the null-space of the Jacobian-inertia product. This paper also presents a new method for the robust handling of robot kinematic singularities in the context of joint torque optimization. Control of the end-effector motions in the neighborhood of a singular configuration is based on the use of the damped least-squares inverse of the Jacobian-inertia product. A damping factor as a function of the generalized dynamic manipulability measure is introduced to reduce the end-effector acceleration error caused by the damping. The proposed control method is applied to the numerical model of SNU-ERC 3-DOF planar direct-drive manipulator.     

Integration of real-time planning and control in an unstructured manufacturing workcell

In this paper, we consider the problem of real-time planning and control of a robot manipulator in an unstructured workspace. The task we consider is to control the manipulator, such that the end-effector follows a path on an unknown surface, with the aid of a single camera assumed to be uncalibrated with respect to the robot coordinates. To accomplish a task of this kind, we propose a new control strategy based on multisensor fusion. We assume that three different sensors, i.e. encoders mounted at each joint of the robot with 6 d.o.f., a force-torque sensor mounted at the wrist of the manipulator and a visual sensor with a single camera fixed to the ceiling of the workcell, are available. Also, we assume that the contact point between the tool grasped by the end-effector and the surface is frictionless. To describe the proposed algorithm that we have implemented, first of all we decouple the vector space of control variables into two subspaces, and use one of the subspaces for controlling the magnitude of the contact force on the surface and the other subspace for controlling the constrained motion on the surface. In this way the control synthesis problem is decoupled and we are able to develop a new scheme that utilizes sensor fusion to handle uncalibrated parameters in the workcell and wherein the surface on which the task is to be performed is assumed to be visible, but has an apriori unknown position.     

Determination of optimum robot base location considering discrete end-effector positions by means of hybrid genetic algorithm

The performance of a robot manipulator during a process depends on its position relative to the corresponding path. An ill-placed manipulator risks inefficient operation as well as blocks due to singularities. The paper deals with an optimization algorithm to determine the base position and the joint angles of a spatial robot, when the end-effector poses are prescribed, avoiding the singular configurations. The optimization problem is solved through a hybrid heuristic method that combines the advantages of a genetic algorithm, a quasi-Newton algorithm and a constraints handling method. Six cases of a 6-DOF manipulator are studied to verify the feasibility of the proposed algorithm.     

Robust trajectories following control of a 2-link robot manipulator via coordinate transformation for manufacturing applications

A common idea concerning trajectory control of robot manipulators is to tackle the motion of the end-effector. According to traditional trajectory designs, a prescribed profile in a work space is first decomposed into independent joint positions such that the success in a contouring task lies with good tracking capability of individual joints. To advance trajectory control precision without relying on high tracking performance, a contour control strategy for a robot manipulator is presented in this paper. Different from the traditional concept of trajectory control, a contour following control strategy is developed via a coordinate transformation scheme. The main advantage of the proposed control architecture is that the final contouring accuracy will not be degraded in case the tracking performance of the robot manipulator is not good enough. Moreover, using a concept of variable structure control theory, a smooth robust control algorithm is realized in the form of proportional control plus an integration term. The robustness of the control algorithm is also demonstrated. A number of experiments are conducted to demonstrate the advantage of the trajectories following control framework and validate the feasibility of the proposed controller.     

自由漂浮空间机器人避奇异规划—跟踪算法

针对路径相关空间内自由漂浮空间机器人无法进行有效跟踪控制的问题,设计了一种避奇异轨迹规划—跟踪算法,用于完成路径相关空间机械臂末端轨迹跟踪控制的任务．首先,分析奇异条件并设定安全边界曲线,求解回避奇异的基座姿态角阈值,从而得到避奇异参考轨迹及初始状态值．接着,利用自由漂浮空间机器人非线性动力学模型具有状态依赖参数的类线性结构特点,基于状态依赖Riccati方程设计跟踪控制器对末端速度进行跟踪,保证闭环系统的局部渐近稳定性．所提方法克服了传统方法将工作空间约束在路径无关空间的缺点．仿真结果表明,该算法具有比比例微分（proportional derivative,PD）控制更高的跟踪精度．同时,在存在输入干扰的情况下仍然能够实现有效跟踪．     

改进RRT-人工势场法的机械臂堆垛运动方法

快速拓展随机树算法(RRT)在机械臂路径规划中存在随机性强、搜索效率低、规划路径长等问题,不能在货柜堆垛场景中取得相对最优的光滑路径.对此,该文提出了一种改进RRT-人工势场法混合算法进行货柜堆垛机械臂运动规划.首先,对传统快速拓展随机树算法进行改进,在传统快速拓展随机树算法的全局搜索的基础上引入目标搜索,增强了随机树...     

自由飘浮空间机器人系统基座姿态调整

规划机械臂的运动以调整作为其基座的卫星的姿态，既节约姿控燃料，又可作为常规姿控系统的备份手段．首先，建立自由飘浮空间机器人系统的状态方程，其状态变量为关节角和卫星姿态角，输入变量为关节角速度．基于系统能控性理论，规划连接系统初始状态和期望状态的路径，实现了仅通过机械臂关节的运动同时控制基座姿态和机械臂关节角的目的．从理论上分析了机械臂的能量消耗，给出了使能量指标最小的近似最优算法．仿真结果表明了该方法的有效性．     

Data-Driven Human-Robot Interaction Without Velocity Measurement Using Off-Policy Reinforcement Learning

In this paper, we present a novel data-driven design method for the human-robot interaction (HRI) system, where a given task is achieved by cooperation between the human and the robot. The presented HRI controller design is a two-level control design approach consisting of a task-oriented performance optimization design and a plant-oriented impedance controller design. The task-oriented design minimizes the human effort and guarantees the perfect task tracking in the outer-loop, while the plant-oriented achieves the desired impedance from the human to the robot manipulator end-effector in the inner-loop. Data-driven reinforcement learning techniques are used for performance optimization in the outer-loop to assign the optimal impedance parameters. In the inner-loop, a velocity-free filter is designed to avoid the requirement of end-effector velocity measurement. On this basis, an adaptive controller is designed to achieve the desired impedance of the robot manipulator in the task space. The simulation and experiment of a robot manipulator are conducted to verify the efficacy of the presented HRI design framework.      

基于伪逆的导轨机械臂关节速度纠偏运动规划方案

针对导轨机械臂在任务执行过程中出现的关节速度偏离期望值的问题，提出了一种基于伪逆算法的导轨机械臂关节速度纠偏运动规划方案。首先，根据机械臂的关节角状态和末端执行器的运动状态，运用伪逆算法对导轨机械臂在速度层上进行冗余度解析。然后，设计时变函数对关节速度进行约束调整，使偏离后的关节速度收敛于期望值。接着，针对末端执行器出现的位置误差设计了误差修正方法以保证轨迹跟踪任务的顺利执行。最后，将运动规划方案在Matlab软件上以基座直线移动和弧形移动的四连杆冗余度机械臂为例进行了仿真实验。仿真结果表明了该方案能纠正导轨机械臂在任务执行过程中偏离期望值的关节速度，且能使末端执行器的轨迹跟踪达到较高的精度。     

基于伪逆的导轨机械臂关节速度纠偏运动规划方案

针对导轨机械臂在任务执行过程中出现的关节速度偏离期望值的问题,提出了一种基于伪逆算法的导轨机械臂关节速度纠偏运动规划方案。首先,根据机械臂的关节角状态和末端执行器的运动状态,运用伪逆算法对导轨机械臂在速度层上进行冗余度解析。然后,设计时变函数对关节速度进行约束调整,使偏离后的关节速度收敛于期望值。接着,针对末端执行器出现的位置误差设计了误差修正方法以保证轨迹跟踪任务的顺利执行。最后,将运动规划方案在Matlab软件上以基座直线移动和弧形移动的四连杆冗余度机械臂为例进行了仿真实验。仿真结果表明了该方案能纠正导轨机械臂在任务执行过程中偏离期望值的关节速度,且能使末端执行器的轨迹跟踪达到较高的精度。     

基于hp自适应伪谱法的空间机器人路径规划

针对空间机器人运动过程中基座姿态产生较大扰动的问题,基于hp自适应高斯伪谱法提出了一种以基座所受反作用力矩最小为目标函数的空间机器人路径规划方法.首先,综合考虑空间机器人运动过程中存在的关节角度约束、关节角速度约束、控制力矩约束及初始状态和终端状态约束等约束条件,将空间机器人路径规划问题看成满足一系列约束条件和边界条件并实现特定性能指标最优的最优控制问题.其次,结合hp自适应高斯伪谱法（hp-AGPM）与非线性规划技术,求解带有边界约束和路径约束的优化控制问题,得到满足约束且性能指标最优的空间机器人运动轨迹.最后,以平面2自由度空间机械臂为例对所设计方法进行仿真验证,并与其他伪谱法进行对比分析.仿真结果表明：本文算法能在10.6 s的时间内规划出满足各约束条件且容许偏差低于10^-6的最优运动轨迹,并且在计算速度和配点数量上都优于其他伪谱法.     

Robust robot manipulator control with autonomous consideration algorithm of torque saturation

As each joint actuator of a robot manipulator has a limit value of torque, the motion control system should consider the torque saturation. Conventional motion control based on robust acceleration controller cannot consider the torque saturation and it often causes an oscillated or wrong response. This paper proposes a new autonomous consideration method of joint torque saturation for robust manipulator motion control. The proposed method consists of three on-line autonomous algorithms. These algorithms are the torque limitation algorithm in joint space, the adjustment algorithm of motion control in Cartesian space, and the adjustment algorithm of motion reference in Cartesian space. The robot motion control using the proposed algorithms realizes smooth and robust robot motion response.