Safe Motion Planning and Control Framework for Automated Vehicles with Zonotopic TRMPC

Model mismatches can cause multi-dimensional uncertainties for the receding horizon control strategies of automated vehicles(AVs).The uncertainties may lead to potentially hazardous behaviors when the AV tracks ideal trajectories that are individually optimized by the AV's planning layer.To address this issue,this study proposes a safe motion planning and control(SMPAC)framework for AVs.For the control layer,a dynamic model including multi-dimensional uncertainties is established.A zonotopic tube-based robust model predictive control scheme is proposed to constrain the uncertain system in a bounded minimum robust positive invariant set.A flexible tube with varying cross-sections is constructed to reduce the controller conservatism.For the planning layer,a concept of safety sets,representing the geometric boundaries of the ego vehicle and obstacles under uncertainties,is proposed.The safety sets provide the basis for the subsequent evaluation and ranking of the generated trajectories.An efficient collision avoidance algorithm decides the desired trajectory through the intersection detection of the safety sets between the ego vehicle and obstacles.A numerical simulation and hardware-in-the-loop experiment validate the effectiveness and real-time performance of the SMPAC.The result of two driving scenarios indicates that the SMPAC can guarantee the safety of automated driving under multi-dimensional uncertainties.

Two-Stage Planning of Distributed Power Supply and Energy Storage Capacity Considering Hierarchical Partition Control of Distribution Network with Source-Load-Storage

Aiming at the consumption problems caused by the high proportion of renewable energy being connected to the distribution network,it also aims to improve the power supply reliability of the power system and reduce the operating costs of the power system.This paper proposes a two-stage planning method for distributed generation and energy storage systems that considers the hierarchical partitioning of source-storage-load.Firstly,an electrical distance structural index that comprehensively considers active power output and reactive power output is proposed to divide the distributed generation voltage regulation domain and determine the access location and number of distributed power sources.Secondly,a two-stage planning is carried out based on the zoning results.In the phase 1 distribution network-zoning optimization layer,the network loss is minimized so that the node voltage in the area does not exceed the limit,and the distributed generation configuration results are initially determined;in phase 2,the partition-node optimization layer is planned with the goal of economic optimization,and the distance-based improved ant lion algorithm is used to solve the problem to obtain the optimal distributed generation and energy storage systemconfiguration.Finally,the IEEE33 node systemwas used for simulation.The results showed that the voltage quality was significantly improved after optimization,and the overall revenue increased by about 20.6%,verifying the effectiveness of the two-stage planning.

Evolutionary Decision-Making and Planning for Autonomous Driving Based on Safe and Rational Exploration and Exploitation

Decision-making and motion planning are extremely important in autonomous driving to ensure safe driving in a real-world environment.This study proposes an online evolutionary decision-making and motion planning framework for autonomous driving based on a hybrid data-and model-driven method.First,a data-driven decision-making module based on deep reinforcement learning(DRL)is developed to pursue a rational driving performance as much as possible.Then,model predictive control(MPC)is employed to execute both longitudinal and lateral motion planning tasks.Multiple constraints are defined according to the vehicle’s physical limit to meet the driving task requirements.Finally,two principles of safety and rationality for the self-evolution of autonomous driving are proposed.A motion envelope is established and embedded into a rational exploration and exploitation scheme,which filters out unreasonable experiences by masking unsafe actions so as to collect high-quality training data for the DRL agent.Experiments with a high-fidelity vehicle model and MATLAB/Simulink co-simulation environment are conducted,and the results show that the proposed online-evolution framework is able to generate safer,more rational,and more efficient driving action in a real-world environment.

MPC-based Motion Planning and Control Enables Smarter and Safer Autonomous Marine Vehicles:Perspectives and a Tutorial Survey

Autonomous marine vehicles(AMVs)have received considerable attention in the past few decades,mainly because they play essential roles in broad marine applications such as environmental monitoring and resource exploration.Recent advances in the field of communication technologies,perception capability,computational power and advanced optimization algorithms have stimulated new interest in the development of AMVs.In order to deploy the constrained AMVs in the complex dynamic maritime environment,it is crucial to enhance the guidance and control capabilities through effective and practical planning,and control algorithms.Model predictive control(MPC)has been exceptionally successful in different fields due to its ability to systematically handle constraints while optimizing control performance.This paper aims to provide a review of recent progress in the context of motion planning and control for AMVs from the perceptive of MPC.Finally,future research trends and directions in this substantial research area of AMVs are highlighted.

Leader trajectory planning method considering constraints of formation controller

