Kinodynamic planning and control of closed-chain robotic systems

Aplicat embargament des de la data de defensa fins el dia 1/6/2022This work proposes a methodology for kinodynamic planning and trajectory control in robots with closed kinematic chains. The ability to plan trajectories is key in a robotic system, as it provides a means to convert high-level task commands¾like “move to that location'', or “throw the object at such a speed''¾into low-level controls to be followed by the actuators. In contrast to purely kinematic planners, which only generate collision-free paths in configuration space, kinodynamic planners compute state-space trajectories that also account for the dynamics and force limits of the robot. In doing so, the resulting motions are more realistic and exploit gravity, inertia, and centripetal forces to the benefit of the task. Existing kinodynamic planners are fairly general and can deal with complex problems, but they require the state coordinates to be independent. Therefore, they are hard to apply to robots with loop-closure constraints whose state space is not globally parameterizable. These constraints define a nonlinear manifold on which the trajectories must be confined, and they appear in many systems, like parallel robots, cooperative arms manipulating an object, or systems that keep multiple contacts with the environment. In this work, we propose three steps to generate optimal trajectories for such systems. In a first step, we determine a trajectory that avoids the collisions with obstacles and satisfies all kinodynamic constraints of the robot, including loop-closure constraints, the equations of motion, or any limits on the velocities or on the motor and constraint forces. This is achieved with a sampling-based planner that constructs local charts of the state space numerically, and with an efficient steering method based on linear quadratic regulators. In a second step, the trajectory is optimized according to a cost function of interest. To this end we introduce two new collocation methods for trajectory optimization. While current methods easily violate the kinematic constraints, those we propose satisfy these constraints along the obtained trajectories. During the execution of a task, however, the trajectory may be affected by unforeseen disturbances or model errors. That is why, in a third step, we propose two trajectory control methods for closed-chain robots. The first method enjoys global stability, but it can only control trajectories that avoid forward singularities. The second method, in contrast, has local stability, but allows these singularities to be traversed robustly. The combination of these three steps expands the range of systems in which motion planning can be successfully applied.Aquest treball proposa una metodologia per a la planificació cinetodinàmica i el control de trajectòries en robots amb cadenes cinemàtiques tancades. La capacitat de planificar trajectòries és clau en un robot, ja que permet traduir instruccions d'alt nivell com ara ¿mou-te cap aquella posició'' o ¿llença l'objecte amb aquesta velocitat'' en senyals de referència que puguin ser seguits pels actuadors. En comparació amb els planificadors purament cinemàtics, que només generen camins lliures de col·lisions a l'espai de configuracions, els planificadors cinetodinàmics obtenen trajectòries a l'espai d'estats que són compatibles amb les restriccions dinàmiques i els límits de força del robot. Els moviments que en resulten són més realistes i aprofiten la gravetat, la inèrcia i les forces centrípetes en benefici de la tasca que es vol realitzar. Els planificadors cinetodinàmics actuals són força generals i poden resoldre problemes complexos, però assumeixen que les coordenades d'estat són independents. Per tant, no es poden aplicar a robots amb restriccions de clausura cinemàtica en els quals l'espai d'estats no admeti una parametrització global. Aquestes restriccions defineixen una varietat diferencial sobre la qual cal mantenir les trajectòries, i apareixen en sistemes com ara els robots paral·lels, els braços que manipulen objectes coordinadament o els sistemes amb extremitats en contacte amb l'entorn. En aquest treball, proposem tres passos per generar trajectòries òptimes per a aquests sistemes. En un primer pas, determinem una trajectòria que evita les col·lisions amb els obstacles i satisfà totes les restriccions cinetodinàmiques, incloses les de clausura cinemàtica, les equacions del moviment o els límits en les velocitats i en les forces d'actuació o d'enllaç. Això s'aconsegueix mitjançant un planificador basat en mostratge aleatori que utilitza cartes locals construïdes numèricament, i amb un mètode eficient de navegació local basat en reguladors quadràtics lineals. En un segon pas, la trajectòria s'optimitza segons una funció de cost donada. A tal efecte, introduïm dos nous mètodes de col·locació per a l'optimització de trajectòries. Mentre els mètodes existents violen fàcilment les restriccions cinemàtiques, els que proposem satisfan aquestes restriccions al llarg de les trajectòries obtingudes. Durant l'execució de la tasca, tanmateix, la trajectòria pot veure's afectada per pertorbacions imprevistes o per errors deguts a incerteses en el model dinàmic. És per això que, en un tercer pas, proposem dos mètodes de control de trajectòries per robots amb cadenes tancades. El primer mètode gaudeix d'estabilitat global, però només permet controlar trajectòries que no travessin singularitats directes del robot. El segon mètode, en canvi, té estabilitat local, però permet travessar aquestes singularitats de manera robusta. La combinació d'aquests tres passos amplia el ventall de sistemes en els quals es pot aplicar amb èxit la planificació cinetodinàmica.Postprint (published version

A randomized kinodynamic planner for closed-chain robotic systems

Kinodynamic RRT planners are effective tools for finding feasible trajectories in many classes of robotic systems. However, they are hard to apply to systems with closed-kinematic chains, like parallel robots, cooperating arms manipulating an object, or legged robots keeping their feet in contact with the environ- ment. The state space of such systems is an implicitly-defined manifold, which complicates the design of the sampling and steering procedures, and leads to trajectories that drift away from the manifold when standard integration methods are used. To address these issues, this report presents a kinodynamic RRT planner that constructs an atlas of the state space incrementally, and uses this atlas to both generate ran- dom states, and to dynamically steer the system towards such states. The steering method is based on computing linear quadratic regulators from the atlas charts, which greatly increases the planner efficiency in comparison to the standard method that simulates random actions. The atlas also allows the integration of the equations of motion as a differential equation on the state space manifold, which eliminates any drift from such manifold and thus results in accurate trajectories. To the best of our knowledge, this is the first kinodynamic planner that explicitly takes closed kinematic chains into account. We illustrate the performance of the approach in significantly complex tasks, including planar and spatial robots that have to lift or throw a load at a given velocity using torque-limited actuators.Peer ReviewedPreprin

Randomized kinodynamic planning for constrained systems

© 20xx IEEE. Personal use of this material is permitted. Permission from IEEE must be obtained for all other uses, in any current or future media, including reprinting/republishing this material for advertising or promotional purposes, creating new collective works, for resale or redistribution to servers or lists, or reuse of any copyrighted component of this work in other works.Kinodynamic RRT planners are considered to be general tools for effectively finding feasible trajectories for high-dimensional dynamical systems. However, they struggle when holonomic constraints are present in the system, such as those arising in parallel manipulators, in robots that cooperate to fulfill a given task, or in situations involving contacts with the environment. In such cases, the state space becomes an implicitly-defined manifold, which makes the diffusion heuristic inefficient and leads to inaccurate dynamical simulations. To address these issues, this paper presents an extension of the kinodynamic RRT planner that constructs an atlas of the state-space manifold incrementally, and uses this atlas both to generate random states and to dynamically steer the system towards such states. To the best of our knowledge, this is the first randomized kinodynamic planner that explicitly takes holonomic constraints into account. We validate the approach in significantly-complex systems.Postprint (author's final draft

Kinodynamic planning on constraint manifolds

This report presents a motion planner for systems subject to kinematic and dynamic constraints. The former appear when kinematic loops are present in the system, such as in parallel manipulators, in robots that cooperate to achieve a given task, or in situations involving contacts with the environment. The latter are necessary to obtain realistic trajectories, taking into account the forces acting on the system. The kinematic constraints make the state space become an implicitly-defined manifold, which complicates the application of common motion planning techniques. To address this issue, the planner constructs an atlas of the state space manifold incrementally, and uses this atlas both to generate random states and to dynamically simulate the steering of the system towards such states. The resulting tools are then exploited to construct a rapidly-exploring random tree (RRT) over the state space. To the best of our knowledge, this is the first randomized kinodynamic planner for implicitly-defined state spaces. The test cases presented validate the approach in significantly-complex systems.Peer ReviewedPreprin

Direct collocation methods for trajectory optimization in constrained robotic systems

© 2022 IEEE. Personal use of this material is permitted. Permission from IEEE must be obtained for all other uses, in any current or future media, including reprinting/republishing this material for advertising or promotional purposes, creating new collective works, for resale or redistribution to servers or lists, or reuse of any copyrighted component of this work in other works.Direct collocation methods are powerful tools to solve trajectory optimization problems in robotics. While their resulting trajectories tend to be dynamically accurate, they may also present large kinematic errors in the case of constrained mechanical systems, i.e., those whose state coordinates are subject to holonomic or nonholonomic constraints, such as loop-closure or rolling-contact constraints. These constraints confine the robot trajectories to an implicitly-defined manifold, which complicates the computation of accurate solutions. Discretization errors inherent to the transcription of the problem easily make the trajectories drift away from this manifold, which results in physically inconsistent motions that are difficult to track with a controller. This article reviews existing methods to deal with this problem and proposes new ones to overcome their limitations. Current approaches either disregard the kinematic constraints (which leads to drift accumulation) or modify the system dynamics to keep the trajectory close to the manifold (which adds artificial forces or energy dissipation to the system). The methods we propose, in contrast, achieve full drift elimination on the discrete trajectory, or even along the continuous one, without artificial modifications of the system dynamics. We illustrate and compare the methods using various examples of different complexity.This work was supported in part by the Spanish Ministry of Science, Innovation, and Universities under Project DPI2017-88282-P and Project PID2020-117509GBI00/AEI/10.13039/50110001103 and in part by the German Federal Ministry for Economic Affairs and Energy (BMWi) via DyConPV (0324166B)Peer ReviewedPostprint (author's final draft

A randomised kinodynamic planner for closed-chain robotic systems

© 2021 IEEE. Personal use of this material is permitted. Permission from IEEE must be obtained for all other uses, in any current or future media, including reprinting/republishing this material for advertising or promotional purposes, creating new collective works, for resale or redistribution to servers or lists, or reuse of any copyrighted component of this work in other worksKinodynamic rapidly-exploring random tree (RRT) planners are effective tools for finding feasible trajectories in many classes of robotic systems. However, they are hard to apply to systems with closed-kinematic chains, like parallel robots, collaborative arms manipulating an object, or legged robots keeping their feet in contact with the environment. The state space of such systems is an implicitly-defined manifold that complicates the design of the sampling and steering procedures, and leads to trajectories that drift from the manifold if standard integration methods are used. To address these issues, this article presents a kinodynamic RRT planner that constructs an atlas of the state space incrementally, and uses this atlas to generate random states, and to dynamically steer the system toward such states. The steering method exploits the atlas charts to compute locally optimal controls based on linear quadratic regulators. The atlas also allows the integration of the equations of motion using local coordinates, which eliminates any drift from the state space manifold and results in accurate trajectories. To the best of our knowledge, this is the first kinodynamic planner that explicitly takes closed kinematic chains into account. In this article, we illustrate the planner performance in significantly complex tasks involving planar and spatial robots that have to lift or throw a load using torque-limited actuators.This work has been partially funded by the Spanish Ministry of Science,Innovation, and Universities under project DPI2017-88282-PPeer ReviewedPostprint (author's final draft

A randomized kinodynamic planner for closed-chain robotic systems

Kinodynamic RRT planners are effective tools for finding feasible trajectories in many classes of robotic systems. However, they are hard to apply to systems with closed-kinematic chains, like parallel robots, cooperating arms manipulating an object, or legged robots keeping their feet in contact with the environ- ment. The state space of such systems is an implicitly-defined manifold, which complicates the design of the sampling and steering procedures, and leads to trajectories that drift away from the manifold when standard integration methods are used. To address these issues, this report presents a kinodynamic RRT planner that constructs an atlas of the state space incrementally, and uses this atlas to both generate ran- dom states, and to dynamically steer the system towards such states. The steering method is based on computing linear quadratic regulators from the atlas charts, which greatly increases the planner efficiency in comparison to the standard method that simulates random actions. The atlas also allows the integration of the equations of motion as a differential equation on the state space manifold, which eliminates any drift from such manifold and thus results in accurate trajectories. To the best of our knowledge, this is the first kinodynamic planner that explicitly takes closed kinematic chains into account. We illustrate the performance of the approach in significantly complex tasks, including planar and spatial robots that have to lift or throw a load at a given velocity using torque-limited actuators.Peer Reviewe

La circumnavigation de l'Arabie dans l'Antiquité classique

Salles Jean-Francois. La circumnavigation de l'Arabie dans l'Antiquité classique. In: L'Arabie et ses mers bordières. I. Itinéraires et voisinages. Séminaire de recherche 1985-1986. Lyon : Maison de l'Orient et de la Méditerranée Jean Pouilloux, 1988. pp. 75-102. (Travaux de la Maison de l'Orient, 16

Randomized planning of dynamic motions avoiding forward singularities

The final publication is available at link.springer.comForward singularities, also known as direct, or actuator singularities, cause many problems to the planning and control of robot motions. They yield position errors and rigidity losses of the robot, and generate unbounded actions in typical control laws. To circumvent these issues, this paper proposes a randomized kinodynamic planner for computing trajectories avoiding such singularities. Given initial and final states for the robot, the planner attempts to connect them by means of a dynamically-feasible, singularity-free trajectory that also respects the force limits of the actuators. The performance of the strategy is illustrated in simulation by means of a parallel robot performing a highly- dynamic task.Peer Reviewe