渐进式约束扩展的机械臂运动规划算法

为了保证冗余机械臂带约束运动规划时的路径连续性,针对目前的直接插值和连续插值方法潜在的约束失效和路径失效问题,提出渐进式约束扩展的快速搜索随机树算法（PCE-RRT）。该算法在进行搜索树扩展时引入了一种渐进式约束扩展方法,该方法使用带有最近点信息的逆运动学计算策略,可以在保证任务约束的情况下迭代缩短最近点和扩展点的距离,让每一次扩展都能够保证搜索树的约束性和连续性。PCE-RRT可以使最终生成的搜索树很好地贴合于约束流形子空间,且树上任意两个相连节点都能满足连续条件。通过仿真实验对算法进行验证,实验结果表明该算法能够为机械臂带约束运动规划问题提供同时满足约束性和连续性条件的路径解。     

On point-to-point motion planning for underactuated space manipulator systems

In free-floating mode, space manipulator systems have their actuators turned off, and exhibit nonholonomic behavior due to angular momentum conservation. The system is underactuated and a challenging problem is to control both the location of the end effector and the attitude of the base, using manipulator actuators only. Here a path planning methodology satisfying this requirement is developed. The method uses high order polynomials, as arguments in cosine functions, to specify the desired path directly in joint-space. In this way, the accessibility of final configurations is extended drastically, and the free parameters are determined by optimization techniques. It was found that this approach leads always to a path, provided that the desired change in configuration lies between physically permissible limits. Physical limitations, imposed by system’s dynamic parameters, are examined. Lower and upper bounds for base rotation, due to manipulator motions, are estimated and shown in the implementation section. The presented method avoids the need for many small cyclical motions, and uses smooth functions in the planning scheme, leading to smooth configuration changes in finite and prescribed time.     

Periodic motion planning for virtually constrained Euler–Lagrange systems

The paper suggests an explicit form of a general integral of motion for some classes of dynamical systems including n-degrees of freedom Euler–Lagrange systems subject to (n-1) virtual holonomic constraints. The knowledge of this integral allows to extend the classical results due to Lyapunov for detecting a presence of periodic solutions for a family of second order systems, and allows to solve the periodic motion planning task for underactuated Euler–Lagrange systems, when there is only one not directly actuated generalized coordinate. As an illustrative example, we have shown how to create a periodic oscillation of the pendulum for a cart–pendulum system and how then to make them orbitally exponentially stable following the machinery developed in [A. Shiriaev, J. Perram, C. Canudas-de-Wit, Constructive tool for an orbital stabilization of underactuated nonlinear systems: virtual constraint approach, IEEE Trans. Automat. Control 50 (8) (2005) 1164–1176]. The extension here also considers time-varying virtual constraints.     

三连杆移动机械臂模型与运动规划

采用拉格朗日动力学方法和非完整动力学罗兹方程建立了三连杆移动机器臂运动学和动力学模型,并且利用该模型采用了人工势函数方法来驱动移动机械臂系统绕过障碍物到达目标位置.仿真的结果证明了该模型的正确性及其规划方法是有效的.     

Task scheduling and motion planning for an industrial manipulator

In many robotic industrial applications, a manipulator should move among obstacles and reach a set of task-points in order to perform a pre-defined task. It is quite important as well as very complicated to determine the time-optimum sequence of the task-points visited by the end-effector's tip only once assuring that the manipulator's motion through the successive task-points is collision-free.     

Sampling-based motion planning of manipulator with goal-oriented sampling

Intelligent Service Robotics - A sampling-based planning algorithm is one of the most powerful tools for collision avoidance in the motion planning of manipulators. However, this algorithm takes a...     

Fault-tolerant motion planning and control of redundant manipulator

