轮式移动机械臂的建模与仿真研究

移动机械臂系统一般由移动平台和机器臂组成,它既具有机器臂的操作灵活性,又具有移动机器人的可移动性,因此其应用范围要比单个系统宽得多。这篇文章主要研究了由非完整移动平台和完整机械臂组成的轮式移动机械臂系统的建模、跟踪控制及仿真问题。首先。利用拉格朗日动力学方程和非完整动力学罗兹方程建立了移动机械臂系统的精确数学模型;然后。利用非线性反馈将系统解耦。采用类PD控制器进行控制。在考虑了非完整约束及移动平台和机械臂的动态交互影响情况下,该控制算法保证系统同时跟踪给定的终端执行器和平台轨迹;最后,使用Maflah6．5对系统进行了仿真研究,仿真结果表明了其数学模型及控制方法的正确有效性。     

On-line collision avoidance system for two PTP command-based manipulators with distributed controller

This research aims to solve online collision avoidance problem of two manipulators with independent controller. Since industrial robot controller is a closed commercial system, trajectory generation part of robot controlling is always proprietary or unknown. Thus, this paper proposes a collision avoidance system of two manipulators which are controlled by point-to-point (PTP) commands, in condition that the internal of robot controller is unknown and unchangeable. Based on this condition, collision avoidance is supposed to be realized by online scheduling of these PTP controlling commands. This paper proposes the collision avoidance method that assumes the three-dimensional common workspace between two manipulators can be partitioned into many subregion elements. And with managing these subregion elements, which are occupied by robot motion, PTP commands are scheduled to adjust execution timing for collision avoidance. A deadlock problem caused by the partition of the workspace is also taken into consideration in the method. And the effectiveness and efficiency of the method have been verified by simulations and experiments.     

轮式移动机械臂的鲁棒跟踪控制研究

移动机械臂系统一般由移动平台和机器臂组成,它既具有机器臂的操作灵活性,又具有移动机器人的可移动性,因此其应用范围要比单个系统宽得多。这篇文章研究了由非完整移动平台和完整机械臂构成的移动机械臂系统的鲁棒跟踪控制问题,基于误差动态方程和耗散不等式引理设计了一种鲁棒跟踪控制器,该控制器在出现外界干扰时能使系统渐近跟踪给定信号。使用Matlab6.5对系统进行了仿真研究,仿真结果表明所提出的鲁棒控制算法是正确有效的。     

Dynamic Modeling and Tracking Control of a Nonholonomic Wheeled Mobile Manipulator with Dual Arms

This paper presents methodologies for dynamic modeling and trajectory tracking of a nonholonomic wheeled mobile manipulator (WMM) with dual arms. The complete dynamic model of such a manipulator is easily established using the Lagrange’s equation and MATHEMATICA. The structural properties of the overall system along with its subsystems are also well investigated and then exploited in further controller synthesis. The derived model is shown valid by reducing it to agree well with the mobile platform model. In order to solve the path tracking control problem of the wheeled mobile manipulator, a novel kinematic control scheme is proposed to deal with the nonholonomic constraints. With the backstepping technique and the filtered-error method, the nonlinear tracking control laws for the mobile manipulator system are constructed based on the Lyapunov stability theory. The proposed control scheme not only achieves simultaneous trajectory and velocity tracking, but also compensates for the dynamic interactions caused by the motions of the mobile platform and the two onboard manipulators. Simulation results are performed to illustrate the efficacy of the proposed control strategy.     

Aerial cooperative transporting and assembling control using multiple quadrotor–manipulator systems

In this paper, a fully distributed control scheme for aerial cooperative transporting and assembling is proposed using multiple quadrotor–manipulator systems with each quadrotor equipped with a robotic manipulator. First, the kinematic and dynamic models of a quadrotor with multi-Degree of Freedom (DOF) robotic manipulator are established together using Euler–Lagrange equations. Based on the aggregated dynamic model, the control scheme consisting of position controller, attitude controller and manipulator controller is presented. Regarding cooperative transporting and assembling, multiple quadrotor–manipulator systems should be able to form a desired formation without collision among quadrotors from any initial position. The desired formation is achieved by the distributed position controller and attitude controller, while the collision avoidance is guaranteed by an artificial potential function method. Then, the transporting and assembling tasks request the manipulators to reach the desired angles cooperatively, which is achieved by the distributed manipulator controller. The overall stability of the closed-loop system is proven by a Lyapunov method and Matrosov's theorem. In the end, the proposed control scheme is simplified for the real application and then validated by two formation flying missions of four quadrotors with 2-DOF manipulators.     