To ensure safe flight of multiple fixed-wing unmanned aerial vehicles(UAVs)formation,considering trajectory planning and formation control together,a leader trajectory planning method based on the sparse A*algorithm is introduced.Firstly,a formation controller based on prescribed performance theory is designed to control the transient and steady formation configuration,as well as the formation forming time,which not only can form the designated formation configuration but also can guarantee collision avoidance and terrain avoidance theoretically.Next,considering the constraints caused by formation controller on trajectory planning such as the safe distance,turn angle and step length,as well as the constraint of formation shape,a leader trajectory planning method based on sparse A^(*)algorithm is proposed.Simulation results show that the UAV formation can arrive at the destination safely with a short trajectory no matter keeping the formation or encountering formation transformation.

Self-adapting control parameters modifieddifferential evolution for trajectoryplanning of manipulators

Control parameters of original differential evolution （DE） are kept fixed throughout the entire evolutionary process. However, it is not an easy task to properly set control parameters in DE for different optiinization problems. According to the relative position of two different individual vectors selected to generate a difference vector in the searching place, a self-adapting strategy for the scale factor F of the difference vector is proposed. In terms of the convergence status of the target vector in the current population, a self-adapting crossover probability constant CR strategy is proposed. Therefore, good target vectors have a lower CFI while worse target vectors have a large CFI. At the same time, the mutation operator is modified to improve the convergence speed. The performance of these proposed approaches are studied with the use of some benchmark problems and applied to the trajectory planning of a three-joint redundant manipulator. Finally, the experiment results show that the proposed approaches can greatly improve robustness and convergence speed.

Tracking Control for a Cushion Robot Based on Fuzzy Path Planning With Safe Angular Velocity

This study proposes a new nonlinear tracking control method with safe angular velocity constraints for a cushion robot. A fuzzy path planning algorithm is investigated and a realtime desired motion path of obstacle avoidance is obtained. The angular velocity is constrained by the controller, so the planned path guarantees the safety of users. According to Lyapunov theory, the controller is designed to maintain stability in terms of solutions of linear matrix inequalities and the controller's performance with safe angular velocity constraints is derived.The simulation and experiment results confirm the effectiveness of the proposed method and verify that the angular velocity of the cushion robot provided safe motion with obstacle avoidance.

Planning and Control of COP-Switch-Based Planar Biped Walking

Efficient walking is one of the main goals of researches on biped robots. A feasible way is to translate the understanding from human walking into robot walking, for example, an artificial control approach on a human like walking structure. In this paper, a walking pattern based on Center of Pressure （COP） switched and modeled after human walking is introduced firstly. Then, a parameterization method for the proposed walking gait is presented. In view of the complication, a multi-space planning method which divides the whole planning task into three sub-spaces, including simplified model space, work space and joint space, is proposed. Furthermore, a finite-state-based control method is also developed to implement the proposed walking pattern. The state switches of this method are driven by sensor events. For convincing verification, a 2D simulation system with a 9-1ink planar biped robot is developed. The simulation results exhibit an efficient walking gait.

Local Path Planning and Tracking Control of Vehicle Collision Avoidance System

Automotive collision avoidance technology can effectively avoid the accidents caused by dangerous traffic conditions or driver's manipulation errors.Moreover,it can promote the development of autonomous driving for intelligent vehicle in intelligent transportation.We present a collision avoidance system,which is composed of an evasive trajectory planner and a path following controller.Considering the stability of the vehicle in the conflict-free process,the evasive trajectory planner is designed by polynomial parametric method and optimized by genetic algorithm.The path following controller is proposed to make the car drive along the designed path by controlling the vehicle's lateral movement.Simulation results show that the vehicle with the proposed controller has good stability in the collision process,and it can ensure the vehicle driving in accordance with the planned trajectory at different speeds.The research results can provide a certain basis for the research and development of automotive collision avoidance technology.

Motion Planning Based Coordinated Control for Hydraulic Excavators

Hydraulic excavator is one type of the most widely applied construction equipment for various applications mainly because of its versatility and mobility. Among the tasks performed by a hydraulic excavator, repeatable level digging or flat surface finishing may take a large percentage. Using automated functions to perform such repeatable and tedious jobs will not only greatly increase the overall productivity but more importantly also improve the operation safety. For the purpose of investigating the technology without loss of generality, this research is conducted to create a coordinate control method for the boom, arm and bucket cylinders on a hydraulic excavator to perform accurate and effective works. On the basis of the kinematic analysis of the excavator linkage system, the tip trajectory of the end-effector can be determined in terms of three hydraulic cylinders coordinated motion with a visualized method. The coordination of those hydraulic cylinders is realized by controlling three electro-hydraulic proportional valves coordinately. Therefore, the complex control algorithm of a hydraulic excavator can be simplified into coordinated motion control of three individual systems. This coordinate control algorithm was validated on a wheeled hydraulic excavator, and the validation results indicated that this developed control method could satisfactorily accomplish the auto-digging function for level digging or flat surface finishing.

