Nonlinear coupling tracking control for underactuated construction lifting robots with load hoisting/lowering under initial input saturations

Underactuated construction lifting robots, which have been widely concerned by erudite researchers, always contain load hoisting/lowering motion. When the cable length is utilized as a variable, construction lifting robots produce violent load swing, which affects the construction safety undoubtedly and brings great challenges to the development of the controller. Moreover, most existing controllers may not take into account issues, such as initial input saturations and poor ability to suppress load swing, and they may utilize linearization or approximation. Inspired by these phenomena, a nonlinear coupling tracking controller for underactuated construction lifting robots with load hoisting/lowering under initial input saturations is proposed. With reference to expected trajectories to ensure the smooth operation of the construction lifting robot system, the initial input saturations are considered to make the trolley and cable start stably, respectively; a coupling signal, which contains actuated variables and underactuated variables, is constructed to improve the transient control performance of construction lifting robots. Combined with theoretical derivation, simulation, and experimental verification, the proposed controller achieves superior control performance, which ensures the accurate positionings of the system, and suppresses and eliminates the load swing effectively, so as to ensure the safe construction; the proposed controller admits outstanding robustness with respect to the changes of system parameters and the adverse effects of external disturbances. The proposed controller provides a novel antiswing strategy for construction lifting robots with load hoisting/lowering, which possesses excellent practical significance.     

载人机器人平顺轨迹规划及自抗扰跟踪控制方法

针对公共环境载人机器人的安全性和乘载舒适性需求,提出一种机器人平顺轨迹规划及改进自抗扰跟踪控制方法,重点解决避险和平稳运动两种工况下机器人轨迹扰动问题;首先,设计了基于障碍物密度及其危险性的在线速度空间优化方法,获得符合安全和舒适度要求的轨迹;其次,采用扩张状态观测器观测机器人轨迹跟踪过程中内外扰动并实施补偿;再次,引入非线性反馈控制律自动调整反馈增益,减少超调并提高自抗扰控制器稳定性;对不同场景数值模型仿真表明,提出的轨迹规划方法可以满足机器人作业的安全性、舒适性需求;改进自抗扰跟踪控制器效果明显优于传统ADRC和自适应PID,具有较强的抗干扰能力和较快速的跟踪性能.     

未知环境下基于虚拟角速度跟踪的避障策略EI北大核心CSCD

当智能体自主执行任务时,局部障碍物可测的未知环境增加了局部极值和执行器饱和发生的概率.对此,本文提出了虚拟角速度跟踪的避障策略.首先,基于简易障碍物的几何模型构造虚拟的避障引导角,并利用李雅普诺夫方法设计角速度控制律,通过受限制的虚拟角速度跟踪来实现避障控制.然后,引入方位因子改进距离型权值分配器,强化轨迹附近障碍物的影响以降低局部极值发生的概率.最后,对于不完全可测的复杂障碍物,根据历史探测信息建立以边界点为中心的简易障碍物模型.仿真结果表明,该策略能够避让低速动态障碍物及U型复杂障碍物,并且可实现抗饱和控制.     

Control of snake robots with switching constraints: trajectory tracking with moving obstacle

We propose control of a snake robot that can switch lifting parts dynamically according to kinematics. Snakes lift parts of their body and dynamically switch lifting parts during locomotion: e.g. sinus-lifting and sidewinding motions. These characteristic types of snake locomotion are used for rapid and efficient movement across a sandy surface. However, optimal motion of a robot would not necessarily be the same as that of a real snake as the features of a robot’s body are different from those of a real snake. We derived a mathematical model and designed a controller for the three-dimensional motion of a snake robot on a two-dimensional plane. Our aim was to accomplish effective locomotion by selecting parts of the body to be lifted and parts to remain in contact with the ground. We derived the kinematic model with switching constraints by introducing a discrete mode number. Next, we proposed a control strategy for trajectory tracking with switching constraints to decrease cost function, and to satisfy the conditions of static stability. In this paper, we introduced a cost function related to avoidance of the singularity and the moving obstacle. Simulations and experiments demonstrated the effectiveness of the proposed controller and switching constraints.     

非平衡负载下轮式移动机器人的抗扰PID控制

