多移动机器人轨迹跟踪控制系统设计与实现

针对轮式移动机器人的轨迹跟踪控制问题,在分析了机器人运动学模型的基础上,构建多机器人的领航-追随模型;采用跟踪微分器在输入输出两端安排过渡过程,设计了一种基于多变量解耦的非线性PID轨迹跟踪控制器;搭建以Arduino Mega 1280控制板为核心的移动机器人实验平台,采用速度PID控制器以满足机器人驱动电机的实时调速要求,基于ROS提出一种结构化和模块化的多机器人控制系统;在此基础上进行实验,并将实验结果与传统PID方法控制的实验结果进行对比;实验结果验证了文章所提算法的有效性,控制器易于实现且具有一定的鲁棒性。     

非完整移动机器人轨迹跟踪自适应控制器设计

针对轮式移动机器人的非完整运动学模型,将自适应反演控制技术和李亚普诺夫稳定性理论应用于机器人轨迹跟踪控制,设计了具有全局渐近稳定性的自适应轨迹跟踪控制器,并在Matlab环境下实现了移动机器人对直线和椭圆2种轨迹追踪的仿真实验.实验表明:该控制方法在轨迹跟踪控制中有较好的航向跟踪效果,对机器人非完整系统模型的非线性特性...     

Convergence and robustness of a discrete-time learning control scheme for constrained manipulators

The constrained motion control is one of the most common control tasks found in many industrial robot applications. The nonlinear and nonclassical nature of the dynamic model of constrained robots make designing a controller for accurate tracking of both motion and force a difficult problem. In this article, a discrete-time learning control problem for precise path tracking of motion and force for constrained robots is formulated and solved. The control system is able to reduce the tracking error iteratively in the presence of external disturbances and errors in initial condition as the robot repeats its action. Computer simulation result is presented to demonstrate the performance of the proposed learning controller. © 1994 John Wiley & Sons, Inc.     

Adaptive control of free-floating space robots in Cartesian coordinates

An adaptive control scheme is proposed for the end-effector trajectory tracking control of free-floating space robots. In order to cope with the nonlinear parameterization problem of the dynamic model of the free-floating space robot system, the system is modeled as an extended robot which is composed of a pseudo-arm representing the base motions and a real robot arm. An on-line estimation of the unknown parameters along with a computed-torque controller is used to track the desired trajectory. The proposed control scheme does not require measurement of the accelerations of the base and the real robot arm. A two-link planar space robot system is simulated to illustrate the validity and effectiveness of the proposed control scheme.     

Adaptive Jacobian tracking control of robots with uncertainties in kinematic, dynamic and actuator models

Most research so far on robot trajectory control has assumed that the kinematics of the robot is known exactly. However, when a robot picks up tools of uncertain lengths, orientations, or gripping points, the overall kinematics becomes uncertain and changes according to different tasks. Recently, we derived a new adaptive Jacobian tracking controller for robots with uncertain kinematics and dynamics. This note extends the results to include redundant robots and adaptation to actuator parameters. Experimental results are presented to illustrate the performance of the proposed controller.     

无人仓多搬运机器人协同作业轨迹自动控制研究

由于无人仓多搬运机器人协同作业线路较为复杂,导致协同作业轨迹控制难度增加,为了保证多搬运机器人能够按照规划路线执行搬运作业,提出了无人仓多搬运机器人协同作业轨迹自动控制方法;采用栅格图建模法,结合无人仓内货架的实际分布情况,建立无人仓环境场景;从组成结构、运动学以及动力学3个方面,构建搬运机器人的数学模型;遵循就近原则分配多机器人搬运任务,规划多搬运机器人的协同作业轨迹,根据多搬运机器人实时位姿的自动检测结果计算控制量,利用作业轨迹自动控制器的安装与运行,完成无人仓多搬运机器人协同作业轨迹的自动控制任务;实验结果表明,在该方法应用后,多搬运机器人在无人仓中的作业轨迹与规划轨迹基本相同,计算得出的平均位置控制误差和姿态角控制误差分别为2.27 cm和0.05°,搬运机器人的碰撞次数能被控制在规定范围内,实际应用效果好。     

A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-Varying Formations