Dynamics and Cooperative Object Manipulation Control of Suspended Mobile Manipulators

Dynamics and control of mobile manipulators is obviously a more challenging problem compared to fixed-base robots. Including a suspension system for these mobile platforms increases their maneuverability, but considerably adds to their complexity. In this paper, a suspended wheeled mobile platform with two 6-DOF Puma-type manipulators is used to manipulate an object along a given path. To apply a model-based control algorithm, it is required to have an explicit dynamics model for such highly nonlinear system. This model should be as concise as possible to include fewer mathematical calculations for online computations. Therefore in this paper, a detailed set of dynamics equations for a multiple arm wheeled mobile platform equipped with an effective suspension system is presented. The method is based on the concept of Direct Path Method (DPM), which is extended here for such challenging type of robots. The obtained dynamics model is then verified with a dynamical analysis study using software ADAMS. Then, Natural Orthogonal Complement Method is used to include the non-holonomic constraint of the wheeled platform in a more concise dynamics model. Next, an impedance control law is applied for cooperative manipulation of an object by the two manipulators. The obtained results for a suspended wheeled platform equipped with two 6-DOF Puma-type manipulators reveal a successful performance for moving an object along a mixed circular-straight path, even in the presence of unexpected disturbing forces, system/end-effector flexibility and impacts due to contact with an obstacle.     

非完整移动机械臂的避障运动规划

针对有空间障碍物避免的移动式操作机器人系统运动规划问题，提出了一种基于特殊的人工势函数，使用局部距离信息实现非完整移动机械臂系统实时避障运动规划方法，并且用Lyapunov定理证明了闲环系统的稳定性。用提出的方法对非完整移动机械臂系统进行仿真．仿真结果表明了它的正确有效性。     

A kinematically compatible framework for cooperative payload transport by nonholonomic mobile manipulators

In this paper, we examine the development of a kinematically compatible control framework for a modular system of wheeled mobile manipulators that can team up to cooperatively transport a common payload. Each individually autonomous mobile manipulator consists of a differentially-driven Wheeled Mobile Robot (WMR) with a mounted two degree-of-freedom (d.o.f) revolute-jointed, planar and passive manipulator arm. The composite wheeled vehicle, formed by placing a payload at the end-effectors of two (or more) such mobile manipulators, has the capability to accommodate, detect and correct both instantaneous and finite relative configuration errors. The kinematically-compatible motion-planning/control framework developed here is intended to facilitate maintenance of all kinematic (holonomic and nonholonomic) constraints within such systems. Given an arbitrary end-effector trajectory, each individual mobile-manipulator's bi-level hierarchical controller first generates a kinematically-feasible desired trajectory for the WMR base, which is then tracked by a suitable lower-level posture stabilizing controller. Two variants of system-level cooperative control schemes—leader-follower and decentralized control—are then created based on the individual mobile-manipulator control scheme. Both methods are evaluated within an implementation framework that emphasizes both virtual prototyping (VP) and hardware-in-the-loop (HIL) experimentation. Simulation and experimental results of an example of a two-module system are used to highlight the capabilities of a real-time local sensor-based controller for accommodation, detection and corection of relative formation errors.     

Robust tracking control of a unicycle-type wheeled mobile manipulator using a hybrid sliding mode fuzzy neural network

This article presents a robust tracking controller for an uncertain mobile manipulator system. A rigid robotic arm is mounted on a wheeled mobile platform whose motion is subject to nonholonomic constraints. The sliding mode control (SMC) method is associated with the fuzzy neural network (FNN) to constitute a robust control scheme to cope with three types of system uncertainties; namely, external disturbances, modelling errors, and strong couplings in between the mobile platform and the onboard arm subsystems. All parameter adjustment rules for the proposed controller are derived from the Lyapunov theory such that the tracking error dynamics and the FNN weighting updates are ensured to be stable with uniform ultimate boundedness (UUB).     

基于屏障控制函数的轮式机器人系统多目标分布式协同控制

