Towards the Implementation of a MPC-based Planner on an Autonomous All-Terrain Vehicle

Planning and control for a wheeled mobile robot are challenging problems when poorly traversable terrains, including dynamic obstacles, are considered. To accomplish a mission, the control system should firstly guarantee the vehicle integrity, for example with respect to possible roll-over/tip-over phenomena. A fundamental contribution to achieve this goal, however, comes from the planner as well. In fact, computing a path that takes into account the terrain traversability, the kinematic and dynamic vehicle constraints, and the presence of dynamic obstacles, is a first and crucial step towards ensuring the vehicle integrity. The present paper addresses some of the aforementioned issues, describing the hardware/software architecture of the planning and control system of an autonomous All-Terrain Mobile Robot and the implementation of a real-time path planner

Modeling and Control of the UGV Argo J5 with a Custom-Built Landing Platform

This thesis aims to develop a detailed dynamic model and implement several navigation controllers for path tracking and dynamic self-leveling of the Argo J5 Unmanned Ground Vehicle (UGV) with a custom-built landing platform. The overall model is derived by combining the Argo J5 driveline system with the wheelsterrain interaction (using terramechanics theory and mobile robot kinetics), while the landing platform model follows the Euler-Lagrange formulation. Different controllers are, then, derived, implemented to demonstrate: i.) self-leveling accuracy of the landing platform, ii.) trajectory tracking capabilities of the Argo J5 when moving in uneven terrains. The novelty of the Argo J5 model is the addition of a vertical load on each wheel through derivation of the shear stress depending on the point’s position in 3D space on each wheel. Static leveling of the landing platform within one degree of the horizon is evaluated by implementing Proportional Derivative (PD), Proportional Integral Derivative (PID), Linear Quadratic Regulator (LQR), feedback linearization, and Passivity Based Adaptive Controller (PBAC) techniques. A PD controller is used to evaluate the performance of the Argo J5 on different terrains. Further, for the Argo J5 - landing platform ensemble, PBAC and Neural Network Based Adaptive Controller (NNBAC) are derived and implemented to demonstrate dynamic self-leveling. The emphasis is on different controller implementation for complex real systems such as Argo J5 - Landing platform. Results, obtained via extensive simulation studies in a Matlab/Simulink environment that consider real system parameters and hardware limitations, contribute to understanding navigation performance in a variety of terrains with unknown properties and illustrate the Argo J5 velocity, wheel rolling resistance, wheel turning resistance and shear stress on different terrains

Performance Analysis of Constant Speed Local Abstacle Avoidance Controller Using a MPC Algorithym on Granular Terrain

A Model Predictive Control (MPC) LIDAR-based constant speed local obstacle avoidance algorithm has been implemented on rigid terrain and granular terrain in Chrono to examine the robustness of this control method. Provided LIDAR data as well as a target location, a vehicle can route itself around obstacles as it encounters them and arrive at an end goal via an optimal route. This research is one important step towards eventual implementation of autonomous vehicles capable of navigating on all terrains. Using Chrono, a multibody physics API, this controller has been tested on a complex multibody physics HMMWV model representing the plant in this study. A penalty-based DEM approach is used to model contacts on both rigid ground and granular terrain. Conclusions are drawn regarding the MPC algorithm performance based on its ability to navigate the Chrono HMMWV on rigid and granular terrain. A novel simulation framework has been developed to efficiently simulate granular terrain for this application. Two experiments were conducted to analyze the performance of the MPC LIDAR-based constant speed local obstacle avoidance controller. In the first, two separate controllers were developed, one using a 2-DOF analytical model to predict the HMMWV behavior, and the second using a higher fidelity 14-DOF vehicle model. In this first experiment, two controllers were compared as they controlled the HMMWV on two obstacle fields on rigid ground and granular terrain to understand the influence of model fidelity and terrain on controller performance. From these results, an improved lateral force model was developed for use in the 2-DOF vehicle model to better model the tire ground interaction using terramechanics relations. A second experiment was performed to compare two developed controllers. One used the 2-DOF vehicle model using the Pacejka Magic Formula to estimate tire forces while the second used a 2-DOF vehicle model with the newly developed force model to estimate lateral tire forces. As a result of this research, a smarter controller was developed that uses friction angle, cohesion, and interparticle friction coefficient to more accurately predict vehicle trajectories on granular terrain and allow a vehicle to navigate autonomously on granular terrain

