Path Planning Based on Parametric Curves

Parametric curves are extensively used in engineering. The most commonly used parametric curves are, Bézier, B-splines, (NURBSs), and rational Bézier. Each and every one of them has special features, being the main difference between them the complexity of their mathematical definition. While Bézier curves are the simplest ones, B-splines or NURBSs are more complex. In mobile robotics, two main problems have been addressed with parametric curves. The first one is the definition of an initial trajectory for a mobile robot from a start location to a goal. The path has to be a continuous curve, smooth and easy to manipulate, and the properties of the parametric curves meet these requirements. The second one is the modification of the initial trajectory in real time attending to the dynamic properties of the environment. Parametric curves are capable of enhancing the trajectories produced by path planning algorithms adapting them to the kinematic properties of the robot. In order to avoid obstacles, the shape modification of parametric curves is required. In this chapter, an algorithm is proposed for computing an initial Bézier trajectory of a mobile robot and subsequently modifies it in real time in order to avoid obstacles in a dynamic environment

Smooth Three-Dimensional Route Planning for Fixed-Wing Unmanned Aerial Vehicles With Double Continuous Curvature

This paper presents a smooth flight path planner for maneuvering in a 3D Euclidean space, which is based on two new space curves. The first one is called 'Elementary Clothoid-based 3D Curve (ECb3D)', which is built by concatenating two symmetric Clothoid-based 3D Curves (Cb3D). The combination of these curves allows to reach an arbitrary orientation in 3D Euclidean space. This new curve allows to generate continuous curvature and torsion profiles that start and finish with a null value, which means that they can be concatenated with other curves, such as straight segments, without generating discontinuities on those variables. The second curve is called 'Double Continuous Curvature 3D Curve (DCC3D)' which is built as a concatenation of three straight line segments and two ECb3D curves, allowing to reach an arbitrary configuration in position and orientation in the 3D Euclidean space without discontinuities in curvature and torsion. This trajectory is applied for autonomous path planning and navigation of unmanned aerial vehicles (UAVs) such as fixed-wing aircrafts. Finally, the results are validated on the FlightGear 2018 flight simulator with the UAV kadett 2400 platform

Smooth path planning with Pythagorean-hodoghraph spline curves geometric design and motion control

This thesis addresses two significative problems regarding autonomous systems, namely path and trajectory planning. Path planning deals with finding a suitable path from a start to a goal position by exploiting a given representation of the environment. Trajectory planning schemes govern the motion along the path by generating appropriate reference (path) points. We propose a two-step approach for the construction of planar smooth collision-free navigation paths. Obstacle avoidance techniques that rely on classical data structures are initially considered for the identification of piecewise linear paths that do not intersect with the obstacles of a given scenario. In the second step of the scheme we rely on spline interpolation algorithms with tension parameters to provide a smooth planar control strategy. In particular, we consider Pythagorean\u2013hodograph (PH) curves, since they provide an exact computation of fundamental geometric quantities. The vertices of the previously produced piecewise linear paths are interpolated by using a G1 or G2 interpolation scheme with tension based on PH splines. In both cases, a strategy based on the asymptotic analysis of the interpolation scheme is developed in order to get an automatic selection of the tension parameters. To completely describe the motion along the path we present a configurable trajectory planning strategy for the offline definition of time-dependent C2 piece-wise quintic feedrates. When PH spline curves are considered, the corresponding accurate and efficient CNC interpolator algorithms can be exploited

Smooth path planning with Pythagorean-hodoghraph spline curves geometric design and motion control