受多目标优化理论的启发,针对非完整约束轮式机器人设计基于屏障控制函数的多目标协同控制算法.该方法可实现队形控制主目标、连通性次级目标以及避碰次级目标,其中将连通性保持和避碰问题建模为两个系统约束,屏障控制函数作为约束对应的惩罚函数,可解决系统有输入或状态约束的问题.通过获取的局部信息将系统状态约束转化为屏障控制函数,利用屏障控制函数的类李雅普诺夫特性对其导数引入约束,再通过保证约束集的正不变性,达到控制目标.所提出方法可有效地避免控制器在连通性约束和避碰约束边界处的频繁切换,减小机械疲劳,在理论上可进一步扩展次级目标的数目,实现多目标控制.另外,所提出的协同控制算法对编队队形没有特殊要求,适用于不同编队需求和通信拓扑情况.最后通过数值仿真验证了所提出算法在不同情况下的有效性.     

A New Mobile Robot Toolbox for Matlab

In this study, a wheeled mobile robot navigation toolbox for Matlab is presented. The toolbox includes algorithms for 3D map design, static and dynamic path planning, point stabilization, localization, gap detection and collision avoidance. One can use the toolbox as a test platform for developing custom mobile robot navigation algorithms. The toolbox allows users to insert/remove obstacles to/from the robot’s workspace, upload/save a customized map and configure simulation parameters such as robot size, virtual sensor position, Kalman filter parameters for localization, speed controller and collision avoidance settings. It is possible to simulate data from a virtual laser imaging detection and ranging (LIDAR) sensor providing a map of the mobile robot’s immediate surroundings. Differential drive forward kinematic equations and extended Kalman filter (EKF) based localization scheme is used to determine where the robot will be located at each simulation step. The LIDAR data and the navigation process are visualized on the developed virtual reality interface. During the navigation of the robot, gap detection, dynamic path planning, collision avoidance and point stabilization procedures are implemented. Simulation results prove the efficacy of the algorithms implemented in the toolbox.     

Adaptive stabilization of mobile manipulators

This paper considers the motion control problem for uncertain mobile manipulator systems comprised of a robotic arm mounted on a wheeled mobile platform. More specifically, we address the problem of stabilizing mobile manipulators in the presence of uncertainty regarding the system dynamic model. It is proposed that a simple and effective solution to this problem can be obtained by combining ideas from homogeneous system theory and adaptive control theory. Thus each of the proposed control systems consists of two subsystems: a (homogeneous) kinematic stabilization strategy, which generates a desired velocity trajectory for the mobile manipulator, and an adaptive control scheme, which ensures that this velocity trajectory is accurately tracked. This approach is shown to provide arbitrarily accurate stabilization to any desired configuration and can be implemented without knowledge of the details of the system dynamic model. Moreover, it is demonstrated that exponential rates of convergence can be achieved with this methodology. The efficacy of the proposed stabilization strategies is illustrated through computer simulations with two mobile manipulators. © 1998 John Wiley & Sons, Inc.     

基于生存理论的非完整约束轮式机器人高速避障控制

轮式移动机器人现有的避障控制方法大多需要在避障过程中进行减速处理, 会影响移动效率. 鉴于此, 将生存理论应用于轮式移动机器人的反应式避障控制. 分析非完整约束轮式机器人的仿射非线性系统模型和约束条件, 利用弹性边界升维和控制模型退化的方法给出系统的生存性设计, 并利用最优化方法得出机器人高速避障控制器. 最后通过仿真实验, 表明了轮式机器人高速避障控制的有效性.

     

Cooperative collision avoidance between multiple mobile robots

This paper presents a new collision avoidance technique, called cooperative collision avoidance, for multiple mobile robots. The detection of the danger of collision between two mobile robots is discussed with respect to the geometric aspects of their paths as are cooperative collision avoidance behaviors. The direction control command and the velocity control command for the cooperative collision avoidance are then proposed. The avoidance technique is extended to cases in which the number of mobile robots is more than two. Furthermore, the conditions for collision avoidance are considered with respect to the navigation parameters and guidelines of designing the navigation parameters are obtained. The effectiveness of the proposed technique is demonstrated by means of numerical simulation and navigation experiments using two real mobile robots named Pioneer‐1. ©2000 John Wiley & Sons, Inc.     

Collision free cooperative navigation of multiple wheeled robots in unknown cluttered environments

