Path planning, modelling and simulation for energy optimised mobile robotics

This thesis is concerned with an investigation of a solution for mobile robotic platforms to minimize the usage of scarce energy that is available and is not wasted following traditionally planned paths for complex terrain environments. This therefore addresses the need to reduce the total energy cost during a field task or mission. A path planning algorithm is designed by creating a new approach of artificial potential field method that generates a planned path, utilising terrain map. The new approach has the capability of avoiding the local minimum problems which is one of the major problems of traditional potential field method. By solving such problems gives a reliable solution to establish a required path. Therefore the approach results in an energy efficient path of the terrain identified, instead obvious straight line of the terrain. A literature review is conducted which reviews the mainstream path planning algorithms with the applications in mobile robotic platforms was analysed. These path planning algorithms are compared for the purpose of energy optimized planning, which concludes the method of artificial potential field as the path planning algorithm which has the most potential and will be further investigated and improved in this research. The methodology of designing, modelling and simulating a mobile robotic platform is defined and presented for the purpose of energy optimized path planning requirement. The research is to clarify the needs, requirements, and specifications of the design. A complete set of models which include mechanical and electrical modelling, functional concept modelling, modelling of the system are established. Based on these models, an energy optimized path planning algorithm is designed. The modelling of force and the kinematics is established to validate and evaluate the result of the algorithm through simulations. Moreover a simulation environment is established which is constructed for multi perspective simulation. This also enables collaborative simulation using Simulink and ADAMS to for simulating a path generated by the path planning algorithm and assess the energy consumption of the driven and steering mechanism of an exemplar system called AgriRover. This simulation environment allows the capture of simulated result of the total energy consumption, therefore outlines the energy cost behaviour of the AgriRover. A total of two sets of paths was tested in the fields for validation, one being generated by the energy optimized path planning algorithm and the other following a straight path. During the field tests the total cost of energy was captured . Two sets of results are compared with each other and compared with the simulation. The comparison shows a 21.34% of the energy saving by deploying the path generated with the energy optimized path planning algorithm in the field test. This research made the following contribution to knowledge. A comparison and grading of mainstream path planning algorithms from energy optimisation perspective is undertaken using detailed evaluation criteria, including computational power required, extendibility, flexibility and more criteria that is relevant for the energy optimized planning purpose. These algorithms have not been compared from energy optimisation angle before, and the research for energy optimised planning under complex terrain environments have not been investigated. Addressing these knowledge gaps, a methodology of designing, modelling and simulating a mobile platform system is proposed to facilitate an energy optimized path planning. This , leads to a new approach of path planning algorithm that reduces unnecessary energy spend for climbing of the terrain, using the terrain data available. Such a methodology derives several novel methods: Namely, a method for avoiding local minimum problem for artificial potential field path planning using the approach of approximation; A method of achieving high expendability of the path planning algorithm, where this method is capable of generate a path through a large map in a short time; A novel method of multi perspective dynamic simulation, which is capable of simulating the behaviour of internal mechanism and the overall robotic mobile platform with the fully integrated control, The dynamic simulation enables prediction of energy consumption; Finally, a novel method of mathematically modelling and simplifying a steering mechanism for the wheel based mobile vehicle was further investigated.This thesis is concerned with an investigation of a solution for mobile robotic platforms to minimize the usage of scarce energy that is available and is not wasted following traditionally planned paths for complex terrain environments. This therefore addresses the need to reduce the total energy cost during a field task or mission. A path planning algorithm is designed by creating a new approach of artificial potential field method that generates a planned path, utilising terrain map. The new approach has the capability of avoiding the local minimum problems which is one of the major problems of traditional potential field method. By solving such problems gives a reliable solution to establish a required path. Therefore the approach results in an energy efficient path of the terrain identified, instead obvious straight line of the terrain. A literature review is conducted which reviews the mainstream path planning algorithms with the applications in mobile robotic platforms was analysed. These path planning algorithms are compared for the purpose of energy optimized planning, which concludes the method of artificial potential field as the path planning algorithm which has the most potential and will be further investigated and improved in this research. The methodology of designing, modelling and simulating a mobile robotic platform is defined and presented for the purpose of energy optimized path planning requirement. The research is to clarify the needs, requirements, and specifications of the design. A complete set of models which include mechanical and electrical modelling, functional concept modelling, modelling of the system are established. Based on these models, an energy optimized path planning algorithm is designed. The modelling of force and the kinematics is established to validate and evaluate the result of the algorithm through simulations. Moreover a simulation environment is established which is constructed for multi perspective simulation. This also enables collaborative simulation using Simulink and ADAMS to for simulating a path generated by the path planning algorithm and assess the energy consumption of the driven and steering mechanism of an exemplar system called AgriRover. This simulation environment allows the capture of simulated result of the total energy consumption, therefore outlines the energy cost behaviour of the AgriRover. A total of two sets of paths was tested in the fields for validation, one being generated by the energy optimized path planning algorithm and the other following a straight path. During the field tests the total cost of energy was captured . Two sets of results are compared with each other and compared with the simulation. The comparison shows a 21.34% of the energy saving by deploying the path generated with the energy optimized path planning algorithm in the field test. This research made the following contribution to knowledge. A comparison and grading of mainstream path planning algorithms from energy optimisation perspective is undertaken using detailed evaluation criteria, including computational power required, extendibility, flexibility and more criteria that is relevant for the energy optimized planning purpose. These algorithms have not been compared from energy optimisation angle before, and the research for energy optimised planning under complex terrain environments have not been investigated. Addressing these knowledge gaps, a methodology of designing, modelling and simulating a mobile platform system is proposed to facilitate an energy optimized path planning. This , leads to a new approach of path planning algorithm that reduces unnecessary energy spend for climbing of the terrain, using the terrain data available. Such a methodology derives several novel methods: Namely, a method for avoiding local minimum problem for artificial potential field path planning using the approach of approximation; A method of achieving high expendability of the path planning algorithm, where this method is capable of generate a path through a large map in a short time; A novel method of multi perspective dynamic simulation, which is capable of simulating the behaviour of internal mechanism and the overall robotic mobile platform with the fully integrated control, The dynamic simulation enables prediction of energy consumption; Finally, a novel method of mathematically modelling and simplifying a steering mechanism for the wheel based mobile vehicle was further investigated

