Chapter 18 - Distances in Mathematical Engineering

Whole-body motion and footstep planning for humanoid robots with multi-heuristic search

This paper presents a new type of leg-wheeled robot, which is constructed with passive wheels and the idea of reduced degrees of freedom (DOF). Even though there are variety types of mobile robots researched, some of them cannot be used practical purpose because of their high number of DOF, resulting in complex structure and complicated control system. Typical leg-wheeled robots also have a high number of DOF, and because of that, it is very difficult to put them in practical purpose. Thus, we try to develop another type of leg-wheeled robot with reduced DOF, which only have 10 DOF even though they have 6 legs. The motion plan for the robot discussed in previous study was simply moving forward, and those motion plans cannot be applied for moving omnidirectionaly. Therefore, we propose new motion plans, which can be applied for moving in omnidirection, and more details about the motion planning of moving forward by using the new motion plan.

Traditional motion planning can be computationally burdensome for practical robots, due to extensive collision checking and considerable iterative propagation of cost values. We present a novel neural network architecture which can directly generate the cost-to-go (c2g) function for a given configuration space and a goal configuration. The output of the network is a continuous function whose gradient in configuration space can be directly used to generate trajectories in motion planning without the need for protracted iterations or extensive collision checking. This higher order function (i.e. a function generating another function) representation lies at the core of our motion planning architecture, c2g-HOF, which can take a workspace as input, and generate the cost-to-go function over the configuration space map (C-map). Simulation results for 2D and 3D environments show that c2g-HOF can be orders of magnitude faster at execution time than methods which explore the configuration space during execution. We also present an implementation of c2g-HOF which generates trajectories for robot manipulators directly from an overhead image of the workspace.