When employing autonomous wheeled robots, it is desirable to use navigation approaches that always prevent collisions. In this paper, we consider the problem of navigating multiple vehicles through an unknown static environment with limited sensing and communication capabilities available. We propose a decentralized, cooperative, reactive, model predictive control based collision avoidance scheme that plans short range paths in the currently sensed part of the environment, and show that it is able to prevent collisions from occurring. An auxiliary controller is employed to follow previously planned paths whenever the main path planning system fails to update the path. Simulations and real-world testing in various scenarios confirm the methods validity.     

Multiple-arm space free-flying robots for manipulating objects with force tracking restrictions

Multiple Impedance Control (MIC) is an algorithm that enforces designated impedance at various levels, i.e. on the manipulated object, all cooperating manipulators, and the moving platform of a robotic system. In this paper, a force tracking strategy inspired by a human control system is added to the MIC algorithm and the general formulation is revised to fulfill a desired force tracking strategy for object manipulation tasks. The stability analysis of the MIC algorithm based on the Liapunov Direct Method, besides error analysis, shows that a good tracking of cooperative manipulators and the manipulated object is guaranteed. Next, using MAPLE and MATLAB tools, a system of three manipulators mounted on a space free-flying robot is simulated. The task is moving an object based on given trajectories which come across an obstacle, to examine the performance of the developed control law. The results show that, even in the presence of both external disturbances and an impact due to collision with the obstacle, the response of the MIC algorithm is smooth. Moreover, based on the embedded force tracking strategy, the contact force is confined to follow a desired trajectory. Also, it is shown that decreasing the values of the controller mass matrix elements results in reducing both the object position and force tracking error.     

Disturbance rejection for space‐based manipulators

Most industrial manipulators operate from a fixed base. Hence, there are no disturbances from the environment to alter the position of the end‐effector. On the other hand, manipulators that are mounted on mobile platforms are subject to disturbances emerging from unwanted motion at the base. Similarly, manipulators that perform delicate operations in space while on board in‐orbit spacecraft experience disturbances. This article describes the design and implementation of a disturbance rejection controller for a 6 degree‐of‐freedom (DOF) programable universal manipulator for assembly (PUMA) manipulator mounted on a 3‐DOF platform. A control algorithm is designed to track the desired position and attitude of the end‐effector in inertial space, subject to unknown disturbances in the platform axes. Experimental results are presented for step, sinusoidal, and random disturbances in the platform rotational axis and in the neighborhood of kinematic singularities. ©1999 John Wiley & Sons, Inc.     

Motion coordination and reactive control of autonomous multi-manipulator systems

The emerging field of service robots demands new systems with increased flexibility. The flexibility of a robot system can be increased in many different ways. Mobile manipulation—the coordinated use of manipulation capabilities and mobility—is an approach to increase robots flexibility with regard to their motion capabilities. Most mobile manipulators that are currently under development use a single arm on a mobile platform. The use of a two-arm manipulator system allows increased manipulation capabilities, especially when large, heavy, or non-rigid objects must be manipulated. This article is concerned with motion control for mobile two-arm systems. These systems require new schemes for motion coordination and control. A coordination scheme called transparent coordination is presented that allows for an arbitrary number of manipulators on a mobile platform. Furthermore, a reactive control scheme is proposed to enable the platform to support sensor-guided manipulator motion. Finally, this article introduces a collision avoidance scheme for mobile two-arm robots. This scheme surveys the vehicle motion to avoid platform collisions and arm collisions caused by self-motion of the robot. © 1996 John Wiley & Sons, Inc.     

基于预测窗的轮式移动机器人最优避障避碰算法

针对非线性轮式移动机器人的避障以及多机器人间的相互避碰问题,提出了一种基于预测窗的避障避碰算法.首先为了便于预测碰撞的发生,通过反馈线性化将非线性的机器人运动学模型转化成线性模型;然后根据线性模型预测会导致机器人发生碰撞的所有相对虚拟加速度变化量集合,称之为加速度变化障碍.基于此,为每个机器人构造既能躲避障碍物又能相互避碰的可行加速度变化集合.然后通过优化指标函数求得最优虚拟加速度变化量,最后将其转换成机器人的实际控制量.这种算法与现有的相比,可使机器人在避障或避碰过程中的行驶方向角、线速度的变化幅值更小,角速度和线加速度的变化更为平顺,而且运行所用的平均时间更短.仿真结果演示了所提出算法的有效性和相对于已有方法的优势.     

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

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