Fast Design Space Exploration of Nonlinear Systems: Part II

Nonlinear system design is often a multi-objective optimization problem involving search for a design that satisfies a number of predefined constraints. The design space is typically very large since it includes all possible system architectures with different combinations of components composing each architecture. In this article, we address nonlinear system design space exploration through a two-step approach encapsulated in a framework called Fast Design Space Exploration of Nonlinear Systems (ASSENT). In the first step, we use a genetic algorithm to search for system architectures that allow discrete choices for component values or else only component values for a fixed architecture. This step yields a coarse design since the system may or may not meet the target specifications. In the second step, we use an inverse design to search over a continuous space and fine-tune the component values with the goal of improving the value of the objective function. We use a neural network to model the system response. The neural network is converted into a mixed-integer linear program for active learning to sample component values efficiently. We illustrate the efficacy of ASSENT on problems ranging from nonlinear system design to design of electrical circuits. Experimental results show that ASSENT achieves the same or better value of the objective function compared to various other optimization techniques for nonlinear system design by up to 54%. We improve sample efficiency by 6-10x compared to reinforcement learning based synthesis of electrical circuits.Comment: 14 pages, 24 figures. arXiv admin note: substantial text overlap with arXiv:2009.1021

Trajectory Analysis and Design for Planetary Powered Descent and Orbital Ascent Maneuvers

M.S

Autonomous vehicle guidance in unknown environments

