仿人机器人相似性运动轨迹跟踪控制研究

提出一种基于带观测器的条件状态反馈控制的仿人机器人相似性运动轨迹跟踪控制方法.首先,分析了7连杆双足机器人动力学模型,阐述了其运动能量方程与动力学特征方程; 其次,基于带观测器的状态反馈控制器原理,构建起三维倒立摆平衡控制模型; 最后,由线性二次型调节器确定状态反馈增益矩阵,使机器人轨迹跟踪误差最小化,以复现出较高相似度的双足步行运动效果.实验验证了该方法的有效性.     

基于线性二次型算法的轮式移动机器人轨迹跟踪控制

文章在控制输入饱和约束条件下,以非完整移动机器人的运动学模型为对象,研究了移动机器人的轨迹跟踪问题.首先在参考轨迹处对运动学模型进行线性化得到移动机器人线性时变系统,证明了其能观性和能控性,在此基础上设计了饱和约束条件的分段线性二次型控制器(Piecewise Linear QuadraticRegulator,PLQR),并基于Lyapunov方法证明了其稳定性.在MATLAB软件平台下的仿真和实验结果表明,基于PLQR的轮式移动机器人对不同初始位姿及不同的参考轨迹都有较好的跟踪效果,且能够避免控制律跳变现象,满足饱和约束条件.     

基于Lyapunov方法和快速终端滑模的轨迹跟踪控制

针对移动机器人的运动学模型,提出一种具有全局渐近稳定性的跟踪控制器。该跟踪控制器的设计分为两部分：第一部分是采用全局快速终端滑动模态的思想设计了角速度的控制律,用来渐近镇定移动机器人跟踪的前向角误差;第二部分是采用Lyapunov方法设计了线速度的控制律,用来渐近镇定移动机器人跟踪的平面坐标误差。采用Lyapunov稳定性定理,证明了移动机器人在满足这些控制律条件下,实现了对参考轨迹的全局渐近跟踪。实验结果表明移动机器人能够有效地跟踪期望轨迹,有利于在实际应用中推广。     

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

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

Weighted max-norm estimate of two-stage splitting method for solving a class of nonlinear complementarity problems

In this paper, an asymptotically stable optimal control is proposed for the trajectory tracking of a cylindrical robotic arm. The proposed controller uses the linear quadratic regulator method and its Riccati equation is considered as an adaptive function. The tracking error of the proposed controller is guaranteed to be asymptotically stable. A simulation shows the effectiveness of the proposed algorithm.     

Omni-directional mobile robot controller based on trajectory linearization

In this paper, a nonlinear controller design for an omni-directional mobile robot is presented. The robot controller consists of an outer-loop (kinematics) controller and an inner-loop (dynamics) controller, which are both designed using the Trajectory Linearization Control (TLC) method based on a nonlinear robot dynamic model. The TLC controller design combines a nonlinear dynamic inversion and a linear time-varying regulator in a novel way, thereby achieving robust stability and performance along the trajectory without interpolating controller gains. A sensor fusion method, which combines the onboard sensor and the vision system data, is employed to provide accurate and reliable robot position and orientation measurements, thereby reducing the wheel slippage induced tracking error. A time-varying command filter is employed to reshape an abrupt command trajectory for control saturation avoidance. The real-time hardware-in-the-loop (HIL) test results show that with a set of fixed controller design parameters, the TLC robot controller is able to follow a large class of 3-degrees-of-freedom (3DOF) trajectory commands accurately.     

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.      

Mu-based trajectory tracking control for a quad-rotor UAV

In this paper, the design and application of a robust mu-synthesis-based controller for quad-rotor trajectory tracking are presented. The proposed design approach guarantees robust performance over a weakly nonlinear range of operation of the quad-rotor, which is a practical range that suits various applications. The controller considers different structured and unstructured uncertainties, such as unmodeled dynamics and perturbation in the parameters. The controller also provides robustness against external disturbances such as wind gusts and wind turbulence. The proposed controller is fixed and linear; therefore, it has a very low computational cost. Moreover, the controller meets all design specifications without tuning. To validate this control strategy, the proposed approach is compared to a linear quadratic regulator (LQR) controller using a high- fidelity quad-rotor simulation environment. In addition, the experimental results presented show the validity of the proposed control strategy.     