In this paper, we present a synchronization approach to trajectory tracking of multiple mobile robots while maintaining time-varying formations. The main idea is to control each robot to track its desired trajectory while synchronizing its motion with those of other robots to keep relative kinematics relationships, as required by the formation. First, we pose the formation-control problem as a synchronization control problem and identify the synchronization control goal according to the formation requirement. The formation error is measured by the position synchronization error, which is defined based on the established robot network. Second, we develop a synchronous controller for each robot's translation to guarantee that both position and synchronization errors approach zero asymptotically. The rotary controller is also designed to ensure that the robot is always oriented toward its desired position. Both translational and rotary controls are supported by a centralized high-level planer for task monitoring and robot global localization. Finally, we perform simulations and experiments to demonstrate the effectiveness of the proposed synchronization control approach in the formation control tasks.     

From Trajectory Tracking Control to Leader–Follower Formation Control

Abstract

This work investigates the leader–follower formation control of multiple nonholonomic mobile robots. First, the formation control problem is converted into a trajectory tracking problem and a tracking controller based on the dynamic feedback linearization technique drives each follower robot toward its corresponding reference trajectory in order to achieve the formation. The desired orientation for each follower is selected such that the nonholonomic constraint of the robot is respected, and thus the tracking of the reference trajectory for each follower is feasible. An adaptive dynamic controller that considers the actuators dynamics in the design procedure is proposed. The dynamic model of the robots includes the actuators dynamics in order to obtain the velocities as control inputs instead of torques or voltages. Using Lyapunov control theory, the tracking errors are proven to be asymptotically stable and the formation is achieved despite the uncertainty of the dynamic model parameters. In order to assess the proposed control laws, a ROS-framework is developed to conduct real experiments using four ROS-enabled mobile robots TURTLEBOTs. Moreover, the leader fault problem, which is considered as the main drawback of the leader–follower approach, is solved under ROS. An experiment is conducted where in order to overcome this problem, the desired formation and the leader role are modified dynamically during the experiment.     

Investigations on the Hybrid Tracking Control of an Underactuated Autonomous Underwater Robot

The problem of trajectory tracking control of an underactuated autonomous underwater robot (AUR) in a three-dimensional (3-D) space is investigated in this paper. The control of an underactuated robot is different from fully actuated robots in many aspects. In particular, these robot systems do not satisfy Brockett's necessary condition for feedback stabilization and no continuous time-invariant state feedback control law exists that makes a specified equilibrium of the closed-loop system asymptotically stable. The uncertainty of hydrodynamic parameters, along with the coupled, nonlinear dynamics of the underwater robot, also makes the navigation and tracking control a difficult task. The proposed hybrid control law is developed by combining sliding mode control (SMC) and classical proportional–integral–derivative (PID) control methods to reduce the tracking errors arising out of disturbances, as well as variations in vehicle parameters like buoyancy. Here, a trajectory planner computes the body-fixed linear and angular velocities, as well as vehicle orientations corresponding to a given 3-D inertial trajectory, which yields a feasible 6-d.o.f. trajectory. This trajectory is used to compute the control signals for the three available controllable inputs by the hybrid controller. A supervisory controller is used to switch between the SMC and PID control as per a predefined switching law. The switching function parameters are optimized using Taguchi design techniques. The effectiveness and performance of the proposed controller is investigated by comparing numerically with classical SMC and traditional linear control systems in the presence of disturbances. Numerical simulations using the full set of nonlinear equations of motion show that the controller does quite well in dealing with the plant nonlinearity and parameter uncertainties for trajectory tracking. The proposed controller response shows less tracking error without the usually present control chattering. Some practical features of this control law are also discussed.     

On controlling robots with redundancy

Recently there has been considerable interest in increasing the applicability and utility of robots by developing manipulators which possess kinematic and/or actuator redundancy. This paper presents a unified approach to controlling these redundant robots. The proposed control system consists of two subsystems: an adaptive position controller which generates the Cartesian-space control force FR^m required to track the desired end-effector position trajectory, and an algorithm that maps this control input to a robot joint torque vector TRⁿ. The F → T map is constructed so that the robot redundancy (kinematic and/or actuator) is utilized to improve the performance of the robot. The control scheme does not require knowledge of the complex robot dynamic model or parameter values for the robot or the payload. As a result, the controller is very general and is computationally efficient for on-line implementation. Computer simulation results are given for a kinematically redundant robot, for a robot with actuator redundancy, and for a robot which possesses both kinematic and actuator redundancy. In each case the results demonstrate that accurate end-effector trajectory tracking and effective redundancy utilization can be achieved simultaneously with the proposed scheme.     