This thesis addresses two significative problems regarding autonomous systems, namely path and trajectory planning. Path planning deals with finding a suitable path from a start to a goal position by exploiting a given representation of the environment. Trajectory planning schemes govern the motion along the path by generating appropriate reference (path) points. We propose a two-step approach for the construction of planar smooth collision-free navigation paths. Obstacle avoidance techniques that rely on classical data structures are initially considered for the identification of piecewise linear paths that do not intersect with the obstacles of a given scenario. In the second step of the scheme we rely on spline interpolation algorithms with tension parameters to provide a smooth planar control strategy. In particular, we consider Pythagorean–hodograph (PH) curves, since they provide an exact computation of fundamental geometric quantities. The vertices of the previously produced piecewise linear paths are interpolated by using a G1 or G2 interpolation scheme with tension based on PH splines. In both cases, a strategy based on the asymptotic analysis of the interpolation scheme is developed in order to get an automatic selection of the tension parameters. To completely describe the motion along the path we present a configurable trajectory planning strategy for the offline definition of time-dependent C2 piece-wise quintic feedrates. When PH spline curves are considered, the corresponding accurate and efficient CNC interpolator algorithms can be exploited

Implementation of a local path planning algorithm for unmanned aerial vehicles

As the presence of Unmanned Aircraft Systems (UASs) become more prominent today and in the future. They are used in a variety of ways to solve solutions for a variety of tasks. UASs that are battery-powered typically have a flight time of no more than 30 minutes. Some tasks make take the drone beyond visual line of sight (BVLOS). The approach taken within this paper is allocating a secondary flight computer onboard the UAS to calculate paths while the primary computer controls the aircraft and follows the path being generated. With a proper map of the environment and use of a path planning algorithm the safety of the aircraft can be increased in missions that are BVLOS. This thesis will cover the concepts of path planning algorithms and the development of a modified version of a popular path planning algorithm. Show simulations of comparison with other variations of path planning algorithms and software in the loop (SITL) simulations on a fixed-wing aircraft. It will also show this algorithm's results when implemented in flight tests onboard a fixed-wing and multi-rotor UAS

Using a mobile robot for hazardous substances detection in a factory environment

Dupla diplomação com a UTFPR - Universidade Tecnológica Federal do ParanáIndustries that work with toxic materials need extensive security protocols to avoid accidents. Instead of having fixed sensors, the concept of assembling the sensors on a mobile robot that performs the scanning through a defined path is cheaper, configurable and adaptable. This work describes a mobile robot, equipped with several gas sensors and LIDAR, that follows a trajectory based on waypoints, simulating a working Autonomous Guided Vehicle (AGV). At the same time, the robot keeps measuring for toxic gases. In other words, the robot follows the trajectory while the gas concentration is under a defined value. Otherwise, it starts the autonomous leakage search based on a search algorithm that allows to find the leakage position avoiding obstacles in real time. The proposed methodology is verified in simulation based on a model of the real robot. Therefore, three path plannings were developed and their performance compared. A Light Detection And Ranging (LIDAR) device was integrated with the path planning to propose an obstacle avoidance system with a dilation technique to enlarge the obstacles, thus, considering the robot’s dimensions. Moreover, if needed, the robot can be remotely operated with visual feedback. In addition, a controller was made for the robot. Gas sensors were embedded in the robot with Finite Impulse Response (FIR) filter to process the data. A low cost AGV was developed to compete in Festival Nacional de Robótica (Portuguese Robotics Open) 2019 - Gondomar, describing the robot’s control and software solution to the competition.As indústrias que trabalham com materiais tóxicos necessitam de extensos protocolos de segurança para evitar acidentes. Ao invés de ter sensores estáticos, o conceito de instalar sensores em um robô móvel que inspeciona através de um caminho definido é mais barato, configurável e adaptável. O presente trabalho descreve um robô móvel, equipado com vários sensores de gás e LIDAR, que percorre uma trajetória baseada em pontos de controle, simulando um AGV em trabalho. Em simultâneo são efetuadas medidas de gases tóxicos. Em outras palavras, o robô segue uma trajetória enquanto a concentração de gás está abaixo de um valor definido. Caso contrário, inicia uma busca autônoma de vazamento de gás com um algoritmo de busca que permite achar a posição do gás evitando os obstáculos em tempo real. A metodologia proposta é verificada em simulação. Três algoritmos de planejamento de caminho foram desenvolvidos e suas performances comparadas. Um LIDAR foi integrado com o planejamento de caminho para propôr um sistema de evitar obstáculos. Além disso, o robô pode ser operado remotamente com auxílio visual. Foi feito um controlador para o robô. Sensores de gás foram embarcados no robô com um filtro de resposta ao impulso finita para processar as informações. Um veículo guiado automático de baixo custo foi desenvolvido para competir no Festival Nacional de Robótica 2019 - Gondomar. O controle do veículo foi descrito com o programa de solução para a competição