This work presents an efficient framework to generate a motion plan of a robot with high degrees of freedom (e.g., a humanoid robot). High-dimensionality of the robot configuration space often leads to difficulties in utilizing the widely-used motion planning algorithms, since the volume of the decision space increases exponentially with the number of dimensions. To handle complications arising from the large decision space, and to solve a corresponding motion planning problem efficiently, two key concepts are adopted in this work: First, the Gaussian process latent variable model (GP-LVM) is utilized for low-dimensional representation of the original configuration space. Second, an approximate inference algorithm is used, exploiting through the duality between control and estimation, to explore the decision space and to compute a high-quality motion trajectory of the robot. Utilizing the GP-LVM and the duality between control and estimation, we construct a fully probabilistic generative model with which a high-dimensional motion planning problem is transformed into a tractable inference problem. Finally, we compute the motion trajectory via an approximate inference algorithm based on a variant of the particle filter. The resulting motions can be viewed in the supplemental video. ( https://youtu.be/kngEaOR4Esc )

This paper describes a new approach to robot motion planning that combines the end-point motion planning with joint trajectory planning for collision avoidance of the links. Local and global methods are proposed for end-point motion planning. The joint trajectory planning is achieved through a pseudoinverse kinematic formulation of the problem. This approach enables collision avoidance of the links by a fast null-space vector computation. The power of the proposed planner derives from: its speed; the good properties of the potential function for end-point motion planning; and from the simultaneous avoidance of the links collision, kinematic singularities, and local minima of the potential function. The planner is not defined over computationally expensive configuration space and can be applied for real-time applications. The planner shows to be faster than many previous planners and can be applied to robots with many degrees of freedom. The effectiveness of the proposed local and global planning methods as well as the general robot motion planning approach have been experimented using the computer-simulated robots. Some of the simulation results are included in this paper.

Recent progress in motion planning has made it possible to determine homotopy inequivalent trajectories between an initial and terminal configuration in a robot configuration space. Current approaches have however either assumed the knowledge of differential one-forms related to a skeletonization of the collision space, or have relied on a simplicial representation of the free space. Both of these approaches are currently however not yet practical for higher dimensional configuration spaces. We propose 2D topological task projections (TTPs): mappings from the configuration space to 2-dimensional spaces where simplicial complex filtrations and persistent homology can identify topological properties of the high-dimensional free configuration space. Our approach only requires the availability of collision free samples to identify winding centers that can be used to determine homotopy inequivalent trajectories. We propose the Winding Augmented RRT and RRT* (WA-RRT/RRT*) algorithms using which homotopy inequivalent trajectories can be found. We evaluate our approach in experiments with configuration spaces of planar linkages with 2–10 degrees of freedom. Results indicate that our approach can reliably identify suitable topological task projections and our proposed WA-RRT and WA-RRT* algorithms were able to identify a collection of homotopy inequivalent trajectories in each considered configuration space dimension.

Optimal Mesh Algorithms for the Voronoi Diagram of Line Segments and Motion Planning in the Plane

In this paper, we discuss the field of sampling-based motion planning. In contrast to methods that construct boundary representations of configuration space obstacles, samplingbased methods use only information from a collision detector as they search the configuration space. The simplicity of this approach, along with increases in computation power and the development of efficient collision detection algorithms, has resulted in the introduction of a number of powerful motion planning algorithms, capable of solving challenging problems with many degrees of freedom. First, we trace how sampling-based motion planning has developed. We then discuss a variety of important issues for sampling-based motion planning, including uniform and regular sampling, topological issues, and search philosophies. Finally, we address important issues regarding the role of randomization in sampling-based motion planning.

We present a general search strategy called SANDROS for motion planning, and its applications to motion planning for three types of robots: (1) manipulator; (2) rigid object; and (3) multiple rigid objects. SANDROS is a dynamic-graph search algorithm, and can be described as a hierarchical, nonuniform-multiresolution, best-first search to find a heuristically short motion in the configuration space. The SANDROS planner is resolution complete, and its computation time is commensurate with the problem difficulty measured empirically by the solution-path complexity. For many realistic problems involving a manipulator or a rigid object with six degrees of freedom, its computation times are under 1 minute for easy problems involving wide free space, and several minutes for relatively hard problems.

A topological theory initiated recently by the author uses methods of algebraic topology to estimate numerically the character of instabilities arising in motion planning algorithms. The present paper studies random motion planning algorithms and reveals how the topology of the robot's configuration space influences their structure. We prove that the topological complexity of motion planning TC(X) coincides with the minimal n such that there exists an n-valued random motion planning algorithm for the system; here $X$ denotes the configuration space. We study in detail the problem of collision free motion of several objects on a graph G. We describe an explicit motion planning algorithm for this problem. We prove that if G is a tree and if the number of objects is large enough, then the topological complexity of this motion planning problem equals 2m(G)+1 where m(G) is the number of the essential vertices of G. It turns out (in contrast with the results on the collision free control of many objects in space obtained earlier jointly with S. Yuzvinsky) that the topological complexity is independent of the number of particles.

Visual feedback can play a crucial role in a dynamic robotic task such as the interception of a moving target. To utilize the feedback effectively, there is a need to develop robot motion planning techniques that also take into account properties of the sensed data. We propose a motion planning framework that achieves this with the help of a space called the perceptual control manifold (PCM) defined on the product of the robot configuration space and an image-based feature space. We show how the task of intercepting a moving target can be mopped to the PCM. This leads to the generation of motion plans that satisfy various constraints and optimality criteria derived from the robot kinematics, the control system, and the sensing mechanism.

Motion planning is an already old and classical problem in Robotics. A few years ago a new instance of this problem has appeared in the literature : motion planning for nonholonomic systems. While useful tools in motion planning come from Computer Science and Mathematics (Computational Geometry, Real Algebraic Geometry), nonholonomic motion planning needs some Control Theory and more Mathematics (Differential Geometry).

Certain species of ants can carry out tasks in dense work spaces while maintaining their ability to accurately manipulate heavy loads, and these advantages are of interest to the robotics community. We consider a robotic swarm of $N\ge 6$ agents that assumes the task of moving a load through a cluttered space. This forces the swarm to carefully manipulate the orientation of the load, while transporting it to its destination point. We model this scenario as a 6-PPSS (Prismatic-Prismatic-Spherical-Spherical) redundant mobile platform, having six degrees of freedom. As with insects, the multitude of agents enables sharing the burden of the load in the case that one or more agents are blocked by an obstacle. We model this by a semi-algebraic set of constraints on the distances between the agents and the load. We apply an Extended Kalman Filter routine, in order to estimate their relative locations. We show how the estimation-error is reduced when position-information is shared among the agents. These estimations are then used to calculate the full configuration and investigate the effect of position estimation error on the platform heading error. We show how motion planning can then be calculated in the model's full configuration space and demonstrate this with a distributed control scheme. To reduce the search time, we introduce a variant of the crawling probabilistic road map motion planning algorithm under a set of kinematic constraints and work-space obstacles. Finally, we exemplify our algorithms on several simulated scenarios.

Configuration space (C-space) plays an important role not only in motion planning but also in geometric modeling, shape and kinematic reasoning, and is fundamental to several basic geometric operations, such as continuous collision detection and generalized penetration depth estimation, that also find their applications in motion planning, animation and simulation. In this paper, we developed a new method for constructing the boundary of the C-space obstacles (C-obst) of polygons. This method is simpler to implement and is theoretically more efficient than the existing techniques. Our main idea is to devote the computation on the discontinuity in temporal and spatial coherence where the structure of the C-obst changes. We also developed a method for estimating the generalized penetration depth by computing the distance between the query point and the C-obst surface.

Steerable needles composed of a highly flexible material and with a bevel tip offer greater mobility compared to rigid needles for minimally invasive medical procedures. In this paper, we apply sampling-based motion planning technique to explore motion planning for the steerable bevel-tip needle in 3D environments with obstacles. Based on the Rapidly-exploring Random Trees (RRTs) method, we develop a motion planner to quickly build a tree to search the configuration space using a new exploring strategy, which generates new states using randomly sampled control space instead of the deterministically sampled one used in classic RRTs. Notice the fact that feasible paths might not be found for any given entry point and target configuration, we also address the feasible entry point planning problem to find feasible entry points in a specified entry zone for any given target configuration. To solve this problem, we developed a motion planning algorithm based on RRTs with backchaining, which grow backward from the target to explore the configuration space. Finally, simulation results with a approximated realistic prostate needle insertion environment demonstrate the performance of the proposed motion planner.