在非平衡负载条件下,轮式移动机器人(WMR)的前进、转向速度耦合,影响着轨迹跟踪和避障等运动控制性能.为此,本文提出了一种基于抗扰PID(DR–PID)控制器的WMR速度调节主动抗扰(ADR)控制策略.首先,建立WMR的速度耦合模型,引入解耦矩阵减小静态耦合作用;然后,基于一类改进干扰观测器(DOB)控制方法,设计一种具有ADR能力的PID控制器,即DR–PID,用于WMR的速度分散调节.进一步,考虑高频增益不匹配/不确定性,分析闭环系统稳定性条件.所得结论揭示了PID控制器的抗扰机理;最后,在不平衡负载条件下开展WMR运动控制实验研究,实验结果验证了所提方法的有效性.     

基于速度空间的移动机器人同时避障和轨迹跟踪方法

针对有障碍物环境下非完整轮式 移动机器人的轨迹跟踪问题,提出一种基于速度空间的同时避障和轨迹跟踪方法(VSTTM).首先,根据机器人 的动力学特性构建速度空间,得到由速度元组构成的控制集;然后,构造目标函数并对各控制量进行 评价,其中跟踪误差评价函数评估跟踪效果,碰撞检测函数检测是否发生碰撞,终端状态惩罚项保证 算法的稳定性;最后,通过优化过程找到最优的无碰控制量.仿真结果表明了所提出方法的有效性.     

An obstacle avoidance algorithm for robot manipulators based on decision-making force

Obstacle avoidance is a significant skill not only for mobile robots but also for robot manipulators working in unstructured environments. Various algorithms have been proposed to solve off-line planning and on-line adaption problems. However, it is still not able to ensure safety and flexibility in complex scenarios. In this paper, a novel obstacle avoidance algorithm is proposed to improve the robustness and flexibility. The method contains three components: A closed-loop control system is used to filter the preplanned trajectory and ensure the smoothness and stability of the robot motion; the dynamic repulsion field is adopted to fulfill the robot with primitive obstacle avoidance capability; to mimic human’s complex obstacle avoidance behavior and instant decision-making mechanism, a parametrized decision-making force is introduced to optimize all the feasible motions. The algorithms were implemented in planar and spatial robot manipulators. The comparative results show the robot can not only track the task trajectory smoothly but also avoid obstacles in different configurations.     

Formation tracking of multi-vehicle systems in unknown environments using a multi-region control scheme

In this paper, a multi-region control scheme is proposed for a formation of nonholonomic vehicles to track a reference trajectory while avoiding collisions and preserving network connectivity in unknown environments. The proposed control scheme defines three regions, safe region, dangerous region and transition region. In different regions, priority is given to different control objectives. In safe region where trajectory tracking holds the priority, the proposed control scheme guarantees bounded tracking of the reference trajectory for each vehicle. In dangerous region where avoidance control is the main objective, a new bounded potential function is designed to characterise constraints of obstacle and inter-vehicle collision avoidance as well as connectivity maintenance. By introducing a series of transition functions, smooth switching between trajectory tracking and avoidance control is achieved in transition region. It has been proved that each vehicle can track its reference trajectory while satisfying the constraints simultaneously with a bounded controller which means that the proposed control scheme satisfies input constraints by properly tuning parameters. Simulation results demonstrate the effectiveness of the proposed method.     

Obstacle avoidance for redundant robots using configuration control

The article presents a new and simple solution to the obstacle avoidance problem for redundant robots. In the proposed approach, called configuration control, the redundancy is utilized to configure the robot so as to satisfy a set of kinematic inequality constraints representing obstacle avoidance, while the end-effector is tracking a desired trajectory. The robot control scheme is very simple, and uses on-line adaptation to eliminate the need for the complex dynamic model and parameter values of the robot. Several simulation results for a four-link planar robot are presented to illustrate the versatility of the approach. These include reaching around a stationary obstacle, simultaneous avoidance of two obstacles, robot reconfiguration to avoid a moving obstacle, and avoidance of rectangular obstacles. The simplicity and computational efficiency of the proposed scheme allows on-line implementation with a high sampling rate for real-time obstacle avoidance in a dynamically varying environment.     