High-Speed Obstacle Avoidance at the Dynamic Limits for Autonomous Ground Vehicles

Enabling autonomy of passenger-size and larger vehicles is becoming increasingly important in both military and commercial applications. For large autonomous ground vehicles (AGVs), the vehicle dynamics are critical to consider to ensure vehicle safety during obstacle avoidance maneuvers especially at high speeds. This research is concerned with large-size high-speed AGVs with high center of gravity that operate in unstructured environments. The term `unstructured' in this context denotes that there are no lanes or traffic rules to follow. No map of the environment is available a priori. The environment is perceived through a planar light detection and ranging sensor. The mission of the AGV is to move from its initial position to a given target position safely and as fast as possible. In this dissertation, a model predictive control (MPC)-based obstacle avoidance algorithm is developed to achieve the objectives through an iterative simultaneous optimization of the path and the corresponding control commands. MPC is chosen because it offers a rigorous and systematic approach for taking vehicle dynamics and safety constraints into account. Firstly, this thesis investigates the level of model fidelity needed for an MPC-based obstacle avoidance algorithm to be able to safely and quickly avoid obstacles even when the vehicle is close to its dynamic limits. Five different representations of vehicle dynamics models are considered. It is concluded that the two Degrees-of-Freedom (DoF) representation that accounts for tire nonlinearities and longitudinal load transfer is necessary for the MPC-based obstacle avoidance algorithm to operate the vehicle at its limits within an environment that includes large obstacles. Secondly, existing MPC formulations for passenger vehicles in structured environments do not readily apply to this context. Thus, a novel nonlinear MPC formulation is developed. First, a new cost function formulation is used that aims to find the shortest path to the target position. Second, a region partitioning approach is used in conjunction with a multi-phase optimal control formulation to accommodate the complicated forms of obstacle-free regions from an unstructured environment. Third, the no-wheel-lift-off condition is established offline using a fourteen DoF vehicle dynamics model and is included in the MPC formulation. The formulation can simultaneous optimize both steering angle and reference longitudinal speed commands. Simulation results show that the proposed algorithm is capable of safely exploiting the dynamic limits of the vehicle while navigating the vehicle through sensed obstacles of different size and number. Thirdly, in the algorithm, a model of the vehicle is used explicitly to predict and optimize future actions, but in practice, the model parameter values are not exactly known. It is demonstrated that using nominal parameter values in the algorithm leads to safety issues in about one fourth of the evaluated scenarios with the considered parametric uncertainty distributions. To improve the robustness of the algorithm, a novel double-worst-case formulation is developed. Results from simulations with stratified random scenarios and worst-case scenarios show that the double-worst-case formulation considering both the most likely and less likely worst-case scenarios renders the algorithm robust to all uncertainty realizations tested. The trade-off between the robustness and the task completion performance of the algorithm is also quantified. Finally, in addition to simulation-based validation, preliminary experimental validation is also performed. These results demonstrate that the developed algorithm is promising in terms of its capability of avoiding obstacles. Limitations and potential improvements of the algorithm are discussed.PHDMechanical EngineeringUniversity of Michigan, Horace H. Rackham School of Graduate Studieshttp://deepblue.lib.umich.edu/bitstream/2027.42/135770/1/ljch_1.pd

Actuation-Aware Simplified Dynamic Models for Robotic Legged Locomotion

In recent years, we witnessed an ever increasing number of successful hardware implementations of motion planners for legged robots. If one common property is to be identified among these real-world applications, that is the ability of online planning. Online planning is forgiving, in the sense that it allows to relentlessly compensate for external disturbances of whatever form they might be, ranging from unmodeled dynamics to external pushes or unexpected obstacles and, at the same time, follow user commands. Initially replanning was restricted only to heuristic-based planners that exploit the low computational effort of simplified dynamic models. Such models deliberately only capture the main dynamics of the system, thus leaving to the controllers the issue of anchoring the desired trajectory to the whole body model of the robot. In recent years, however, we have seen a number of new approaches attempting to increase the accuracy of the dynamic formulation without trading-off the computational efficiency of simplified models. In this dissertation, as an example of successful hardware implementation of heuristics and simplified model-based locomotion, I describe the framework that I developed for the generation of an omni-directional bounding gait for the HyQ quadruped robot. By analyzing the stable limit cycles for the sagittal dynamics and the Center of Pressure (CoP) for the lateral stabilization, the described locomotion framework is able to achieve a stable bounding while adapting to terrains of mild roughness and to sudden changes of the user desired linear and angular velocities. The next topic reported and second contribution of this dissertation is my effort to formulate more descriptive simplified dynamic models, without trading off their computational efficiency, in order to extend the navigation capabilities of legged robots to complex geometry environments. With this in mind, I investigated the possibility of incorporating feasibility constraints in these template models and, in particular, I focused on the joint torques limits which are usually neglected at the planning stage. In this direction, the third contribution discussed in this thesis is the formulation of the so called actuation wrench polytope (AWP), defined as the set of feasible wrenches that an articulated robot can perform given its actuation limits. Interesected with the contact wrench cone (CWC), this yields a new 6D polytope that we name feasible wrench polytope (FWP), defined as the set of all wrenches that a legged robot can realize given its actuation capabilities and the friction constraints. Results are reported where, thanks to efficient computational geometry algorithms and to appropriate approximations, the FWP is employed for a one-step receding horizon optimization of center of mass trajectory and phase durations given a predefined step sequence on rough terrains. For the sake of reachable workspace augmentation, I then decided to trade off the generality of the FWP formulation for a suboptimal scenario in which a quasi-static motion is assumed. This led to the definition of the, so called, local/instantaneous actuation region and of the global actuation/feasible region. They both can be seen as different variants of 2D linear subspaces orthogonal to gravity where the robot is guaranteed to place its own center of mass while being able to carry its own body weight given its actuation capabilities. These areas can be intersected with the well known frictional support region, resulting in a 2D linear feasible region, thus providing an intuitive tool that enables the concurrent online optimization of actuation consistent CoM trajectories and target foothold locations on rough terrains

Climbing and Walking Robots

With the advancement of technology, new exciting approaches enable us to render mobile robotic systems more versatile, robust and cost-efficient. Some researchers combine climbing and walking techniques with a modular approach, a reconfigurable approach, or a swarm approach to realize novel prototypes as flexible mobile robotic platforms featuring all necessary locomotion capabilities. The purpose of this book is to provide an overview of the latest wide-range achievements in climbing and walking robotic technology to researchers, scientists, and engineers throughout the world. Different aspects including control simulation, locomotion realization, methodology, and system integration are presented from the scientific and from the technical point of view. This book consists of two main parts, one dealing with walking robots, the second with climbing robots. The content is also grouped by theoretical research and applicative realization. Every chapter offers a considerable amount of interesting and useful information

Motion Kinematics Analysis of a Horse Inspired Terrain-Adaptive Unmanned Vehicle With Four Hydraulic Swing Arms

All terrain vehicles (ATV) perform tasks in unstructured environments where the advanced adaptive ability of rigid terrain has become a key factor. In this article, we propose a novel horse inspired all terrain eight-wheeled vehicle with four swing arms for transportation in the mountain battlefield. The mechanism structure and system configuration of the ATV are designed based on the horse leg kinematics analysis. In order to analyze the obstacle surmounting strategy of the ATV, the kinematics model and the center of gravity of the ATV are represented. A model reference adaptive control method is proposed for the hydraulic attitude control system. Then the model for obstacle surmounting is proposed for dynamics performance and geometric kinematics. Additionally, the simulation is executed in Adams to verify the analysis and strategy. Finally, the experiment is demonstrated for climbing a vertical wall, which is a challenging and typical terrain of the mountain battlefield

Robotics 2010

Without a doubt, robotics has made an incredible progress over the last decades. The vision of developing, designing and creating technical systems that help humans to achieve hard and complex tasks, has intelligently led to an incredible variety of solutions. There are barely technical fields that could exhibit more interdisciplinary interconnections like robotics. This fact is generated by highly complex challenges imposed by robotic systems, especially the requirement on intelligent and autonomous operation. This book tries to give an insight into the evolutionary process that takes place in robotics. It provides articles covering a wide range of this exciting area. The progress of technical challenges and concepts may illuminate the relationship between developments that seem to be completely different at first sight. The robotics remains an exciting scientific and engineering field. The community looks optimistically ahead and also looks forward for the future challenges and new development

Optimization-based multi-contact motion planning for legged robots

For legged robots, generating dynamic and versatile motions is essential for interacting with complex and ever-changing environments. So far, robots that routinely operate reliably over rough terrains remains an elusive goal. Yet the primary promise of legged locomotion is to replace humans and animals in performing tedious and menial tasks, without requiring changes in the environment as wheeled robots do. A necessary step towards this goal is to endow robots with capabilities to reason about contacts but this vital skill is currently missing. An important justification for this is that contact phenomena are inherently non-smooth and non-convex. As a result, posing and solving problems involving contacts is non-trivial. Optimization-based motion planning constitutes a powerful paradigm to this end. Consequently, this thesis considers the problem of generating motions in contact-rich situations. Specifically, we introduce several methods that compute dynamic and versatile motion plans from a holistic optimization perspective based on trajectory optimization techniques. The advantage is that the user needs to provide a high-level task description in the form of an objective function only. Subsequently, the methods output a detailed motion plan—that includes contact locations, timings, gait patterns—that optimally achieves the high-level task. Initially, we assume that such a motion plan is available, and we investigate the relevant control problem. The problem is to track a nominal motion plan as close as possible given external disturbances by computing inputs for the robot. Thus, this stage typically follows the motion planning stage. Additionally, this thesis presents methods that do not necessarily require a separate control stage by computing the controller structure automatically. Afterwards, we proceed to the main parts of this thesis. First, assuming a pre-specified contact sequence, we formulate a trajectory optimization method reminiscent of hybrid approaches. Its backbone is a high-accuracy integrator, enabling reliable long-term motion planning while satisfying both translational and rotational dynamics. We utilize it to compute motion plans for a hopper traversing rough terrains—with gaps and obstacles—and performing explosive motions, like a somersault. Subsequently, we provide a discussion on how to extend the method when the contact sequence is unspecified. In the next chapter, we increase the complexity of the problem in many aspects. First, we formulate the problem in joint-level utilizing full dynamics and kinematics models. Second, we assume a contact-implicit perspective, i.e. decisions about contacts are implicitly defined in the problem’s formulation rather than defined as explicit contact modes. As a result, pre-specification of the contact interactions is not required, like the order by which the feet contact the ground for a quadruped robot model and the respective timings. Finally, we extend the classical rigid contact model to surfaces with soft and slippery properties. We quantitatively evaluate our proposed framework by performing comparisons against the rigid model and an alternative contact-implicit framework. Furthermore, we compute motion plans for a high-dimensional quadruped robot in a variety of terrains exhibiting the enhanced properties. In the final study, we extend the classical Differential Dynamic Programming algorithm to handle systems defined by implicit dynamics. While this can be of interest in its own right, our particular application is computing motion plans in contact-rich settings. Compared to the method presented in the previous chapter, this formulation enables experiencing contacts with all body parts in a receding horizon fashion, albeit with limited contact discovery capabilities. We demonstrate the properties of our proposed extension by comparing implicit and explicit models and generating motion plans for a single-legged robot with multiple contacts both for trajectory optimization and receding horizon settings. We conclude this thesis by providing insights and limitations of the proposed methods, and possible future directions that can improve and extend aspects of the presented work