One important issue in the motion planning of a kinematic redundant manipulator is fault tolerance. In general, if the motion planner is fault tolerant, the manipulator can achieve the required path of the end-effector even when its joint fails. In this situation, the contribution of the faulty joint to the end-effector is required to be compensated by the healthy joints to maintain the prescribed end-effector trajectory. To achieve this, this paper proposes a fault-tolerant motion planning scheme by adding a simple fault-tolerant equality constraint for the faulty joint. Such a scheme is then unified into a quadratic program (QP), which incorporates joint-physical constraints such as joint limits and joint-velocity limits. In addition, a numerical computing solver based on linear variational inequalities (LVI) is presented for the real-time QP solving. Simulative studies and experimental results based on a six degrees-of-freedom (DOF) redundant robot manipulator with variable joint-velocity limits substantiate the effectiveness of the proposed fault-tolerant scheme and its solution.     

基于带约束S型速度曲线的机械手笛卡尔空间轨迹规划

针对机械手在笛卡尔空间中轨迹规划问题，设计基于S型速度曲线的空间直线和空间圆弧插补算法。增加路径长度约束，将S型速度规划分为七段式、六段式、五段式和四段式4种类型；建立基于四元数的直线与圆弧运动的位姿模型，并采用弧长增量法插补技术实现轨迹规划。在六自由度机械手实时控制平台上进行了实验验证。结果表明:该算法可实现在路径长度约束下速度和加速度的自动调整；该算法可保证机械手末端加速度连续，有效减少冲击。     

real-time motion planning for multibody systems

The solution of constrained motion planning is an important task in a wide number of application fields. The real-time solution of such a problem, formulated in the framework of optimal control theory, is a challenging issue. We prove that a real-time solution of the constrained motion planning problem for multibody systems is possible for practical real-life applications on standard personal computers. The proposed method is based on an indirect approach that eliminates the inequalities via penalty formulation and solves the boundary value problem by a combination of finite differences and Newton–Broyden algorithm. Two application examples are presented to validate the method and for performance comparisons. Numerical results show that the approach is real-time capable if the correct penalty formulation and settings are chosen.     

A genetic approach to motion planning of redundant mobile manipulator systems considering safety and configuration

This article presents a genetic algorithm approach to multi-criteria motion planning of mobile manipulator systems. For mobile robot path planning, traveling distance and path safety are considered. The workspace of a mobile robot is represented as a grid by cell decomposition, and a wave front expansion algorithm is used to build the numerical potential fields for both the goal and the obstacles. For multi-criteria position and configuration optimization of a mobile manipulator, least torque norm, manipulability, torque distribution and obstacle avoidance are considered. The emphasis of the study is placed on using genetic algorithms to search for global optimal solutions and solve the minimax problem for manipulator torque distribution. Various simulation results from two examples show that the proposed genetic algorithm approach performs better than the conventional methods.     

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

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

基于有限时间对偶神经网络的冗余机械臂重复运动规划

在考虑关节物理极限的情况下,将冗余机械臂的逆运动学解析问题抽象为带约束的重复运动规划(RMP)方案.针对速度层的带约束RMP方案,本文提出了一种新型的递归神经网络,即有限时间对偶神经网络(FTDNN),用以求解该类带约束RMP方案.相比于传统的递归神经网络,该FTDNN模型具有有限时间收敛特性,不仅能够改进收敛的速度,并且能够获得较高的收敛精度.通过李雅普诺夫稳定性定理验证了FTDNN模型的渐近稳定性,并进一步计算出FTDNN模型求解带约束RMP方案最优解的时间上界.基于冗余机械臂PA10的计算仿真结果验证了FTDNN模型求解带约束RMP方案的有效性和可行性.最后在Dobot Magician实物机械臂上的实验结果表明本文提出的有限时间对偶神经网络方法可以有效实现机械臂各关节角的重复运动.     

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

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

Task-oriented motion planning for multi-arm robotic systems