基于BP神经网络的移动机器人避障设计及仿真

为了解决移动机器人在复杂环境中如何高效精确地躲避障碍物的问题,提出了一种基于BP神经网络的避障方法。建立了机器人的避障运动模型并设计了神经网络避障控制系统;分析了机器人在运动过程中与障碍物的位置关系,使用超声波传感器采集距离信息,进行BP神经网络输入、输出训练并采用Matlab工具进行仿真试验。结果表明,该方法可以高效精确地实现移动机器人的自主避障,运行相对稳定、轨迹连续平滑,达到了较为理想的避障效果。验证了方法的可行性和有效性,为移动机器人自主避障提供了一种新的控制方法。     

基于RFID技术的四旋翼无人机轨迹跟踪控制系统设计

为促进四旋翼无人机的飞行自主性,增强无人监管情况下飞行器主机所具备的避障行进能力,设计基于RFID技术的四旋翼无人机轨迹跟踪控制系统;采用RFID标签识别技术,调制处理既定控制信号,利用标签识别协议,连接微型四旋翼轨迹控制器与内环姿态控制器,通过数据通信链路,提取轨迹跟踪控制所需的传输电子量,完成轨迹跟踪控制系统硬件设计;利用动力系统中的参数辨识策略,确定与轨迹姿态控制相关的物理规律标注,实现四旋翼无人机轨迹跟踪控制;实验结果表明,与机器视觉型控制系统相比,基于RFID技术的控制系统的SSI避障行进指标数值相对较高,全局最大值达到了 79％,四旋翼无人机滚转角平均值为85°,能够有效抑制四旋翼无人机滚转角的数值上升趋势,增强无人监管情况下飞行器主机避障行进能力.     

A model predictive obstacle avoidance method based on dynamic motion primitives and a Kalman filter

A dynamic motion primitive (DMP) is a robust framework that generates obstacle avoidance trajectories by introducing perturbative terms. The perturbative term is usually constructed with an artificial potential field (APF) method. Dynamic obstacle avoidance is rarely considered with this approach; furthermore, even when dynamic obstacles are considered, only the velocity and position information of the current state are incorporated into the obstacle avoidance framework. However, if the position of an obstacle changes suddenly, a robot may be placed in a dangerous position close to the obstacle, resulting in large obstacle avoidance accelerations, sharp trajectories, or even obstacle avoidance failure. Therefore, we present a model predictive obstacle avoidance method based on dynamic motion primitives and a Kalman filter. This method has three main components: Dynamic motion primitives are used to generate the desired trajectory and introduce perturbations to achieve obstacle avoidance; the Kalman filter method is adopted to estimate the future positions of the obstacles; and model predictive control is employed to optimize the repulsive force generated by the APF while minimizing the defined cost function, thus guaranteeing the safety and flexibility of the method. We validate the presented method with 2D and 3D obstacle avoidance simulations. The method is also verified with a real robot: the-Kinova MOVO. The simulation and experimental results show that the proposed method not only avoids dynamic obstacles but also tracks the desired trajectory more smoothly and precisely.     

带有未知参数和有界干扰的移动机器人轨迹跟踪控

针对模型参数未知和存在有界干扰的非完整移动机器人的轨迹跟踪控制问题,本文提出了一种鲁棒自适应轨迹跟踪控制器方法.非完整移动机器人的控制难点在于它的运动学系统是欠驱动的.针对这一难点,本文利用横截函数的思想,引入新的辅助控制器,使得非完整移动机器人系统不再是一个欠驱动系统,缩减了控制器设计的难度,进而利用非线性自适应算法和参数映射方法构造李雅谱诺夫函数.通过李雅普诺夫方法设计控制器和参数自适应器,从而使得非完整移动机器人的跟随误差任意小,即可以任意小的误差来跟随任意给定的参考轨迹.仿真结果证明了方法的有效性.     

Decoupling control for spatial six-degree-of-freedom electro-hydraulic parallel robot