基于运动控制和频域分析的移动机器人能耗最优轨迹规划

本文针对两轮自平衡可移动机器人, 提出了一种新的能耗最优运动轨迹规划方法.本文将轨迹规划与由轨迹跟踪控制器和机器人动力学方程组成的运动控制模型相结合, 基于期望轨迹与实际电机输入电压间的传递函数和能量在时域和频域上的对应关系, 通过频域分析的方法得到了具有明确机理表达的线性能耗模型, 并采用最小二乘线性回归法对模型参数进行辨识.对于能耗最优轨迹, 由全局路径规划得到的路径点作为局部轨迹规划的局部目标点, 通过一定的数学转换和参数求导, 可直接得到相邻两个局部目标点间的能耗最优运行轨迹和对应的运行时间.通过仿真实验证明了本文所提能耗模型的准确性和所得轨迹的能耗最优性.     

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.     

基于传感器融合技术的机器人远程控制系统设计

结合数据融合技术与无线传输技术,提出了一种基于传感器融合的机器人远程控制系统设计方法。机器人端采用FMCE毫米波雷达与摄像机进行多传感器融合,机器人端与远程PC端采用局域网进行通信,本地PC端对机器人进行远程控制时功能主要有两个,第一个是根据现场作业环境实时控制机器人移动,第二个是在PC端选择目标对象后让机器人生成行驶路径后自动跟踪目标对象,路径跟踪控制器采用的是线性二次型调节器(LQR),这种基于传感器融合的机器人远程控制系统设计方法,具有高效、智能、可靠、精确等优点,可以应用于各种需要机器人协助完成的任务中,如无人巡检、智能交通等领域。     

Global exponential tracking control of a mobile robot system via aPE condition

This paper presents the design of a differentiable, kinematic control law that achieves global asymptotic tracking. In addition, we also illustrate how the proposed kinematic controller provides global exponential tracking provided the reference trajectory satisfies a mild persistency of excitation (PE) condition. We also illustrate how the proposed kinematic controller can be slightly modified to provide for global asymptotic regulation of both the position and orientation of the mobile robot. Finally, we embed the differentiable kinematic controller inside of an adaptive controller that fosters global asymptotic tracking despite parametric uncertainty associated with the dynamic model. Experimental results are also provided to illustrate the performance of the proposed adaptive tracking controller.     

Motion control of a snake robot moving between two non-parallel planes

A control method that makes the head of a snake robot follow an arbitrary trajectory on two non-parallel planes, including coexisting sloped and flat planes, is presented. We clarify an appropriate condition of contact between the robot and planes and design a controller for the part of the robot connecting the two planes that satisfies the contact condition. Assuming that the contact condition is satisfied, we derive a simplified model of the robot and design a controller for trajectory tracking of the robot’s head. The controller uses kinematic redundancy to avoid violating the limit of the joint angle and a collision between the robot and the edge of a plane. The effectiveness of the proposed method is demonstrated in experiments using an actual robot.     

基于模型预测—中枢模式发生器的六足机器人轨迹跟踪控制

为了模仿动物卓越的运动能力和环境适应能力,提出了六足仿生机器人的轨迹跟踪控制方法。首先建立了机器人的运动学模型,接着通过转向参数将机器人的速度和角速度与中枢模式发生器（CPG）参数结合起来,设计了转换函数。然后通过转换函数将模型预测控制器和CPG网络结合起来,提出了基于CPG的模型预测控制器（MPC-CPG）,并证明了其稳定性。最后对机器人跟踪圆周轨迹和直线轨迹进行了仿真和实验。实验表明,在有初始误差的条件下,机器人在MPC-CPG控制器的作用下能够快速地消除位置误差和航向角误差,跟踪上参考轨迹。轨迹跟踪的位置误差始终保持在-0.1～0.1 m,航向角误差保持在-27?～20?。在MPC-CPG控制器的作用下,机器人不仅具有较高的轨迹跟踪精度,同时还表现出良好的运动平滑性和协调性,进一步验证了所提出的MPC-CPG控制器的有效性。     

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

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