In this paper a task-oriented motion planning approach for general cooperative multi-robot systems is proposed. In order to derive a meaningful task formulation, a taxonomy of cooperative multi-arm systems of industrial interest is devised. Then, a workpiece-oriented general formulation for cooperative tasks is proposed, where the user is asked to specify the motion of the system only at the workpiece level, while the motion of the single arms in the system is computed via kinematic transformations between the relevant coordinate frames. Based on this task formulation, an instructions set is derived to extend classical programming languages for industrial robots to general multi-robot systems. In order to test the approach, a software environment has been built, composed of an interpreter of the language and the motion planning software.     

状态空间中约束系统的运动方程

引入状态变量表示力学系统的约束方程;建立状态空间中运动约束系统的新型变分原理;导出运动约束系统的带乘子的运动微分方程和广义状态变量运动微分方程;证明状态空间中运动约束系统的运动方程是奇异的;举例说明所得结果的应用.     

Maneuver-based motion planning for nonlinear systems with symmetries

In this paper, we introduce an approach for the efficient solution of motion-planning problems for time-invariant dynamical control systems with symmetries, such as mobile robots and autonomous vehicles, under a variety of differential and algebraic constraints on the state and on the control inputs. Motion plans are described as the concatenation of a number of well-defined motion primitives, selected from a finite library. Rules for the concatenation of primitives are given in the form of a regular language, defined through a finite-state machine called a Maneuver Automaton. We analyze the reachability properties of the language, and present algorithms for the solution of a class of motion-planning problems. In particular, it is shown that the solution of steering problems for nonlinear dynamical systems with symmetries and invariant constraints can be reduced to the solution of a sequence of kinematic inversion problems. A detailed example of the application of the proposed approach to motion planning for a small aerobatic helicopter is presented.     

Unconstrained and constrained motion control of a planar two-link structurally flexible robotic manipulator

Unconstrained and constrained motion control of a planar two-link structurally-flexible robotic manipulator are considered in this study. The dynamic model is obtained by using the extended Hamilton's principle and the Galerkin criterion. A method is presented to obtain the linearized equations of motion in Cartesian space for use in designing the control system. The approach to solving the control problem is to use feedforward and feedback control torques. The feedforward torques maneuver the flexible manipulator along a nominal trajectory and the feedback torques minimize any deviations from the nominal trajectory. The feedforward and feedback torques are obtained by solving the inverse dynamics problem for the rigid manipulator and designing linear quadratic Gaussian with loop transfer recovery (LQG/LTR) compensators, respectively. The LQG/LTR design methodology is exploited to design a robust feedback control system that can handle modeling errors and sensor noise, and operate on Cartesian space trajectory errors. Computer simulated results are presented for an example planar, two-link, structurally flexible robotic manipulator. © 1994 John Wiley & Sons, Inc.     

Constrained motion planning of nonholonomic systems

This paper addresses the constrained motion planning problem for nonholonomic systems represented by driftless control systems with output. The problem consists in defining a control function driving the system output to a desirable point at a given time instant, whereas state and control variables remain over the control horizon within prescribed bounds. The state and control constraints are handled by extending the control system with a pair of state equations driven by the violation of constraints, and adding regularizing perturbations. For the regularized system a Jacobian motion planning algorithm is designed, called imbalanced. Solutions of example constrained motion planning problems for the rolling ball illustrate the theoretical concepts.     

Heuristic solution for constrained 7-DOF motion planning in 3D scanning application

This paper proposes a heuristic algorithm for near-optimal handling of the redundancy in robot mechanisms, applied to a 3D scanning platform consisting of a 6-DOF articulated robot arm which moves a laser sensor around a workpiece placed on a rotary table. The proposed method handles both static constraints, like avoiding joint limits, kinematic singularities or collisions, modelled using a configuration map viewed as a grayscale image, and dynamic constraints like velocity and acceleration. The algorithm is compared with Dijkstra algorithm, which gives the optimal solution, but is very slow, and with two other heuristics which are very fast, but give suboptimal solutions.