Gaining from significant advances in their performance granted by technological evolution, Autonomous Vehicles are rapidly increasing the number of fields of possible and effective applications. From operations in hostile, dangerous environments (military use in removing unexploded projectiles, survey of nuclear power and chemical industrial plants following accidents) to repetitive 24h tasks (border surveillance), from power-multipliers helping in production to less exotic commercial application in household activities (cleaning robots as consumer electronics products), the combination of autonomy and motion offers nowadays impressive options. In fact, an autonomous vehicle can be completed by a number of sensors, actuators, devices making it able to exploit a quite large number of tasks. However, in order to successfully attain these results, the vehicle should be capable to navigate its path in different, sometimes unknown environments. This is the goal of this dissertation: to analyze and - mainly - to propose a suitable solution for the guidance of autonomous vehicles. The frame in which this research takes its steps is the activity carried on at the Guidance and Navigation Lab of Sapienza – Università di Roma, hosted at the School of Aerospace Engineering. Indeed, the solution proposed has an intrinsic, while not limiting, bias towards possible space applications, that will become obvious in some of the following content. A second bias dictated by the Guidance and Navigation Lab activities is represented by the choice of a sample platform. In fact, it would be difficult to perform a meaningful study keeping it a very general level, independent on the characteristics of the targeted kind of vehicle: it is easy to see from the rough list of applications cited above that these characteristics are extremely varied. The Lab hosted – even before the beginning of this thesis activity – a simple, home-designed and manufactured model of a small, yet performing enough autonomous vehicle, called RAGNO (standing for Rover for Autonomous Guidance Navigation and Observation): it was an obvious choice to select that rover as the reference platform to identify solutions for guidance, and to use it, cooperating to its improvement, for the test activities which should be considered as mandatory in this kind of thesis work to validate the suggested approaches. The draft of the thesis includes four main chapters, plus introduction, final remarks and future perspectives, and the list of references. The first chapter (“Autonomous Guidance Exploiting Stereoscopic Vision”) investigates in detail the technique which has been deemed as the most interesting for small vehicles. The current availability of low cost, high performance cameras suggests the adoption of the stereoscopic vision as a quite effective technique, also capable to making available to remote crew a view of the scenario quite similar to the one humans would have. Several advanced image analysis techniques have been investigated for the extraction of the features from left- and right-eye images, with SURF and BRISK algorithm being selected as the most promising one. In short, SURF is a blob detector with an associated descriptor of 64 elements, where the generic feature is extracted by applying sequential box filters to the surrounding area. The features are then localized in the point of the image where the determinant of the Hessian matrix H(x,y) is maximum. The descriptor vector is than determined by calculating the Haar wavelet response in a sampling pattern centered in the feature. BRISK is instead a corner detector with an associated binary descriptor of 512 bit. The generic feature is identified as the brightest point in a sampling circular area of N pixels while the descriptor vector is calculated by computing the brightness gradient of each of the N(N-1)/2 pairs of sampling points. Once left and right features have been extracted, their descriptors are compared in order to determine the corresponding pairs. The matching criterion consists in seeking for the two descriptors for which their relative distance (Euclidean norm for SURF, Hamming distance for BRISK) is minimum. The matching process is computationally expensive: to reduce the required time the thesis successfully explored the theory of the epipolar geometry, based on the geometric constraint existing between the left and right projection of the scene point P, and indeed limiting the space to be searched. Overall, the selected techniques require between 200 and 300 ms on a 2.4GHz clock CPU for the feature extraction and matching in a single (left+right) capture, making it a feasible solution for slow motion vehicles. Once matching phase has been finalized, a disparity map can be prepared highlighting the position of the identified objects, and by means of a triangulation (the baseline between the two cameras is known, the size of the targeted object is measured in pixels in both images) the position and distance of the obstacles can be obtained. The second chapter (“A Vehicle Prototype and its Guidance System”) is devoted to the implementation of the stereoscopic vision onboard a small test vehicle, which is the previously cited RAGNO rover. Indeed, a description of the vehicle – the chassis, the propulsion system with four electric motors empowering the wheels, the good roadside performance attainable, the commanding options – either fully autonomous, partly autonomous with remote monitoring, or fully remotely controlled via TCP/IP on mobile networks - is included first, with a focus on different sensors that, depending on the scenario, can integrate the stereoscopic vision system. The intelligence-side of guidance subsystem, exploiting the navigation information provided by the camera, is then detailed. Two guidance techniques have been studied and implemented to identify the optimal trajectory in a field with scattered obstacles: the artificial potential guidance, based on the Lyapunov approach, and the A-star algorithm, looking for the minimum of a cost function built on graphs joining the cells of a mesh over-imposed to the scenario. Performance of the two techniques are assessed for two specific test-cases, and the possibility of unstable behavior of the artificial potential guidance, bouncing among local minima, has been highlighted. Overall, A-star guidance is the suggested solution in terms of time, cost and reliability. Notice that, withstanding the noise affecting information from sensors, an estimation process based on Kalman filtering has been also included in the process to improve the smoothness of the targeted trajectory. The third chapter (“Examples of Possible Missions and Applications”) reports two experimental campaigns adopting RAGNO for the detection of dangerous gases. In the first one, the rover accommodates a specific sensor, and autonomously moves in open fields, avoiding possible obstacles, to exploit measurements at given time intervals. The same configuration for RAGNO is also used in the second campaign: this time, however, the path of the rover is autonomously computed on the basis of the way points communicated by a drone which is flying above the area of measurements and identifies possible targets of interest. The fourth chapter (“Guidance of Fleet of Autonomous Vehicles ”) stresses this successful idea of fleet of vehicles, and numerically investigates by algorithms purposely written in Matlab the performance of a simple swarm of two rovers exploring an unknown scenario, pretending – as an example - to represent a case of planetary surface exploration. The awareness of the surrounding environment is dictated by the characteristics of the sensors accommodated onboard, which have been assumed on the basis of the experience gained with the material of previous chapter. Moreover, the communication issues that would likely affect real world cases are included in the scheme by the possibility to model the comm link, and by running the simulation in a multi-task configuration where the two rovers are assigned to two different computer processes, each of them having a different TCP/IP address with a behavior actually depending on the flow of information received form the other explorer. Even if at a simulation-level only, it is deemed that such a final step collects different aspects investigated during the PhD period, with feasible sensors’ characteristics (obviously focusing on stereoscopic vision), guidance technique, coordination among autonomous agents and possible interesting application cases