Post-Impact Motion Planning and Tracking Control for Autonomous Vehicles

There is an increasing awareness of the need to reduce traffic accidents and fatality due to vehicle collision.Post-impact hazards can be more serious as the driver may fail to maintain effective control after collisions.To avoid subsequent crash events and to stabilize the vehicle,this paper proposes a post-impact motion planning and stability control method for autonomous vehicles.An enabling motion planning method is proposed for post-impact situations by combining the polynomial curve and artificial potential field while considering obstacle avoidance.A hierarchical controller that consists of an upper and a lower controller is then developed to track the planned motion.In the upper controller,a time-varying linear quadratic regulator is presented to calculate the desired generalized forces.In the lower controller,a nonlinear-optimization-based torque allocation algorithm is proposed to optimally coordinate the actuators to realize the desired generalized forces.The proposed scheme is verified under comprehensive driving scenarios through hardware-in-loop tests.

Energy-Optimal Braking Control Using a Double-Layer Scheme for Trajectory Planning and Tracking of Connected Electric Vehicles

Most researches focus on the regenerative braking system design in vehicle components control and braking torque distribution,few combine the connected vehicle technologies into braking velocity planning.If the braking intention is accessed by the vehicle-to-everything communication,the electric vehicles(EVs)could plan the braking velocity for recovering more vehicle kinetic energy.Therefore,this paper presents an energy-optimal braking strategy(EOBS)to improve the energy efficiency of EVs with the consideration of shared braking intention.First,a double-layer control scheme is formulated.In the upper-layer,an energy-optimal braking problem with accessed braking intention is formulated and solved by the distance-based dynamic programming algorithm,which could derive the energy-optimal braking trajectory.In the lower-layer,the nonlinear time-varying vehicle longitudinal dynamics is transformed to the linear time-varying system,then an efficient model predictive controller is designed and solved by quadratic programming algorithm to track the original energy-optimal braking trajectory while ensuring braking comfort and safety.Several simulations are conducted by jointing MATLAB and CarSim,the results demonstrated the proposed EOBS achieves prominent regeneration energy improvement than the regular constant deceleration braking strategy.Finally,the energy-optimal braking mechanism of EVs is investigated based on the analysis of braking deceleration,battery charging power,and motor efficiency,which could be a guide to real-time control.

Locomotion Optimization and Manipulation Planning of a Tetrahedron-Based Mobile Mechanism with Binary Control

Locomotion and manipulation optimization is essential for the performance of tetrahedron-based mobile mechanism. Most of current optimization methods are constrained to the continuous actuated system with limited degree of freedom(DOF), which is infeasible to the optimization of binary control multi-DOF system. A novel optimization method using for the locomotion and manipulation of an 18 DOFs tetrahedron-based mechanism called 5-TET is proposed. The optimization objective is to realize the required locomotion by executing the least number of struts.Binary control strategy is adopted, and forward kinematic and tipping dynamic analyses are performed, respectively.Based on a developed genetic algorithm(GA), the optimal number of alternative struts between two adjacent steps is obtained as 5. Finally, a potential manipulation function is proposed, and the energy consumption comparison between optimal 5-TET and the traditional wheeled robot is carried out. The presented locomotion optimization and manipulation planning enrich the research of tetrahedron-based mechanisms and provide the instruction to the successive locomotion and operation planning of multi-DOF mechanisms.

Optimal control based coordinated taxiing path planning and tracking for multiple carrier aircraft on flight deck

Coordinated taxiing planning for multiple aircraft on flight deck is of vital importance which can dramatically improve the dispatching efficiency.In this paper,first,the coordinated taxiing path planning problem is transformed into a centralized optimal control problem where collision-free conditions and mechanical limits are considered.Since the formulated optimal control problem is of large state space and highly nonlinear,an efficient hierarchical initialization technique based on the Dubins-curve method is proposed.Then,a model predictive controller is designed to track the obtained reference trajectory in the presence of initial state error and external disturbances.Numerical experiments demonstrate that the proposed“offline planningþonline tracking”framework can achieve efficient and robust coordinated taxiing planning and tracking even in the presence of initial state error and continuous external disturbances.

UAV penetration mission path planning based on improved holonic particle swarm optimization

To meet the requirements of safety, concealment, and timeliness of trajectory planning during the unmanned aerial vehicle(UAV) penetration process, a three-dimensional path planning algorithm is proposed based on improved holonic particle swarm optimization(IHPSO). Firstly, the requirements of terrain threat, radar detection, and penetration time in the process of UAV penetration are quantified. Regarding radar threats, a radar echo analysis method based on radar cross section(RCS)and the spatial situation is proposed to quantify the concealment of UAV penetration. Then the structure-particle swarm optimization(PSO) algorithm is improved from three aspects.First, the conversion ability of the search strategy is enhanced by using the system clustering method and the information entropy grouping strategy instead of random grouping and constructing the state switching conditions based on the fitness function.Second, the unclear setting of iteration numbers is addressed by using particle spacing to create the termination condition of the algorithm. Finally, the trajectory is optimized to meet the intended requirements by building a predictive control model and using the IHPSO for simulation verification. Numerical examples show the superiority of the proposed method over the existing PSO methods.