Human-aware space sharing and navigation for an interactive robot

Les méthodes de planification de mouvements robotiques se sont développées à un rythme accéléré ces dernières années. L'accent a principalement été mis sur le fait de rendre les robots plus efficaces, plus sécurisés et plus rapides à réagir à des situations imprévisibles. En conséquence, nous assistons de plus en plus à l'introduction des robots de service dans notre vie quotidienne, en particulier dans les lieux publics tels que les musées, les centres commerciaux et les aéroports. Tandis qu'un robot de service mobile se déplace dans l'environnement humain, il est important de prendre en compte l'effet de son comportement sur les personnes qu'il croise ou avec lesquelles il interagit. Nous ne les voyons pas comme de simples machines, mais comme des agents sociaux et nous nous attendons à ce qu'ils se comportent de manière similaire à l'homme en suivant les normes sociétales comme des règles. Ceci a créé de nouveaux défis et a ouvert de nouvelles directions de recherche pour concevoir des algorithmes de commande de robot, qui fournissent des comportements de robot acceptables, lisibles et proactifs. Cette thèse propose une méthode coopérative basée sur l'optimisation pour la planification de trajectoire et la navigation du robot avec des contraintes sociales intégrées pour assurer des mouvements de robots prudents, conscients de la présence de l'être humain et prévisibles. La trajectoire du robot est ajustée dynamiquement et continuellement pour satisfaire ces contraintes sociales. Pour ce faire, nous traitons la trajectoire du robot comme une bande élastique (une construction mathématique représentant la trajectoire du robot comme une série de positions et une différence de temps entre ces positions) qui peut être déformée (dans l'espace et dans le temps) par le processus d'optimisation pour respecter les contraintes données. De plus, le robot prédit aussi les trajectoires humaines plausibles dans la même zone d'exploitation en traitant les chemins humains aussi comme des bandes élastiques. Ce système nous permet d'optimiser les trajectoires des robots non seulement pour le moment présent, mais aussi pour l'interaction entière qui se produit lorsque les humains et les robots se croisent les uns les autres. Nous avons réalisé un ensemble d'expériences avec des situations interactives humains-robots qui se produisent dans la vie de tous les jours telles que traverser un couloir, passer par une porte et se croiser sur de grands espaces ouverts. La méthode de planification coopérative proposée se compare favorablement à d'autres schémas de planification de la navigation à la pointe de la technique. Nous avons augmenté le comportement de navigation du robot avec un mouvement synchronisé et réactif de sa tête. Cela permet au robot de regarder où il va et occasionnellement de détourner son regard vers les personnes voisines pour montrer que le robot va éviter toute collision possible avec eux comme prévu par le planificateur. À tout moment, le robot pondère les multiples critères selon le contexte social et décide de ce vers quoi il devrait porter le regard. Grâce à une étude utilisateur en ligne, nous avons montré que ce mécanisme de regard complète efficacement le comportement de navigation ce qui améliore la lisibilité des actions du robot. Enfin, nous avons intégré notre schéma de navigation avec un système de supervision plus large qui peut générer conjointement des comportements du robot standard tel que l'approche d'une personne et l'adaptation de la vitesse du robot selon le groupe de personnes que le robot guide dans des scénarios d'aéroport ou de musée.The methods of robotic movement planning have grown at an accelerated pace in recent years. The emphasis has mainly been on making robots more efficient, safer and react faster to unpredictable situations. As a result we are witnessing more and more service robots introduced in our everyday lives, especially in public places such as museums, shopping malls and airports. While a mobile service robot moves in a human environment, it leaves an innate effect on people about its demeanor. We do not see them as mere machines but as social agents and expect them to behave humanly by following societal norms and rules. This has created new challenges and opened new research avenues for designing robot control algorithms that deliver human-acceptable, legible and proactive robot behaviors. This thesis proposes a optimization-based cooperative method for trajectoryplanning and navigation with in-built social constraints for keeping robot motions safe, human-aware and predictable. The robot trajectory is dynamically and continuously adjusted to satisfy these social constraints. To do so, we treat the robot trajectory as an elastic band (a mathematical construct representing the robot path as a series of poses and time-difference between those poses) which can be deformed (both in space and time) by the optimization process to respect given constraints. Moreover, we also predict plausible human trajectories in the same operating area by treating human paths also as elastic bands. This scheme allows us to optimize the robot trajectories not only for the current moment but for the entire interaction that happens when humans and robot cross each other's paths. We carried out a set of experiments with canonical human-robot interactive situations that happen in our everyday lives such as crossing a hallway, passing through a door and intersecting paths on wide open spaces. The proposed cooperative planning method compares favorably against other stat-of-the-art human-aware navigation planning schemes. We have augmented robot navigation behavior with synchronized and responsive movements of the robot head, making the robot look where it is going and occasionally diverting its gaze towards nearby people to acknowledge that robot will avoid any possible collision with them. At any given moment the robot weighs multiple criteria according to the social context and decides where it should turn its gaze. Through an online user study we have shown that such gazing mechanism effectively complements the navigation behavior and it improves legibility of the robot actions. Finally, we have integrated our navigation scheme with a broader supervision system which can jointly generate normative robot behaviors such as approaching a person and adapting the robot speed according to a group of people who the robot guides in airports or museums

Contextual information aided target tracking and path planning for autonomous ground vehicles

Recently, autonomous vehicles have received worldwide attentions from academic research, automotive industry and the general public. In order to achieve a higher level of automation, one of the most fundamental requirements of autonomous vehicles is the capability to respond to internal and external changes in a safe, timely and appropriate manner. Situational awareness and decision making are two crucial enabling technologies for safe operation of autonomous vehicles. This thesis presents a solution for improving the automation level of autonomous vehicles in both situational awareness and decision making aspects by utilising additional domain knowledge such as constraints and influence on a moving object caused by environment and interaction between different moving objects. This includes two specific sub-systems, model based target tracking in environmental perception module and motion planning in path planning module. In the first part, a rigorous Bayesian framework is developed for pooling road constraint information and sensor measurement data of a ground vehicle to provide better situational awareness. Consequently, a new multiple targets tracking (MTT) strategy is proposed for solving target tracking problems with nonlinear dynamic systems and additional state constraints. Besides road constraint information, a vehicle movement is generally affected by its surrounding environment known as interaction information. A novel dynamic modelling approach is then proposed by considering the interaction information as virtual force which is constructed by involving the target state, desired dynamics and interaction information. The proposed modelling approach is then accommodated in the proposed MTT strategy for incorporating different types of domain knowledge in a comprehensive manner. In the second part, a new path planning strategy for autonomous vehicles operating in partially known dynamic environment is suggested. The proposed MTT technique is utilized to provide accurate on-board tracking information with associated level of uncertainty. Based on the tracking information, a path planning strategy is developed to generate collision free paths by not only predicting the future states of the moving objects but also taking into account the propagation of the associated estimation uncertainty within a given horizon. To cope with a dynamic and uncertain road environment, the strategy is implemented in a receding horizon fashion