*Proceeding Paper* **Optimality Conditions for the Principle of Trajectory Division †**

**Valentin Bereznev**

Federal Research Center Computer Science and Control of RAS, Vavilov Str. 44, build.2, Moscow 119333, Russia; va\_bereznev@mail.ru; Tel.: +7-915-167-0295

† Presented at the 15th International Conference "Intelligent Systems" (INTELS'22), Moscow, Russia,

14–16 December 2022.

**Abstract:** This paper considers the problem of controlling a mobile robot in the presence of circular obstacles. To solve this problem, it is proposed to use the previously suggested principle of dividing permissible trajectories into a sequence of rectilinear sections and arcs of circles that are the boundaries of circular obstacles. The conditions for the solution based on this principle of optimality are obtained.

**Keywords:** controlling a mobile robot; principle of dividing the feasible trajectory; optimality conditions

Suppose that the problem of controlling a mobile robot is solved using the principle of dividing feasible trajectories [1]. In the case of the phase space R2, this principle is an alternative to the classical optimal control theory based on the maximum principle [2]. According to this principle, a connected graph is first constructed, then the shortest path on the graph is searched. Taking into account that it is not the distance between the vertices that is used as the edges of the graph, but rather the minimum time rewuired for the robot to travel along the edge, we can assume that the time-optimal problem has been solved. However, this is true only under the essential condition that the robot, in bypassing a circular obstacle, always moves along the border of the obstacle, i.e., that the minimum allowable radius of curvature of the route is selected on the turn. Nevertheless, there is doubt that such a choice is always optimal in terms of performance. This is clearly seen in the example of auto racing, when, in seeking to overtake an opponent, the driver tries to avoid heavy braking on a curve, instead choosing a larger radius of curvature. If the driver chooses too high a speed at this point, slippage may occur, i.e., loss of grip with the surface of the track, resulting in displacement in the direction of the centrifugal force of inertia or even in the vehicle overturning.

On this basis, let us consider the main factors influencing the reasonable choice of the radius of curvature for the trajectory of the device when bypassing a circular obstacle. As already noted, an object moving along the arc of a circle is affected by the so-called centrifugal force of inertia *F*, which acts along the radius from the center of the circle and is calculated by the formula

$$F = m\omega r^2 r\_\prime$$

where *m* is the mass of the object, *ω* is its angular speed, and *r* is the radius of the circle. This force is opposed by the force *G* of adhesion to the surface of the highway acting in the opposite direction, which is determined by weather conditions, the condition of the road surface, and the wheels of the car or robot.

Let us consider a concrete example (see Figure 1) in which a controlled device must move from point *A* to point *B* while bypassing a circular obstacle of radius *r*<sup>1</sup> (a circle of dark color) or an obstacle of radius *r*<sup>2</sup> > *r*<sup>1</sup> (a circle of light color).

For simplicity, assume that the distances from points *A* and *B* to the center of the circles are the same and are equal to *S*. The points *C*, *D*, *M*, and *N* are the tangent points of the lines drawn from *A* and *B* to the small and large circles. Let us define the conditions under

**Citation:** Bereznev, V. Optimality Conditions for the Principle of Trajectory Division. *Eng. Proc.* **2023**, *33*, 2. https://doi.org/10.3390/ engproc2023033002

Academic Editors: Askhat Diveev, Ivan Zelinka, Arutun Avetisyan and Alexander Ilin

Published: 9 May 2023

**Copyright:** © 2023 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (https:// creativecommons.org/licenses/by/ 4.0/).

which, from the point of view of time consumption, it is preferable to bypass a circular obstacle along an arc of a small radius or along an arc of a large one, provided that *m*<sup>1</sup> = *m*<sup>2</sup> = *m* and

$$F\_i = m\omega\_i^2 r\_i = G, \quad i = 1, 2,\tag{1}$$

i.e., the passage of the turn is guaranteed against slippage.

**Figure 1.** Passage of a vmrage with a different radius.

Let *r*<sup>2</sup> = *γr*1, *γ* > 1. Note that the coefficient *γ* cannot be arbitrarily large, as at *γ* > *S*/*r*<sup>1</sup> point *A* already falls inside the circle and the task loses its meaning. Due to the symmetry of the tracks in both cases with respect to a straight line passing through the center of the circles parallel to the ordinate axis, we estimate the time of passage of the left half of the trajectories. Let us first determine the time spent on moving along the arcs of circles. Suppose that the linear speed of motion along a small arc, corresponding to the fulfillment of the condition (3) at *i* = 1, is equal to *v*<sup>1</sup> = *v*<sup>−</sup> and determines the feasible linear speed *v*2. It follows from (3) that *ω*<sup>2</sup> = *ω*<sup>1</sup> 1/*γ*, i.e., *<sup>ω</sup>*<sup>2</sup> < *<sup>ω</sup>*1. As is well known, *vi* = *ωiri*, *i* = 1, 2; therefore, *v*<sup>2</sup> = *ω*2*γr*<sup>1</sup> = *ω*1*r*<sup>1</sup> <sup>√</sup>*<sup>γ</sup>* <sup>=</sup> *<sup>v</sup>*<sup>1</sup> <sup>√</sup>*<sup>γ</sup>* <sup>&</sup>gt; *<sup>v</sup>*<sup>1</sup> <sup>=</sup> *<sup>v</sup>*−.

It is easy to see that the angles based on the half-arcs of the circles are equal to *α*<sup>1</sup> = arcsin (*r*1/*S*) and *α*<sup>2</sup> = arcsin (*γr*1/*s*), respectively. Then, the lengths of the arcs themselves are *s*<sup>1</sup> = *r*1*α*<sup>1</sup> and *s*<sup>2</sup> = *γr*1*α*2. Due to the uniform motion along these arcs with speeds *v*<sup>1</sup> and *v*<sup>2</sup> = *v*<sup>1</sup> <sup>√</sup>*γ*, we obtain expressions for time *<sup>t</sup>*<sup>11</sup> <sup>=</sup> *<sup>r</sup>*1*α*1/*v*<sup>1</sup> and *<sup>t</sup>*<sup>12</sup> <sup>=</sup> *<sup>r</sup>*<sup>1</sup> <sup>√</sup>*γα*2/*v*1. Thus,

$$
\Delta T\_1 = t\_{12} - t\_{11} = \frac{r\_1(\sqrt{\gamma}u\_2 - u\_1)}{v\_1} > 0,\tag{2}
$$

as the expression in parentheses is obviously positive.

Now, let us estimate the time for the device to pass straight-line line break sections of the route to the points of contact *C* and *M*. Recall that, according to the assumptions, the robot starts moving at point *A* at a speed of *v*+, and should arrive at the touch point at a speed of *vi*, *i* = 1, 2. Let us first determine the time spent in both cases on braking, which we denote by *<sup>t</sup>*2*i*, *<sup>i</sup>* <sup>=</sup> 1, 2. We have *<sup>t</sup>*2*<sup>i</sup>* = (*v*<sup>+</sup> <sup>−</sup> *vi*)/|*u*−|, i.e.,

$$
\Delta T\_2 = t\_{22} - t\_{21} = \frac{v^+ - \sqrt{\gamma}v\_1}{|u^-|} - \frac{v^+ - v\_1}{|u^-|} = \frac{(1 - \sqrt{\gamma})v\_1}{|u^-|},\tag{3}
$$

meaning that in this case the distance traveled by the robot during braking is equal to *di* = (*v*<sup>+</sup> <sup>−</sup> *vi*)2/(2|*y*−|). Thus, with the maximum speed *<sup>v</sup>*+, the robot travels the distance *S* cos *α<sup>i</sup>* − *di*, with the time spent on this task being

$$t\_{3i} = \frac{1}{v^+} (S \cos \alpha\_i - d\_i) = \frac{1}{v^+} \left( S \cos \alpha\_i - \frac{(v^+ - v\_i)^2}{2|u^-|} \right).$$

Hence ,

$$
\Delta T\_3 = t\_{32} - t\_{31} = \frac{S(\cos \alpha\_2 - \cos \alpha\_1)}{v^+} - \frac{(v^+ - \sqrt{\gamma} v\_1)^2}{2v^+ |u^-|} + \frac{(v^+ - v\_1)^2}{2v^+ |u^-|}. \tag{4}
$$

Thus, it follows from (4)–(6) that in both cases the difference in the time taken by the device to pass half of the trajectory is expressed by

$$\begin{split} \Delta T &= \frac{r\_1(\sqrt{\gamma}u\_2 - a\_1)}{v\_1} + \frac{(1 - \sqrt{\gamma})v\_1}{|\mu^-|} + \\ &+ \frac{S(\cos a\_2 - \cos a\_1)}{v^+} - \frac{(v^+ - \sqrt{\gamma}v\_1)^2}{2v^+|\mu^-|} + \frac{(v^+ - v\_1)^2}{2v^+|\mu^-|} = \\ &= \frac{r\_1(\sqrt{\gamma}u\_2 - a\_1)}{v\_1} + \frac{S(\cos a\_2 - \cos a\_1)}{v^+} + \frac{(1 - \gamma)v\_1^2}{2v^+|\mu^-|}. \end{split} \tag{5}$$

Let us now evaluate the second term in this expression. Taking into account that sin *x* < *x* for *x* > 0, and assuming that *α*<sup>1</sup> + *α*<sup>2</sup> < *π*, we have

$$\begin{aligned} \frac{S(\cos \alpha\_2 - \cos \alpha\_1)}{\upsilon^+} &= -\frac{2S}{\upsilon^+} \sin \frac{\alpha\_2 + \alpha\_1}{2} \sin \frac{\alpha\_2 - \alpha\_1}{2} > 0\\ &> -\frac{S}{\upsilon^+} \sin \left( \arcsin \frac{r\_1}{S} \right) (\alpha\_2 - \alpha\_1) = -\frac{r\_1}{\upsilon^+} (\alpha\_2 - \alpha\_1) .\end{aligned}$$

Therefore,

$$\begin{split} \Delta T &> \frac{r\_1(\sqrt{\gamma}u\_2 - \alpha\_1)}{v\_1} - \frac{r\_1}{v^+}(\mathfrak{a}\_2 - \mathfrak{a}\_1) + \frac{(1-\gamma)v\_1^2}{2v^+|\mu^-|} > \\ &> \frac{r\_1(\mathfrak{a}\_2 - \mathfrak{a}\_1)}{v\_1} - \frac{r\_1}{v^+}(\mathfrak{a}\_2 - \mathfrak{a}\_1) + \frac{(1-\gamma)v\_1^2}{2v^+|\mu^-|} = \\ &= r\_1(\mathfrak{a}\_2 - \mathfrak{a}\_1) \left(\frac{1}{v\_1} - \frac{1}{v^+}\right) + \frac{(1-\gamma)v\_1^2}{2v^+|\mu^-|}. \end{split} \tag{6}$$

Let *v*<sup>+</sup> = *θv*1, *θ* > 1. Then, the last expression in (8) takes the form

$$
\Delta T > \frac{r\_1 \left(\alpha\_2 - \alpha\_1\right) \left(\theta - 1\right)}{\theta v\_1} + \frac{(1 - \gamma) v\_1}{2\theta |u^-|};
$$

moreover, the right side of this inequality takes a positive value when

$$\gamma < 1 + \frac{2r\_1(\alpha\_2 - \alpha\_1)|u^-|(\theta - 1)}{v\_1^2}. \tag{7}$$

Obviously, the estimate for the second half of the route takes the same form (9) with the replacement of <sup>|</sup>*u*−| by *<sup>u</sup>*+. Thus, the following statement is true.

**Theorem 1.** *Assume that the coupling force G and the maximum speed v*<sup>1</sup> *when passing a turn along the minimum allowable radius r*<sup>1</sup> *are known. Then,* Δ*T* > 0 *for any γ satisfying the inequality*

$$1 < \gamma < 1 + \frac{2r\_1(\alpha\_2 - \alpha\_1)\tilde{u}(\theta - 1)}{v\_1^2}\gamma$$

*where <sup>u</sup>*˜ <sup>=</sup> min{|*u*−|, *<sup>u</sup>*+}*.*

Thus, with a sufficient natural condition for the parameter *γ*, the solution of the timeoptimal problem based on the principle of trajectory division is optimal. This is confirmed by computational experiments.

**Funding:** This research received no external funding.

**Institutional Review Board Statement:** Not applicable.

**Informed Consent Statement:** Not applicable.

**Data Availability Statement:** Not applicable.

**Conflicts of Interest:** The author declares no conflict of interest.

### **References**


**Disclaimer/Publisher's Note:** The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.