Cognitive Granular-Based Path Planning and Tracking for Intelligent Vehicle with Multi-Segment Bezier Curve Stitching

Unmanned vehicles are currently facing many difficulties and challenges in improving safety performance when running in complex urban road traffic environments,such as low intelligence and poor comfort perfor-mance in the driving process.The real-time performance of vehicles and the comfort requirements of passengers in path planning and tracking control of unmanned vehicles have attracted more and more attentions.In this paper,in order to improve the real-time performance of the autonomous vehicle planning module and the comfort requirements of passengers that a local granular-based path planning method and tracking control based on multi-segment Bezier curve splicing and model predictive control theory are pro-posed.Especially,the maximum trajectory curvature satisfying ride comfort is regarded as an important constraint condition,and the corresponding curvature threshold is utilized to calculate the control points of Bezier curve.By using low-order interpolation curve splicing,the planning computation is reduced,and the real-time performance of planning is improved,com-pared with one-segment curve fitting method.Furthermore,the comfort performance of the planned path is reflected intuitively by the curvature information of the path.Finally,the effectiveness of the proposed control method is verified by the co-simulation platform built by MATLAB/Simulink and Carsim.The simulation results show that the path tracking effect of multi-segment Bezier curve fitting is better than that of high-order curve planning in terms of real-time performance and comfort.

Trajectory Planning and Optimal Lateral Stability Control under Multiple Barriers for Intelligent Vehicle

Based on analysis and evaluation on the circular, cosine type, constant-speed offset type and ladder type lane change trajectory, this paper proposes an intelligent vehicle lane change trajectory model under multiple barriers, proposes its dynamic constraints in the light of the cellular automata theory, obtains the desired lane change trajectory using this method, and finally changes into a simple coefficient selection problem. Secondly, based on the quadratic optimal control theory, this paper proposes a state space analysis method of intelligent vehicle lateral control, and designs an optimal controller for lateral stability of H2 vehicles. The computer simulation results show that compared with other vehicle trajectory methods, the method in this paper is able to simply and rapidly describe the trajectory, and can describe the intelligent vehicle lane change trajectory under a variety of situations, wherein the controller is reliable and capable of fast convergence.

Neural Dynamics for Cooperative Motion Control of Omnidirectional Mobile Manipulators in the Presence of Noises: A Distributed Approach

This paper presents a distributed scheme with limited communications, aiming to achieve cooperative motion control for multiple omnidirectional mobile manipulators(MOMMs).The proposed scheme extends the existing single-agent motion control to cater to scenarios involving the cooperative operation of MOMMs. Specifically, squeeze-free cooperative load transportation is achieved for the end-effectors of MOMMs by incorporating cooperative repetitive motion planning(CRMP), while guiding each individual to desired poses. Then, the distributed scheme is formulated as a time-varying quadratic programming(QP) and solved online utilizing a noise-tolerant zeroing neural network(NTZNN). Theoretical analysis shows that the NTZNN model converges globally to the optimal solution of QP in the presence of noise. Finally, the effectiveness of the control design is demonstrated by numerical simulations and physical platform experiments.

BASED ON WAVELET ANALYSIS TO OPTIMAL CONTROL OF MOTION PLANNING OF SPACE MANIPULATOR

The optimal control problem of nonholonomic motion planning of space manipulator was discussed. Utilizing the method of wavelet analysis, the discrete orthogonal wavelets were introduced to solve the optimal control problem, the classical Fourier basic functions were replaced by the wavelet expansion approximation. A numerical algorithm of optimal control was proposed based an wavelet analysis. The numerical simulation shows, the method is effective for nonholonomic motion planning of space manipulator.

Optimal control of nonholonomic motion planning for a free-falling cat

The nonholonomic motion planning of a free-falling cat is investigated. Nonholonomicity arises in a free-falling cat subject to nonintegrable angle velocity constraints or nonintegrable conservation laws. When the total angular momentum is zero, the motion equation of a free-falling cat is established based on the model of two symmetric rigid bodies and conservation of angular momentum. The control of system can be converted to the problem of nonholonomic motion planning for a free-falling cat. Based on Ritz approximation theory, the Gauss-Newton method for motion planning by a falling cat is proposed. The effectiveness of the numerical algorithm is demonstrated through simulation on model of a free-falling cat.