Localized online learning-based control of a soft redundant manipulator under variable loading

ABSTRACT

Soft robots are inherently compliant and manoeuvrable manipulators that can passively adapt to their environment. However, in order to fully make use of their unique properties, accurate control should still be maintained when affected by external loading. Commonly used model-based approaches often have low tolerance to unmodelled loading, resulting in significant error when acted on by them. Therefore, in this study we employ a nonparametric learning-based method that can approximate and update the inverse model of a redundant two-segment soft robot in an online manner. The primary contribution of this work is the application and evaluation of the proposed framework on a redundant soft robot. With the addition of redundancy, a constrained optimization approach is taken to consistently resolve null-space behaviour. Through this control framework, the controller can continuously adapt to unknown external disturbances during runtime and maintain end-effector accuracy. The performance of the control framework was evaluated by tracking of a 3D trajectory with a static tip load, and a variable weight tip load. The results indicate that the proposed controller could effectively adapt to the disturbances and continue to track the desired trajectory accurately.     

基于RBF神经网络的多关节机器人固定时间滑模控制

针对具有典型非线性特性的多关节机器人轨迹跟踪控制问题,提出一种基于径向基函数(RBF)神经网络的固定时间滑模控制方法.首先,基于凯恩方法建立包括系统模型不确定性以及外部干扰在内的多关节机器人动力学模型;然后,根据机器人动力学模型设计一种固定时间收敛的滑模控制器,RBF神经网络用来逼近系统模型中的不确定性项,并利用Lyapunov理论证明该系统跟踪误差能在固定时间内收敛;最后,对特定型号的多关节机器人虚拟样机进行仿真分析,结果表明:与基于RBF神经网络的有限时间滑模控制器相比,所提出控制器具有良好的跟踪性能且能保证系统状态在固定时间内收敛.     

Dynamic Load Carrying Capacity of Flexible Cable Suspended Robot: Robust Feedback Linearization Control Approach

In this paper dynamic load carrying capacity (DLCC) of a cable robot equipped with a closed loop control system based on feedback linearization, is calculated for both rigid and flexible joint systems. This parameter is the most important character of a cable robot since the main application of this kind of robots is their high load carrying capacity. First of all the dynamic equations required for control approach are represented and then the formulation of control approach is driven based on feedback linearization method which is the most suitable control algorithm for nonlinear dynamic systems like robots. This method provides a perfect accuracy and also satisfies the Lyapunov stability since any desired pole placement can be achieved by using suitable gain for controller. Flexible joint cable robot is also analyzed in this paper and its stability is ensured by implementing robust control for the designed control system. DLCC of the robot is calculated considering motor torque constrain and accuracy constrain. Finally a simulation study is done for two samples of rigid cable robot, a planar complete constrained sample with three cables and 2 degrees of freedom and a spatial unconstrained case with six cables and 6 degrees of freedom. Simulation studies continue with the same spatial robot but flexible joint characteristics. Not only the DLCC of the mentioned robots are calculated but also required motors torque and desired angular velocity of the motors are calculated in the closed loop condition for a predefined trajectory. The effectiveness of the designed controller is shown by the aid of simulation results as well as comparison between rigid and flexible systems.     

基于神经网络的不确定移动机器人鲁棒自适应跟踪控制

针对含运动学未知参数以及动力学模型不确定的非完整轮式移动机器人轨迹跟踪问题,基于Radical Basis Function(径向基函数)神经网络,提出了一种鲁棒自适应控制器.首先,考虑移动机器人运动学参数未知的情况,提出了一种含自适应参数的运动学控制器,用以补偿参数不确定性导致的系统误差;其次,利用神经网络控制技术,对于机器人在移动中动力学模型不确定问题,提出了一种具有鲁棒性的动力学控制器,使得移动机器人可以在不知道具体动力学模型的情况下跟踪到目标轨迹;最后利用Lyapunov稳定性理论证明了整个系统的稳定性.通过数值仿真验证了所设计的控制器的可行性.     

Cartesian control of redundant robots

