A criterion for DW and FD* integration is proposed, which makes comparison of the current possible robot trajectories and the geometric global path by applying
the global objective function
expressed as weighted sum of objective measures for clearance
and path alignment
(v,) = + (1 - ),
is the weighting factor.
Path alignment measure relates possible robot trajectories with the local geometric path configuration and thus improves the restrictions on the translational velocity and also determines the local target heading direction. This restriction of the linear velocity is the key element since the velocity is adaptive according to the local path configuration.
The path alignment measure
for a robot trajectory is defined according to the following expression:
(v,) = 1 - .
A trajectory generated by DW, which is a circular arc, is represented by a discrete set of points Nt
. Trajectory length Lt
is set according to the velocity tuple
which characterize current trajectory and the time look-ahead Tmax
beyond which all trajectories are considered clear of obstacles
Lt(v,) = vTmax
is a set of points on the so called effective path and dij
is the Euclidean distance between the i
-th point on the trajectory and j
-th point on the effective path.
The number of points on both curve is fixed. When choosing these numbers one must consider computation complexity in one hand and a quality of approximation of the curves in another hand. In our work, we have assumed number of Np = 10
points to be valid approximation of straight line segment and number of Nt = 30
points to be valid approximation of circular trajectories (see Fig. 6).
The effective path and robot trajectory comparison
When the number of points is fixed, resolution of the curves depends only on the velocities: higher velocities mean more rarely distributed points.
The limit values
Dmin = jdij
Dmax = jdij
are used for normalization along all possible robot trajectories.
The index factor j
that weights the distance contributions is introduced to penalize more points at the end of the trajectories which define the trajectory deviation from the global path more than the starting points on different trajectories, since they all start from the same robot position.
The so called effective path is the straight line segment connecting the current robot position and a reference point on the path. Its orientation determines the current reference orientation of the robot in relation to the local path configuration affecting the rotational velocity of the robot
and its length determines what the optimal translational velocity vref
should be. Reference point on the path has assigned constant time Tmax
(admissible collision time) as a fixed travelled time from the current robot position to the reference point.
The nominal reference point position is at the point immediately before the second path direction change (path direction changes are multiples of
), as can be seen in Fig. 7.
Determing the nominal reference point position on the global geometric path
This assumption is based on the fact that detecting the first path direction change which altered the path direction for
starting from the robot position is not enough to determine the tendency of the path change thereafter. The second path direction change then determines whether the path direction changed back to its original direction or continued changing which signifies a stronger curvature change and therefore gives a good local curve tendency information.
Due to dynamic constraints of the robot, a distance between the reference point position on global path and robot current position R(vc)
is upperbounded by a maximum translational velocity
vc + t
, that can be accessed in the next time interval t
for the current robot velocity vector (
, and the time look-ahead Tmax
(see Fig. 8):
Rmax(vc) = (vc + t)Tmax.
Therefore, its length is adaptively increased as the robot speeds up or vice-versa.
Determing the upperbounded reference point position on the global geometric path
If the path direction change is detected in the immediate vicinity of the robot (for instance, the grid-cell next to the robot position), its direction change impact on the robot is not significant. Therefore, a distance between the reference point position on global path and robot current position is lowerbounded with Rmin
that filters out the insignificant path direction changes that would slow down the robot but would not change its global position much (see Fig. 9).
Determing the lowerbounded reference point position on the global geometric path
It is effectively set according to the maximal breakage time
so the robot could stop along the minimal effective path length if it previously achieved maximal translation velocity:
Rmin = vmaxTbmax - T2bmax = T2bmax.
Therefore, a minimal reference translation velocity would be