Multitasking collision-free motion planning algorithms in Euclidean spaces
Cesar A. Ipanaque Zapata, Jesus Gonzalez

TL;DR
This paper introduces optimal multitasking collision-free motion planning algorithms in Euclidean spaces, minimizing local planners and improving efficiency for systems with many moving objects.
Contribution
The paper develops new optimal algorithms for multitasking motion planning in Euclidean spaces, extending previous work and aiming for better efficiency in complex multi-object systems.
Findings
Algorithms are optimal with minimal local planners.
Expected to outperform previous algorithms in large multi-object systems.
Based on and extending prior work by Mas-Ku, Torres-Giese, and Farber.
Abstract
We present optimal motion planning algorithms which can be used in designing practical systems controlling objects moving in Euclidean space without collisions. Our algorithms are optimal in a very concrete sense, namely, they have the minimal possible number of local planners. Our algorithms are motivated by those presented by Mas-Ku and Torres-Giese (as streamlined by Farber), and are developed within the more general context of the multitasking (a.k.a.~higher) motion planning problem. In addition, an eventual implementation of our algorithms is expected to work more efficiently than previous ones when applied to systems with a large number of moving objects.
Peer Reviews
No public reviews on file for this paper yet. If you reviewed it on a platform where reviews are public (OpenReview, ICLR, NeurIPS, ICML), you can paste yours below so the community can read it here.
Videos
No videos yet. Explain this paper in a talk, walkthrough, or lecture? Add one.
Multitasking collision-free optimal motion planning algorithms in Euclidean spaces
Cesar A. Ipanaque Zapata
Departamento de Matemática,Universidade de São Paulo, Instituto de Ciências Matemáticas e de Computação - USP , Avenida Trabalhador São-carlense, 400 - Centro CEP: 13566-590 - São Carlos - SP, Brasil Departamento de Matemáticas, Centro de Investigación y de Estudios Avanzados del I. P. N. Av. Instituto Politécnico Nacional número 2508, San Pedro Zacatenco, Mexico City 07000, México [email protected]
and
Jesús González
Departamento de Matemáticas, Centro de Investigación y de Estudios Avanzados del I. P. N. Av. Instituto Politécnico Nacional número 2508, San Pedro Zacatenco, Mexico City 07000, México
Abstract.
We present optimal motion planning algorithms which can be used in designing practical systems controlling objects moving in Euclidean space without collisions. Our algorithms are optimal in a very concrete sense, namely, they have the minimal possible number of local planners. Our algorithms are motivated by those presented by Mas-Ku and Torres-Giese (as streamlined by Farber), and are developed within the more general context of the multitasking (a.k.a. higher) motion planning problem. In addition, an eventual implementation of our algorithms is expected to work more efficiently than previous ones when applied to systems with a large number of moving objects.
Key words and phrases:
Configuration spaces, topological complexity, higher motion planning algorithms
2010 Mathematics Subject Classification:
Primary 55R80; Secondary 55M30, 55P10, 68T40.
The first author would like to thank grant#2018/23678-6, São Paulo Research Foundation (FAPESP) for financial support.
1. Introduction
Let be the space of all possible obstacle-free configurations or states of a given autonomous system. For an -th sequential motion planning algorithm on is a function which, to any -tuple of configurations ( times), assigns a continuous motion of the system, so that starts at the given initial state , ends at the final desired state , and passes sequentially through the additional prescribed intermediate states . The fundamental problem in robotics, the motion planning problem, deals with how to provide, to any given autonomous system, with an -th sequential motion planning algorithm.
For practical purposes, an -th sequential motion planning algorithm should depend continuously on the -tuple of points . Indeed, if the autonomous system performs within a noisy environment, absence of continuity could lead to instability issues in the behavior of the motion planning algorithm. Unfortunately, a (global) continuous -th sequential motion planning algorithm on a space exists if and only if is contractible. Yet, if is not contractible, we could care about finding local continuous -th sequential motion planning algorithms, i.e., motion planning algorithms defined only on a certain open set of , to which we refer as the domain of definition of . In these terms, a motion planner on is a set of local continuous -th sequential motion planning algorithms whose domains of definition cover . The -th sequential topological complexity of , TC, is then the minimal cardinality among motion planners on , while a motion planner on is said to be optimal if its cardinality is TC. The design of explicit motion planners that are reasonably close to optimal is one of the challenges of modern robotics (see, for example Latombe [8] and LaValle [9]).
In more detail, the components of the multitasking motion planning problem via topological complexity are as follows:
Formulation 1.1**.**
Ingredients in the multitasking motion planning problem via topological complexity:
- (1)
The obstacle-free configuration space . The topology of this space is assumed to be fully understood in advance. 2. (2)
Query -tuples . The point is designated as the initial configuration of the query. The points in are designated as the prescribed intermediate configurations. The point is designated as the goal configuration.
In the above setting, the goal is to either describe an -th sequential motion planning algorithm, i.e., describe
- (3)
An open covering of ; 2. (4)
For each , an -th sequential planner, i.e., a continuous map satisfying
[TABLE]
for any (here stands for the free-path space on ),
or, else, report that such an algorithm does not exist.
Investigation of the problem of simultaneous collision-free sequential motion planners for distinguishable robots, each with state space , leads us to study the ordered configuration space of distinct points on (see [6]). Explicitly,
[TABLE]
topologised as a subspace of the Cartesian power . For our purposes, we ignore dynamics and other differential constraints, and we focus primarily on the translations required to move the robot. So we will have in mind an infinitesimal mass particle as an object (e.g., infinitesimally small ball). Namely, we consider our robots as points in the Euclidean space . The configuration space of each robot is determined by its position in . In other words, . Note that the -th coordinate of a point represents the state or position of the -th moving object, so that the condition reflects the collision-free requirement. Thus, a (local) -th sequential motion planning algorithm in assigns to any -tuple of configurations in (an open set of) a continuous curve of configurations
[TABLE]
such that for .
In this work we present two -th sequential motion planners in for any . Inspired by the work done for by Farber ([4]) and Mas-Ku and Torres-Giese ([10]), we present two -th sequential motion planners in for any . The first planner has domains of definition, works for any , and is optimal if is odd (in view of Theorem 2.8 below). The second planner, which is defined only for even, has regions of continuity and is optimal too (again by Theorem 2.8). The motion planning algorithms we present in this work are easily implementable in practice, and (for ) work more efficiently than those of Farber when the number of moving objects becomes large (see Remark 3.1).
Despite the multitasking motion planning problem is relatively new, its theoretical properties via topological complexity (a la Farber) have been studied intensively. Yet, concrete algorithms are scarce (only those coming from [4] and [10]), while specific implementations are inexistent. In fact, this work takes a first step in the direction of producing explicit algorithms.
2. Preliminary results
The concept of -th sequential topological complexity (also called -th “higher” TC) was introduced by Rudyak in [11], and further developed in [1]. Here we recall the basic definitions and properties.
For a topological space , let denote the space of free paths on with the compact-open topology. For , consider the evaluation fibration
[TABLE]
An -th sequential motion planning algorithm is a section of the fibration , i.e., a (not necessarily continuous) map satisfying . A continuous -th sequential motion planning algorithm in exists if and only if the space is contractible, which forces the following definition. The -th sequential topological complexity TC of a path-connected space is the Schwarz genus of the evaluation fibration (2.1). In other words the -th sequential topological complexity of is the smallest positive integer TC for which the product is covered by open subsets such that for any there exists a continuous section of over (i.e., ).
Example 2.1**.**
Suppose that is a convex subset of a Euclidean space . Given an -tuple of configurations , we may move with constant velocity along the straight line segment connecting and for each . This clearly produces a continuous algorithm for the -th sequential motion planning problem in . Thus we have TC.
Note that TC2 coincides with Farber‘s topological complexity, which is defined in terms of motion planning algorithms for a robot moving between initial-final configurations [5]. The more general TCn is Rudyak‘s higher topological complexity of motion planning problem, whose input requires, in addition of initial-final states, intermediate states of the robot. We will use the expression “motion planning algorithm” as a substitute of “-th sequential motion planning algorithm for ”.
The definition of TC deals with open subsets of admitting continuous sections of the evaluation fibration (2.1), yet for practical purposes, the construction of explicit -th sequential motion planning algorithms is usually done by partitioning the whole space into pieces, over each of which a continuous section for (2.1) is set. Since any such partition necessarily contains subsets which are not open (recall has been assumed to be path-connetected), we need to be able to operate with subsets of of a more general nature.
Definition 2.2**.**
A topological space is a Euclidean Neighbourhood Retract (ENR) if it can be embedded into an Euclidean space with an open neighbourhood , , admiting a retraction .
Example 2.3**.**
A subspace is an ENR if and only if it is locally compact and locally contractible, see [3, Chap. 4, Sect. 8]. This implies that all finite-dimensional polyhedra, manifolds and semi-algebraic sets are ENRs.
Definition 2.4**.**
Let be an ENR. An -th sequential motion planning algorithm is said to be tame if splits as a pairwise disjoint union , where each is an ENR, and each restriction is continuous. The subsets in such a decomposition are called domains of continuity for .
Proposition 2.5**.**
([11, Proposition 2.2])* For an ENR , TC is the minimal number of domains of continuity for tame -th sequential motion planning algorithms .*
Recall, that an -th sequential motion planning algorithm is called optimal when TC.
Given an -th sequential motion planning algorithm as above, one may organize the implementation as follows. Given an -tuple of configurations , we first find the subset such that and then we give the path as an output.
Remark 2.6**.**
In the final paragraph of the introduction we noted that in this paper we construct optimal -th sequential motion planners in . We can now be more precise: we actually construct -th sequential tame motion planning algorithms with the advertized optimality property.
Since (2.1) is a fibration, the existence of a continuous motion planning algorithm on a subset of implies the existence of a corresponding continuous motion planning algorithm on any subset of deforming to within . Such a fact is argued next in a constructive way, generalizing [4, Example 6.4] (the latter given for ). This of course suits best our implementation-oriented objectives.
Remark 2.7** (Constructing motion planning algorithms via deformations: higher case).**
Let be a continuous motion planning algorithm defined on a subset of . Suppose a subset can be continuously deformed within into . Choose a homotopy such that and for any . Let be the Cartesian components of , . As schematized in the picture
[TABLE]
(where runs from top to bottom and runs from left to right), the path connects in sequence the points , , i.e.,
[TABLE]
whereas the formula
[TABLE]
defines a continuous section of (2.1) over . Note that
[TABLE]
where is the restriction of to the segment
[TABLE]
i.e.,
[TABLE]
for . Summarizing: a deformation of into and a continuous motion planning algorithm defined on determine an explicit continuous motion planning algorithm defined on .
The final ingredient we need is the value of TC, computed by González and Grant in [7].
Theorem 2.8**.**
*([7])*For ,
[TABLE]
3. Optimal tame motion planning algorithm in
In this section we make minor modifications in the tame motion planning algorithms described by Farber in [4] for . As noted in the introduction, the first advantage of our streamlined algorithm is that an implementation will run more efficiently when the number of moving objects becomes large (see Remark 3.1). The second advantage is that the streamlined algorithm generalizes to the multitasking (sequential) motion planning realm (Section 4).
3.1. Giese-Mas’ motion planning algorithm in revisited
3.1.1. Section over
We think of as a subspace of via the embedding , . Consider the first two standard basis elements and in (we assume ). Given two configurations and in , let be the path in from to depicted in Figure 1.
Explicitly, has components defined by
[TABLE]
This yields a continuous motion planning algorithm .
Remark 3.1**.**
The algorithm plays the role of the section in [4, Equation (18)]. In that work, is constructed via a concatenation process which, in our notation, involves having constructed, in advance, paths. An implementation of this motion planning algorithm is bound to have complexity issues for large values of (i.e., when the number of moving particles is large). We avoid the problem with the explicit formula (3.1).
3.1.2. The sets .
Let denote the projection onto the first coordinate. For a configuration , denotes the cardinality of the set of projection points . Note that ranges in . Let denote the set of all configurations with . is an ENR, because it is a semi-algebraic set. Note that the closure of each set is contained in the union of the sets with :
[TABLE]
Remark 3.2**.**
The map given by the formula
[TABLE]
where , defines a continuous deformation of onto inside (see Figure 2). In particular, and the case in Remark 2.7 yield a continuous motion planning algorithm defined on .
For a configuration , set
[TABLE]
In addition, for as above and , set
[TABLE]
where for . This defines a continuous “desingularization” deformation of into inside (see Figure 3). As in Remark 3.2, this yields a continuous motion planning algorithm on any subset , for .
3.1.3. Combining regions of continuity.
We have constructed continuous motion planning algorithms
[TABLE]
by applying iteratively the construction in Remark 2.7. For , the sets are pairwise disjoint ENR’s covering . The resulting estimate TC is next improved by noticing that the sets can be repacked into pairwise disjoint ENR’s each admitting its own continuous motion planning algorithm. Indeed, (3.2) implies that and are “topologically disjoint” in the sense that , provided and . Consequently, for the motion planning algorithms having determine a (well-defined) continuous motion planning algorithm on the ENR
[TABLE]
We have thus constructed a (global) tame motion planning algorithm in having the domains of continuity (see Figure 4).
3.2. Farber’s motion planning algorithm in revisited
We now improve the motion planning algorithm in of the previous section under the assumption (in force throughout this subsection) that is even. The improved motion planning algorithm will have domains of continuity.
The first steps are nearly identical to those in the previous subsection: For a configuration , consider the affine line through the points and , oriented in the direction of the unit vector
[TABLE]
and let denote the line passing through the origin and parallel to (with the same orientation as ). Let be the orthogonal projection, and let be the cardinality of the set . Note that ranges in . For , let denote111Beware that stands for a different set than the set with the same notation in Subsection 3.1. the set of all configurations with . The various are ENR’s satisfying
[TABLE]
3.2.1. Desingularization
For a configuration , set
[TABLE]
In addition, for as above and , set
[TABLE]
where for . This defines a continuous “desingularization” deformation of into inside . Note that neither the lines and nor their orientations change under the desingularization, i.e., , , and for all .
3.2.2. The sets and
For let
[TABLE]
The sets and are ENR’s (for they are semi-algebraic) covering that satisfy
[TABLE]
in view of (3.4). We also consider subsets and of defined by
[TABLE]
as well as subsets and defined by
[TABLE]
Here a configuration is colinear if in fact . Note that is the set of all pairs of colinear configurations, whereas is the subset of colinear configurations such that and agree and pass through the origin.
3.2.3. Deformations
Next we define homotopies
[TABLE]
deforming into and into respectively, i.e., such that
- (1)
and , 2. (2)
and .
The deformation : Given a pair , we apply first the desingularization deformations and in order to take the pair into a pair of configurations (recall and ). Next we apply the analogue of the linear deformation (3.3), with and replacing , in order to take the pair into a pair of colinear configurations . The deformation is the concatenation of the two deformations just described.
The deformation : Given a pair , we apply first the desingularization deformations and in order to take the pair into a pair of configurations . Next we apply the analogue of the linear deformation (3.3) in order to take the pair into a pair of colinear configurations . The deformation is the corresponding concatenated deformation.
3.2.4. Deformations and
Next we deform into and into by homotopies and defined as follows. Let be a pair of colinear configurations in (so ). First, making parallel translation, we deform into a pair of colinear configurations for which and , i.e., so that both lines and pass through the origin (note that and ). We then view and as points of the unit sphere and, since they are not antipodal, we have the minimal-length geodesic path in
[TABLE]
joining to . This describes a rotation (pivoting at the origin) of the line towards the line which “drags” into a linear configuration with and . This produces a deformation of into the pair of colinear configurations . The desired homotopy is the resulting concatenated deformation.
The homotopy is defined analogously but in a simpler manner, as we do not need the second half of the deformation used in the case of . Indeed, we only need the portion of the deformation coming from parallel translation in order to define .
3.2.5. Section over
Let be the set of pairs of colinear configurations such that . Formula (3.1) defining the motion planning algorithm at the beginning of our revision of Giese-Mas’ motion planning algorithm is readily adaptable to yield a continuous motion planning algorithm
[TABLE]
provided is even (this is the only place where the hypothesis about the parity of is used). Informally—but rather transparently—, the axis in Figure 1 is replaced by the common line oriented via , whereas the “shifting” direction in Figure 1 is replaced by . Here denotes a fixed unitary tangent vector field on , say with . Explicitly, if and , then the path in from to has components defined by
[TABLE]
Since , the restriction of yields continuous motion planning algorithms on as well as on .
3.2.6. Repacking regions of continuity
As explained in Remark 2.7, we can combine the continuous motion planning algorithm with the concatenation of the deformations discussed so far to obtain continuous motion planning algorithms
[TABLE]
for . The corresponding upper bound TC is improved by repacking these regions of continuity. Set
[TABLE]
for . For instance . In view of (3.5), the sets assembling each are topologically disjoint, so the sets are ENR’s covering on each of which the corresponding algorithms in (3.6) assemble a continuous motion planning algorithm. We have thus constructed a tame motion planning algorithm in having regions of continuity .
4. A higher tame motion planning algorithm in
In this section we present two optimal tame -th sequential motion planning algorithms in , which generalize in a natural way the algorithms presented in the previous section. As indicated in the introduction, the first algorithm has regions of continuity, works for any , and is optimal when is odd. The second algorithm, which is defined when is even, has regions of continuity and is optimal. The algorithms we present in this section can be used in designing practical systems controlling sequential motion of many objects moving in Euclidean space without collisions.
4.1. A higher motion planning algorithm in for any
A version of the algorithm developed in this subsection is the topic in Borat’s work [2]. As explained in Remark 3.1, our version is more convenient for implementation purposes.
4.1.1. Section over
Recall we take the standard embedding , so that is naturally a subspace of . The motion planning algorithm given by (3.1) yields a continuous -th motion planning algorithm
[TABLE]
given by concatenation of paths (see Figure 7.)
[TABLE]
4.1.2. Motion planning algorithms
We now go back to the notation introduced in Subsection 3.1.2 where, for , we constructed ENR’s covering , as well as concatenated homotopies deforming into . Together with the motion planning algorithm , these deformations yield, by Remark 2.7, continuous -th motion planning algorithms
[TABLE]
Indeed, the desingularization deformation takes into ; then we apply the deformation which takes into ; and finally we apply Remark 2.7. Let us emphasise that the above description of is fully implementable.
4.1.3. Combining regions of continuity.
The ENR’s , , are mutually disjoint and cover the whole product . The resulting estimate TC coming from Proposition 2.5 and the motion planning algorithms are now improved by combining the domains of continuity to yield covering ENR’s , , each admitting a continuous -th motion planning algorithm. Explicitly, let
[TABLE]
where . By (3.2), any two distinct -tuples and with determine topologically disjoint sets and in , i.e., . Therefore the motion planning algorithms with jointly define a continuous motion planning algorithm on . We have thus constructed a tame -th sequential motion planning algorithm in having domains of continuity .
4.2. An optimal higher motion planning algorithm in for even
In this section we improve the -th sequential motion planning algorithm in of the previous section under the assumption (in force throughout the section) that is even. The improved -th motion planning algorithm has domains of continuity, and is therefore optimal (Theorem 2.8). This gives the higher-TC analogue of the construction in Subsection 3.2.
4.2.1. The sets
For a configuration , we now bring the notation , , , and in Subsection 3.2 back to use. For and we denote by the set of all -tuples of configurations satisfying
- •
for , and
- •
the -tuple has exactly antipodes to .
The sets are pairwise disjoint ENR’s covering . As in Subsection 3.2, the goal is to construct a continuous -th motion planning algorithm on each , and then make a suitable repacking of these domains.
Example 4.1**.**
For , we have and (see Subsection 3.2.2).
In view of (3.4), for and as above, we have
[TABLE]
The sets and
For , let denote the set of all -tuples of colinear configurations such that the -tuple has exactly antipodes to . Consider in addition the subsets consisting of all -tuples of colinear configurations such that and for all .
4.2.2. Deformations
Next we define homotopies
[TABLE]
deforming into , i.e., such that
[TABLE]
Explicitly, given an -tuple , we apply first the -tuple of desingularization deformations in order to take the -tuple into an -tuple of configurations (note this yields with ). Next we apply the corresponding analogues of the linear deformation (3.3) in order to take the -tuple into an -tuple of colinear configurations (once again with ). The deformation is the concatenation of the two deformations just described.
4.2.3. Deformation
Homotopies , for , deforming into are defined next. Let be an -tuple of colinear configurations in . First, making parallel translation, we deform into an -tuple of colinear configurations for which each line passes through the origin (note that this is done so that for ). Continuity on of this deformation is obvious. We then view each as a point of the unit sphere and, whenever is not antipodal to , we have the minimal-length geodesic path in ,
[TABLE]
joining to . This describes a rotation (pivoting at the origin) of the line towards the line which “drags” into a linear configuration with and . This produces a deformation of into an -th tuple of colinear configurations , where we set whenever and are antipodal, in which case the “deformation” of into is stationary. Continuity on of this second deformation holds because it does not leave the (fixed) domain . The desired homotopy is the resulting concatenated deformation.
4.2.4. An -th motion planning algorithm on each
In Subsection 3.2.5 we constructed a continuous motion planning algorithm on the set consisting of all pairs of colinear configurations such that . More generally, we now let stand for the set of all -tuples of colinear configurations such that . Then a continuous -th motion planning algorithm is given by concatenation of paths,
[TABLE]
Since each is a subset of , the deformations discussed so far yield, in view of Remark 2.7, -th continuous motion planning algorithms for and .
4.2.5. Repacking regions of continuity
The sets are pairwise disjoint ENR’s covering on each of which we have constructed a continuous -th motion planning algorithm. The upper bound TC given by Proposition 2.5 is next improved with a suitable repacking of the domains . Set
[TABLE]
for . For instance,
[TABLE]
From (4.3), the sets assembling each are topologically disjoint, so the various sets are pairwise disjoint ENR’s covering on each of which the corresponding algorithms assemble a continuous -th motion planning algorithm. We have thus constructed a (global) tame -th sequential motion planning algorithm in having regions of continuity .
The reference list from the paper itself. Each links out to its DOI / PubMed record.
- 1[1] I. Basabe, J. González, Y.B. Rudyak and D. Tamaki, ‘Higher topological complexity and its symmetrization’ , Algebr. & Geom. Topol. 14 (2014), no. 4, 2103–2124.
- 2[2] A. Borat, ‘Motion planning algorithms for configuration spaces in the higher dimensional case’ , Topol. Methods Nonlinear Anal. 47 (2016), no. 2, 763–767.
- 3[3] A. Dold, ‘Lectures on algebraic topology’ , Springer Science & Business Media. (2012).
- 4[4] M. Farber, ‘Configuration spaces and robot motion planning algorithms’ , in: Combinatorial and Toric Homotopy: Introductory Lectures (eds. A. Darby, J. Grbic and J. Wu) (World Scientific, Singapore, 2017), 263–303.
- 5[5] M. Farber, ‘Topological complexity of motion planning’ , Discrete and Computational Geometry. 29 (2003), no. 2, 211–221.
- 6[6] E. Fadell and L. Neuwirth, ‘Configuration spaces’ . Math. Scand. 10 (4) (1962), 111-118.
- 7[7] J. González, and M. Grant, ‘ Sequential motion planning of non-colliding particles in Euclidean spaces’ , Proceedings of the American Mathematical Society. 143 (2015), no. 10, 4503–4512.
- 8[8] J.-C. Latombe, ‘Robot motion planning’ (Springer, New York, 1991).