This article presents a Cartesian-space position/force controller for redundant robots. The proposed control structure partitions the control problem into a nonredundant position/force trajectory tracking problem and a redundant mapping problem between Cartesian control input F ? R ^m and robot actuator torque T ? R ⁿ(for redundant robots, m < n). The underdetermined nature of the F → T map is exploited so that the robot redundancy is utilized to improve the dynamic response of the robot. This dynamically optimal F → T map is implemented locally (in time) so that it is computationally efficient for on-line control; however, it is shown that the map possesses globally optimal characteristics. Additionally, it is demonstrated that the dynamically optimal F→T map can be modified so that the robot redundancy is used to simultaneously improve the dynamic response and realize any specified kinematic performance objective (e.g., manipulability maximization or obstacle avoidance). Computer simulation results are given for a four degree of freedom planar redundant robot under Cartesian control, and demonstrate that position/force trajectory tracking and effective redundancy utilization can be achieved simultaneously with the proposed controller.     

Whole-body motion planning and control of a quadruped robot for challenging terrain

Quadruped robots working in jungles, mountains or factories should be able to move through challenging scenarios. In this paper, we present a control framework for quadruped robots walking over rough terrain. The planner plans the trajectory of the robot's center of gravity by using the normalized energy stability criterion, which ensures that the robot is in the most stable state. A contact detection algorithm based on the probabilistic contact model is presented, which implements event-based state switching of the quadruped robot legs. And an on-line detection of contact force based on generalized momentum is also showed, which improves the accuracy of proprioceptive force estimation. A controller combining whole body control and virtual model control is proposed to achieve precise trajectory tracking and active compliance with environment interaction. Without any knowledge of the environment, the experiments of the quadruped robot SDUQuad-144 climbs over significant obstacles such as 38 cm high steps and 22.5 cm high stairs are designed to verify the feasibility of the proposed method.     

含驱动器动力学的移动机器人编队自适应控制

针对含有驱动器及编队动力学的多非完整移动机器人编队控制问题,基于领航者-跟随者[l-ψ]控制结构,通过反步法设计了一种将运动学控制器与驱动器输入电压控制器相结合的新型控制策略。采用径向基神经网络（RBFNN）对跟随者及领航者动力学非线性不确定部分进行在线估计,并通过自适应鲁棒控制器对神经网络建模误差进行补偿。该方法不但解决了移动机器人编队控制的参数与非参数不确定性问题,同时也确保了机器人编队在期望队形下对指定轨迹的跟踪;基于Lyapunov方法的设计过程,保证了控制系统的稳定与收敛;仿真结果表明了该方法的有效性。     

Global Output Tracking Control of Flexible Joint Robots via Factorization of the Manipulator Mass Matrix

This paper investigates the problem of global output feedback tracking control of flexible joint robots. Despite the fact that only link position and actuator position are available from measurements, the proposed controller ensures that the link position globally tracks the desired trajectory while keeping all the remaining signals bounded. The controller development uses a partial state-feedback linearization technique combined with the integrator backstepping control design method whereas a filter and an observer are utilized to remove the requirement of link and actuator velocity measurements. Partial state-feedback linearization of robot dynamics is performed by factoring the manipulator mass matrix into a quadratic form involving an integrable root matrix. The applicability of the proposed general design methodology is illustrated by an example of flexible joint planar robots. Numerical results for a two-link flexible joint planar robot are also provided.      

轮子打滑状态下全向移动机器人轨迹跟踪控制

针对全向移动机器人轨迹跟踪控制中存在未知轮子打滑干扰问题,设计自抗扰反步控制器.首先,建立存在轮子打滑扰动的全向移动机器人的运动学模型;然后,融合自抗扰控制技术与反步控制技术,设计基于全向移动机器人运动学模型的轨迹跟踪控制器,该控制器分别从纵向控制、横向控制及姿态控制上对打滑干扰进行实时估计与补偿;最后,利用Lyapunov定理分析闭环系统的稳定性并通过仿真实验验证了所提出控制算法的有效性和鲁棒性.     

Trajectory tracking control of mobile robots without using longitudinal velocity measurements

We propose a new robust trajectory tracking control scheme for wheeled mobile robots without longitudinal velocity measurements. In the proposed controller, a velocity observer is used to estimate the longitudinal velocity of a wheeled mobile robot. A wheeled mobile robot model, including motor dynamics, is used to develop the controller. The developed controller has the following useful properties. (1) The developed controller does not require any accurate knowledge of the robot parameters or the motor parameters. Even if there are uncertainties in the robot dynamics, including the motor properties, it is certain that tracking errors ultimately become uniformly bounded in a closed-loop system using the developed controller. (2) It is shown theoretically that the ultimate norms of tracking errors can easily be reduced by setting only one design parameter.