This paper presents a decoupling controller equipped with cross-coupling pre-compensation for an electro-hydraulic parallel robot, in order to weaken system dynamic coupling effects usually ignored on the design of advanced controllers and improve system control performance. The mathematical model of the electro-hydraulic parallel robot is built using the Kane method and a hydromechanics approach, and the kinematical model is established with a closed-form solution and the Newton-Raphson method. The feedback linearization theory is applied to reduce coupling effects stemmed from system dynamics of the parallel robot via incorporating force-velocity control with cross-coupling pre-compensations. The control performance involving stability, accuracy, and robustness of the proposed controller for spatial 6-DOF parallel robot is analyzed in theory and experiment. The experimental results illustrate that the proposed controller can highly improve the control performance by weakening system dynamic coupling effects of the electro-hydraulic parallel robot, especially for trajectory tracking performance.     

Path tracking control of Lagrange systems with obstacle avoidance

This paper addresses a path tracking problem with obstacle avoidance for Lagrange systems. The proposed method is based on field potential methods in combination with navigation functions for obstacle avoidance. First, it is shown that a simple combination of the navigation function with the conventional path tracking controller does not work. Therefore, in order to cope with this problem, a new feedback law is proposed for a path parameter which characterizes the reference path. It is proved that the proposed controller achieves both path following and collision avoidance. Moreover, since the method adopts bounded navigation functions, the proposed controllers generate bounded input signals even when target systems approach obstacles. Finally, an experimental evaluation is performed with a two-link manipulator to illustrate the effectiveness of the proposed method.     

Visual tracking control for an uncalibrated robot system with unknown camera parameters

The robust trajectory tracking problem for an eye-in-hand system is addressed in this paper. A novel visual feedback control model is proposed. It considers not only the uncertainties and disturbances in the robot model, but also the unknown camera parameters. By using sliding mode control, filter method and adaptive technique, the controller is designed such that the robot can track the desired trajectory well by using information provided by camera. Finally, stability and robustness are rigorously proved by using Lyapunov method. Computer simulations are presented to show the effectiveness of the proposed visual feedback controller.     

Formation control of mobile robots with obstacle avoidance based on GOACM using onboard sensors

This paper deals with the problem of formation control for nonholonomic mobile robots under a cluttered environment. When the obstacles are not detected, the follower robot calculates its waypoint to track, based on the leader robot’s state. The proposed geometric obstacle avoidance control method (GOACM) guarantees that the robot avoids the static and dynamic obstacles using onboard sensors. Due to the difficulty for the robot to simultaneously get overall safe boundary of an obstacle in practice, a safe line, which is perpendicular to the obstacle surface, is used instead of the safe boundary. Since GOACM is executed to find a safe waypoint for the robot, GOACM can effectively cooperate with the formation control method. Moreover, the adaptive controllers guarantee that the trajectory and velocity tracking errors converge to zero with the consideration of the parametric uncertainties of both kinematic and dynamic models. Simulation and experiment results present that the robots effectively form and maintain formation avoiding the obstacles.     

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

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

基于轨迹跟踪车式移动机器人编队控制

针对车式移动机器人的运动学模型特点, 提出一种基于轨迹跟踪多机器人编队控制方法. 首先利用编队结构参数确定队形, 根据编队轨迹和相关参数生成虚拟机器人, 把编队控制转化为跟随机器人对虚拟机器人的轨迹跟踪; 然后运用反步法构造车式移动机器人轨迹跟踪系统的Lyapunov 函数, 通过使该函数负定, 得到跟随机器人的轨迹跟踪控制器; 最后在Microsoft robotics developer studio 4 (MRDS4) 中搭建3D 仿真平台, 设计了3 组实验, 所得结果表明了所提出方法的有效性.     

基于CPLD控制模块的智能机器人控制系统研究

为提高智能机器人环境感知能力和避障能力,降低智能机器人运行中碰撞障碍物的概率,设计了一种基于CPLD控制模块的智能机器人控制系统。以CPLD控制器为核心,调整A/D模拟采集接口模块信号的连接形式,并设置与PWM寄存器相关的连接参数；给出了主机智能程序的决策流程,并适时调整PWM寄存器的整流参数,提升控制指令执行向量的匹配精度,以实现对智能机器人运动轨迹的精确控制。与传统机器人控制系统相比,基于CPLD控制模块的智能机器人能够更准确地感知外界环境的变化,精确规避障碍物。