Design, Construction, Energy Modeling, and Navigation of a Six-Wheeled Differential Drive Robot to Deliver Medical Supplies inside Hospitals

Differential drive mobile robots have been the most ubiquitous kind of robots for the last few decades. As each of the wheels of a differential drive mobile robot can be controlled, it provides additional flexibility to the end-users in creating new applications. These applications include personal assistance, security, warehouse and distribution applications, ocean and space exploration, etc. In a clinic or hospital, the delivery of medicines and patients’ records are frequently needed activities. Medical personnel often find these activities repetitive and time-consuming. Our research was to design, construct, produce an energy model, and develop a navigation control method for a six-wheeled differential drive robot designed to deliver medical supplies inside the hospital. Such a robot is expected to lessen the workload of medical staff. Therefore, the design and implementation of a six-wheeled differential drive robot with a password-protected medicine carrier were presented. This password-protected medicine carrier ensures that only the authorized medical personnel can receive medical supplies. The low-cost robot base and the medicine carrier were built in real life. Besides the actual robot design and fabrication, a kinematic model for the robot was developed, and a navigation control algorithm to avoid obstacles was implemented using MATLAB/Simulink. The kinematic modeling is helpful for the robot to achieve better energy optimization. To develop the object avoidance algorithm, we investigated the use of the Robot Operating System (ROS) and the Simultaneous Localization and Mapping (SLAM) algorithm for the implementation of the mapping and navigation of a robotic platform named TurtleBot 2. Finally, using the Webot robot simulator, the navigation of the six-wheeled mobile robot was demonstrated in a hospital-like simulation environment

Environment Search Planning Subject to High Robot Localization Uncertainty

As robots find applications in more complex roles, ranging from search and rescue to healthcare and services, they must be robust to greater levels of localization uncertainty and uncertainty about their environments. Without consideration for such uncertainties, robots will not be able to compensate accordingly, potentially leading to mission failure or injury to bystanders. This work addresses the task of searching a 2D area while reducing localization uncertainty. Wherein, the environment provides low uncertainty pose updates from beacons with a short range, covering only part of the environment. Otherwise the robot localizes using dead reckoning, relying on wheel encoder and yaw rate information from a gyroscope. As such, outside of the regions with position updates, there will be unconstrained localization error growth over time. The work contributes a Belief Markov Decision Process formulation for solving the search problem and evaluates the performance using Partially Observable Monte Carlo Planning (POMCP). Additionally, the work contributes an approximate Markov Decision Process formulation and reduced complexity state representation. The approximate problem is evaluated using value iteration. To provide a baseline, the Google OR-Tools package is used to solve the travelling salesman problem (TSP). Results are verified by simulating a differential drive robot in the Gazebo simulation environment. POMCP results indicate planning can be tuned to prioritize constraining uncertainty at the cost of increasing path length. The MDP formulation provides consistently lower uncertainty with minimal increases in path length over the TSP solution. Both formulations show improved coverage outcomes