A Stable Analytical Solution Method for Car-Like Robot Trajectory Tracking and Optimization

In this paper, the car-like robot kinematic model trajectory tracking and control problem is revisited by exploring an optimal analytical solution which guarantees the global exponential stability of the tracking error. The problem is formulated in the form of tracking error optimization in which the quadratic errors of the position, velocity, and acceleration are minimized subject to the rear-wheel car-like robot kinematic model. The input-output linearization technique is employed to transform the nonlinear problem into a linear formulation. By using the variational approach, the analytical solution is obtained, which is guaranteed to be globally exponentially stable and is also appropriate for real-time applications. The simulation results demonstrate the validity of the proposed mechanism in generating an optimal trajectory and control inputs by evaluating the proposed method in an eight-shape tracking scenario.     

基于蚁群算法的机器人系统LQR最优控制研究

针对两轮自平衡机器人线性二次最优控制器(LQR)中的权参数选择问题,提出了一种基于自适应蚁群算法的权矩阵优化参数策略.利用LQR控制器,采用自适应蚁群算法对LQR权矩阵Q的各位参数进行数字寻优,将得到的数字序列进行划分,寻找到最优参数值,从而对两轮自平衡机器人的俯仰属性进行有效的系统控制.仿真实验结果表明:采用蚁群算法优化后的控制器比人工选择参数策略有更好的控制效果,验证了方法的稳定性和有效性.     

改进的Backstepping在移动机器人轨迹跟踪中的应用

以四轮移动机器人的运动学模型为研究对象,基于BackStepping的设计思想,通过构造一种简单的中间虚拟反馈变量,同时结合Lyapunov直接法设计了一种移动机器人轨迹跟踪控制律,并证明了系统在设计控制律下的全局稳定性;但控制律中含有未知参数,不同的参考轨迹都要重新调节才能达到良好的跟踪效果,因此利用极点配置的方法对这些参数进行了优化整定,从而保证了控制器的自适应性;文中以直线和圆为参考轨迹做了仿真实验;仿真结果表明该算法具有快速,精确,全局稳定的良好特性。     

基于IMU/UWB的两轮自平衡车轨迹跟踪控制器设计与实现

两轮自平衡车的精确轨迹跟踪技术是实现其自主运动控制的基础.为此,采用拉格朗日法建立两轮自平衡车的动力学模型,并据此提出基于非奇异终端滑模(NTSM)和线性二次型调节器(LQR)的两轮自平衡车轨迹跟踪控制器.在Matlab/Simulink环境下,对所设计的轨迹跟踪控制器进行性能仿真,结果显示,两轮自平衡车能够精确跟踪所给定的参考轨迹,初步表明了所提出轨迹跟踪控制器的有效性.在此基础上,使用STM32F103C8T6单片机,并结合惯性测量组件(IMU)和超宽带(UWB)定位技术对所设计的轨迹跟踪控制器进行硬件实现.实验结果表明,两轮自平衡车能够对给定的参考轨迹进行良好跟踪,横坐标偏差小于0.2m,纵坐标偏差小于0.2m,转向角偏差小于0.07rad,车身倾角除了初始时的波动外均小于0.05rad.     

SCARA机器人内模控制方法

为了使SCARA机器人在外界干扰和模型不精确的情况下具有优良的轨迹跟踪性能,提出一种基于内模控制原理设计SCARA机器人控制器的方法。采用拉格朗日方法获得SCARA机器人动力学模型,将其作为内模控制的估计模型;选择内模滤波器[f(S)]设计内模控制器[Q(S),]使其满足稳态误差为零的条件,通过推导得出不同输入信号下的SCARA机器人控制律。通过仿真,将其与自适应模糊滑模控制方法进行对比分析,结果表明所提出的方法轨迹跟踪精度高,抗干扰能力强,控制器参数调节简单。