Maneuverability modeling and trajectory tracking for fish robot

This study develops a 6-DOF mathematical model for a robotic fish that considers surge, sway, heave, roll, pitch, and yaw. The model considers the conditions of a fish swimming in ocean current perturbations similar to the ocean current perturbations of the slender-body autonomous underwater vehicles. For swimming and turning behaviors, a nonlinear, dynamic, carangiform locomotion model is derived by using a planar four-link model. A 2-DOF barycenter mechanism is proposed to provide body stabilization and to serve as an actuating device for active control design. A barycenter control scheme is developed to change the center of gravity of the robot fish body by moving balancing masses along two axes. The projected torque on x and y axes propel pitch and roll angles to the desired settings. A Stabilizing controller, fish-tail mechanism, rigid body dynamics, and kinematics are incorporated to enable the fish robot to move in three dimensional space. Simulation results have demonstrated maneuverability and control system performance of the developed controller which is proposed to conduct path tracking of the robot fish as it swims under current perturbations.     

Active disturbance rejection based trajectory linearization control for hypersonic reentry vehicle with bounded uncertainties

This paper investigates a novel compound control scheme combined with the advantages of trajectory linearization control (TLC) and alternative active disturbance rejection control (ADRC) for hypersonic reentry vehicle (HRV) attitude tracking system with bounded uncertainties. Firstly, in order to overcome actuator saturation problem, nonlinear tracking differentiator (TD) is applied in the attitude loop to achieve fewer control consumption. Then, linear extended state observers (LESO) are constructed to estimate the uncertainties acting on the LTV system in the attitude and angular rate loop. In addition, feedback linearization (FL) based controllers are designed using estimates of uncertainties generated by LESO in each loop, which enable the tracking error for closed-loop system in the presence of large uncertainties to converge to the residual set of the origin asymptotically. Finally, the compound controllers are derived by integrating with the nominal controller for open-loop nonlinear system and FL based controller. Also, comparisons and simulation results are presented to illustrate the effectiveness of the control strategy.     

Multiple object semilinear motion planning

We present a method based on extended linear real quantifier elimination for multiple object semilinear motion planning, i.e. finding collision-free trajectories for several robots in a time dependent environment. For practical applicability the method is limited to polygonal objects and linear trajectories. It can, however, deal with situations involving even non-convex objects.     

自由飞行轨道解析解的中间轨道方法

本文给出了一组不仅能用于卫星轨道计算，同时也能用于导弹自由飞行轨道的中间轨道计算公式。引组公式的解与二体问题解有很好的可比性。由于导弹轨道与卫星轨道有很大不同，故计算中的各使用常数的取值范围也有很大不同。     

Theoretical Investigation of Time Suboptimal Control of Industrial Manipulators Along Specified Paths

A method for the time suboptimal control of an industrial manipulator from an initial position and orientation to a final position and orientation as it moves along a specified path is proposed. Nonlinear system equations that describe the manipulator motion are linearized at each time step along the path. A method which gives the control inputs (joint angular velocities) for time suboptimal control of the manipulator is developed. In the formulation, joint angular velocity and acceleration limitations are also taken into consideration. A six degree of freedom elbow type manipulator is used in numerical examples to verify the method developed.     

Planning collision-free trajectories in time-varying environments: a two-level hierarchy

We propose a two-level hierarchy for planning collision-free trajectories in time varying environments. Global geometric algorithms for trajectory planning are used in conjunction with a local avoidance strategy. Simulations have been developed for a mobile robot in the plane among stationary and moving obstacles. Essentially, the robot has a global geometric planner that provides a coarse global trajectory (the path and velocity along it), which may be locally modified by the low-level local avoidance module if local sensors detect any obstacles in the vicinity of the robot. This hierarchy makes effective use of the complementary aspects of the global trajectory planning approaches and the local obstacle avoidance approaches.     

Development and implementation of a NURBS curve motion interpolator

This paper deals with the issues of development and implementation of a real-time NURBS interpolator for a six-axis robot. Using an open-architecture controller system as a testbed, a real-time NURBS curve interpolator was developed, implemented and tested. Sample runs were conducted with the resulting trajectories measured in real-time during robot motion. The resulting trajectories are analyzed, discussed and compared with those from a commonly used point-to-point approximation technique. The real-time NURBS curve interpolator's feasibility, advantages and related issues are also discussed.     

An iterative linear quadratic regulator based trajectory tracking controller for wheeled mobile robot

We present an iterative linear quadratic regulator(ILQR) method for trajectory tracking control of a wheeled mobile robot system.The proposed scheme involves a kinematic model linearization technique,a global trajectory generation algorithm,and trajectory tracking controller design.A lattice planner,which searches over a 3D(x,y,θ) configuration space,is adopted to generate the global trajectory.The ILQR method is used to design a local trajectory tracking controller.The effectiveness of the proposed method is demonstrated in simulation and experiment with a significantly asymmetric differential drive robot.The performance of the local controller is analyzed and compared with that of the existing linear quadratic regulator(LQR) method.According to the experiments,the new controller improves the control sequences(v,ω) iteratively and produces slightly better results.Specifically,two trajectories,’S’ and ’8’ courses,are followed with sufficient accuracy using the proposed controller.     

基于改进遗传算法的多脉冲交会轨道优化研究

最优空间多脉冲轨道交会是一个复杂的非线性系统。由于结构复杂,存在非线性特性,影响系统的快速性和实时性。建立最优空间多脉冲轨道交会模型,传统遗传算法不能满足要求,因此提出了在自适应遗传算法的基础上引入多位变异的多变异位自适应遗传算法,对空间多脉冲交会轨道优化进行了求解。多变异位自适应遗传算法增加了种群的多样性,可避免算法的早熟收敛现象。仿真结果表明,利用多位变异自适应遗传算法求解空间多脉冲交会轨道优化效果好,避免了早期收敛,提高了全局寻优能力,为多脉冲交会轨道优化提供了较好的方法。     

基于虚拟样机的轮式起重机吊装安全性研究

研究起重机吊装轨迹优化的问题,系统缺少对吊装轨迹安全因素的控制。为确保吊装作业安全顺利,提出采用虚拟样机仿真技术检验起重机吊装过程。首先推导了三自由度起重机的正逆运动学模型及起重机的雅可比矩阵,得到起重机各关节的位置及速度对起重臂末端位置及速度之间的映射关系,运用五次多项式插值函数对起重机的吊装过程做轨迹规划。根据吊装过程规划模型,在ADAMS软件上进行仿真,仿真结果验证了吊装过程的安全性和定位的准确性。