# An Improved Path-Generating Regulator for Two-Wheeled Robots to Track the Circle/Arc Passage

Authors: Jun Dai; Naohiko Hanajima; Toshiharu Kazama; Akihiko Takashima
Journal: Mathematical Problems in Engineering
 (2014)

---

## Abstract

The improved path-generating regulator (PGR) is proposed to path track the circle/arc passage for two-wheeled robots. The PGR, which is a control method for robots so as to orient its heading toward the tangential direction of one of the curves belonging to the family of path functions, is applied to navigation problem originally. Driving environments for robots are usually roads, streets, paths, passages, and ridges. These tracks can be seen as they consist of straight lines and arcs. In the case of small interval, arc can be regarded as straight line approximately; therefore we extended the PGR to drive the robot move along circle/arc passage based on the theory that PGR to track the straight passage. In addition, the adjustable look-ahead method is proposed to improve the robot trajectory convergence property to the target circle/arc. The effectiveness is proved through MATLAB simulations on both the comparisons with the PGR and the improved PGR with adjustable look-ahead method. The results of numerical simulations show that the adjustable look-ahead method has better convergence property and stronger capacity of resisting disturbance.


---

## Body

## 1. Introduction

Over the last few years, the development on robots has been paid close attention to. There are some research projects such as cleaner robot of iRobot (IRBT) [1], office robot of double robotics [2], and remote-presence robot of mobile access consultation services [3]. These two-wheeled robots have common characteristic that move along the given route. So path tracking serves as an essential task for such autonomous robots.For circle/arc tracking problem, many approaches have been proposed, a dual estimation algorithm estimated the robot’s position and wheel slips based on the Kalman filtering [4], but it is necessary to have previous knowledge about the system and measuring devices. A block iterative method known as four point-explicit group via nine-point Laplacian (4EG9L) was used for solving robot path planning problem [5]. Most such approaches design the feedback control system by converting variables such as input conversion of the mathematical model to a format called chained form. It is noteworthy that the conversion variables cannot be defined globally in such approaches.Compared with the other papers, the originality of this paper proposed the PGR and improved PGR with adjustable look-ahead method to track the circle/arc for two-wheeled robot. It is a control method that carries out asymptotic convergence of nonholonomic robots to a given path function group.Two-wheeled robots belong to nonholonomic constraints system [6], which makes it difficult for robots to converge to the target state by deriving a control law [7]. In one of our previous works, we proposed the path-generating regulator (PGR) method, which controls the robot to move forward to the tangential direction of the curve which passes through the robot current position among the family of path functions [8–10]. This method allows us to make the robot stop at the origin of the rectangular coordinate system. Simultaneously, the global asymptotic stability of PGR has been proven. Because driving environments for robots are usually roads, streets, passages, and ridges. These tracks can be seen as they consist of straight lines and arcs. Recently, the PGR has been extended to path tracking problem along straight passage for two-wheeled robots [11] and the validity has been verified by simulations and experiments. Therefore, we further investigate the PGR and the improved PGR with adjustable look-ahead algorithm to track the circle/arc passage in this paper.The remainder of this paper is organized as follows. Section2 reviews the PGR along straight passage for two-wheeled robots. In Section 3, we propose the PGR along circle/arc passage based on line approximation in a small interval. Because the robot’s trajectory tends to deviate outward from the target circle, the improved PGR along circle/arc passage with adjustable look-ahead method is elaborated in Section 4. In order to verify the efficiency of the two proposed PGR methods, the numerical simulations are executed and discussed in Section 5. Concluding remarks are presented in Section 6.


## 2. Review of the PGR along Straight Passage Method for Two-Wheeled Robots

The PGR was used to solve the path tracking problem along straight passage for two-wheeled robots. To illustrate this method clearly, we establish the robot’s mathematic model, definite the path functions, and carry out necessary mathematical calculation and then deduce the steering angle and the moving speed formulas.


### 2.1. Mathematic Model

In this research, the mathematic model is shown in Figure1. The kinematic variables of the two- wheeled robot are as follows: xr and yr are the coordinates of the robot in the world reference frame. The translational velocity of the center of the robot u1 is related to the velocity in the x and y directions, x˙r and y˙r, through (1) and (2), where ϕ is the orientation angle of the robot with respect to the reference frame. The steering angle of the robot u2 is the change rate ϕ˙ of the orientation angle, through (3):
(1)x˙r=u1cos⁡⁡ϕ,(2)y˙r=u1sin⁡ϕ,(3)ϕ˙=u2.Figure 1
Two-wheeled robot mathematic model.


### 2.2. Path Functions for Straight Passage

The family of path functions for a half-side of straight passage is defined as the following formula from reference [11]:
(4)y={Wx<-π+baW2(1-cos⁡⁡(ax-b))π+ba<x<ba,0x>ba,
where a is a positive constant which adjusts the slope of the curve, b is a translation value of path functions family, and W is the half-width of the passage. Instead of W, we take W1 as the left half width, that is, in the domain of y>0, W2 as the right half width, that is, in the domain of y<0. When y is negative, the sign of the right side of (4) needs to be changed. The graph of the functions is shown in Figure 2. The robot drives through the passage toward the positive direction of the x-axis. ϕr can be expressed as
(5)ϕr={tan-1(-a(W1-y)y)y≥0tan-1(a-(W2+y)y)y<0.Figure 2
The coordinate system and the path functions for straight passage. The robot drives toward the positive direction of thex-axis. The horizontal lines y=W1 and y=-W2 represent the boundary of passage, such as walls.Note thatϕr is calculated only by the y coordinate in the region -W2≤y≤W1. The partial derivative of ϕr with respect to y is calculated as follows:
(6)∂ϕr∂y={-a(W1-2y)(W1-y)y2y(1+a2(W1-y)y)(W1-y)y≥0a(W2+2y)-(W2+y)y2y(1-a2(W2+y)y)(W2+y)y<0.


### 2.3. Steering Angleu2

The deviation between the target angleϕr and the actual angle ϕ is set as δ:
(7)δ=ϕ-ϕr.Under the control ofu2, δ obeys the following derivative equation of the first order delay system:
(8)δ˙=-λδ,
where λ is a coefficient constant, when δ converges to 0; ϕ approaches ϕr simultaneously. According to (3), (6), and (8), we obtain u2 for straight passage as follows:
(9)u2={g1(y,ϕ)0<y<W1-εg2(y,ϕ)-W2+ε<y<0,(10)g1(y,ϕ)=-λ(ϕ+tan-1(a(W1-y)y))-a(W1-2y)(W1-y)y2y(1+a2(W1-y)y)(W1-y)u1sin⁡ϕ,(11)g2(y,ϕ)=-λ(ϕ-tan-1(a-(W2+y)y))+a(W2+2y)-(W2+y)y2y(1-a2(W2+y)y)(W2+y)u1sin⁡ϕ,
where ε is a small positive constant. To avoid division by zero in computer calculation of (10) and (11), when the value of y is around 0, W1 or W2 and the speed command u1 need to be nonzero value.


### 2.4. Translational Velocityu1

u
1 is derived by Lyapunov’s stability method. A hybrid continuous control algorithm in (12), of which the second part puts more emphasis on advance close to the x-axis and the first part guarantees stability in other location, is applied. The control algorithm can be expressed as follows:
(12)u1=-(1-Kme-cmy2)1-e-cysinϕ1+e-cysinϕVm+Kme-cmy2Vm,
where Kme-cmy2 is the modification coefficient used to adjust the emphasis between two parts. Km is within the limit of 0≤Km≤1 and e-cmy2 will be equal to 1 on the x-axis and close to 0 away from the x-axis. cm is an adjustable parameter and cm>0.


## 2.1. Mathematic Model

In this research, the mathematic model is shown in Figure1. The kinematic variables of the two- wheeled robot are as follows: xr and yr are the coordinates of the robot in the world reference frame. The translational velocity of the center of the robot u1 is related to the velocity in the x and y directions, x˙r and y˙r, through (1) and (2), where ϕ is the orientation angle of the robot with respect to the reference frame. The steering angle of the robot u2 is the change rate ϕ˙ of the orientation angle, through (3):
(1)x˙r=u1cos⁡⁡ϕ,(2)y˙r=u1sin⁡ϕ,(3)ϕ˙=u2.Figure 1
Two-wheeled robot mathematic model.


## 2.2. Path Functions for Straight Passage

The family of path functions for a half-side of straight passage is defined as the following formula from reference [11]:
(4)y={Wx<-π+baW2(1-cos⁡⁡(ax-b))π+ba<x<ba,0x>ba,
where a is a positive constant which adjusts the slope of the curve, b is a translation value of path functions family, and W is the half-width of the passage. Instead of W, we take W1 as the left half width, that is, in the domain of y>0, W2 as the right half width, that is, in the domain of y<0. When y is negative, the sign of the right side of (4) needs to be changed. The graph of the functions is shown in Figure 2. The robot drives through the passage toward the positive direction of the x-axis. ϕr can be expressed as
(5)ϕr={tan-1(-a(W1-y)y)y≥0tan-1(a-(W2+y)y)y<0.Figure 2
The coordinate system and the path functions for straight passage. The robot drives toward the positive direction of thex-axis. The horizontal lines y=W1 and y=-W2 represent the boundary of passage, such as walls.Note thatϕr is calculated only by the y coordinate in the region -W2≤y≤W1. The partial derivative of ϕr with respect to y is calculated as follows:
(6)∂ϕr∂y={-a(W1-2y)(W1-y)y2y(1+a2(W1-y)y)(W1-y)y≥0a(W2+2y)-(W2+y)y2y(1-a2(W2+y)y)(W2+y)y<0.


## 2.3. Steering Angleu2

The deviation between the target angleϕr and the actual angle ϕ is set as δ:
(7)δ=ϕ-ϕr.Under the control ofu2, δ obeys the following derivative equation of the first order delay system:
(8)δ˙=-λδ,
where λ is a coefficient constant, when δ converges to 0; ϕ approaches ϕr simultaneously. According to (3), (6), and (8), we obtain u2 for straight passage as follows:
(9)u2={g1(y,ϕ)0<y<W1-εg2(y,ϕ)-W2+ε<y<0,(10)g1(y,ϕ)=-λ(ϕ+tan-1(a(W1-y)y))-a(W1-2y)(W1-y)y2y(1+a2(W1-y)y)(W1-y)u1sin⁡ϕ,(11)g2(y,ϕ)=-λ(ϕ-tan-1(a-(W2+y)y))+a(W2+2y)-(W2+y)y2y(1-a2(W2+y)y)(W2+y)u1sin⁡ϕ,
where ε is a small positive constant. To avoid division by zero in computer calculation of (10) and (11), when the value of y is around 0, W1 or W2 and the speed command u1 need to be nonzero value.


## 2.4. Translational Velocityu1

u
1 is derived by Lyapunov’s stability method. A hybrid continuous control algorithm in (12), of which the second part puts more emphasis on advance close to the x-axis and the first part guarantees stability in other location, is applied. The control algorithm can be expressed as follows:
(12)u1=-(1-Kme-cmy2)1-e-cysinϕ1+e-cysinϕVm+Kme-cmy2Vm,
where Kme-cmy2 is the modification coefficient used to adjust the emphasis between two parts. Km is within the limit of 0≤Km≤1 and e-cmy2 will be equal to 1 on the x-axis and close to 0 away from the x-axis. cm is an adjustable parameter and cm>0.


## 3. The PGR along Circle/Arc Passage Method

In a small interval, circle/arc can be seen as line approximately. The PGR along circle/arc passage based on the theory of straight passage is proposed in this section.As shown in Figure3, we set the circle/arc path functions as
(13)x(s)=x0+rcos⁡(σsr+γ),y(s)=y0+rsin(σsr+γ),
where s is the length of circle/arc, r is the radius of circle/arc, and γ is the inclination angle of circle/arc. c(x0,y0) is the center of circle/arc. σ determines the move direction of circle/arc, σ=1 means counterclockwise direction, and σ=-1 means clockwise direction. θ is central angle, 0<θ≤2π, and θ=s/r.Figure 3
The path of circle/arc.The global and local coordinate systems are shown in Figure4. o-xgyg is the global coordinate system and pl-xlyl is the local coordinate system. (xr,yr,ϕ) is the pose of robot in the global coordinate system. c(x0,y0) is the central point of circle/arc. The angle between the line which passes through (xr,yr) and c(x0,y0) and x-axis is named as α that is expressed as (14). The width of passage inside of the circle/arc is W1 and W1<r; the opposite side is W2:
(14)α=tan-1(yr-y0xr-x0).Figure 4
Global and local coordinate systems.The theory of PGR along straight passage can be used for circle/arc passage in a small intervaldt in the local coordinate system pl-xlyl. In order to simplify computation, we select the intersection point pl(xl,yl), expressed as (15) and (16) and the line through c(x0,y0) and (xr,yr) with the circle/arc as the origin of the local coordinate system. xl-axis is the tangential direction of the arc and yl-axis is the normal direction. μ means the rotation angle that rotates from the local coordinate system to global coordinate system from (17):
(15)xl=x0+rcos⁡⁡α,(16)yl=y0+rsin⁡α,(17)μ=π2+α.Therefore, we can obtain the pose of robot(xr′,yr′,ϕ′) in the local coordinate system:
(18)xr′=xrcos⁡⁡μ+yrsin⁡μ-xlcos⁡⁡μ-ylsin⁡μ,yr′=-xrsin⁡μ+yrcos⁡⁡μ+xlsin⁡μ-ylcos⁡⁡μ,ϕ′=ϕ-μ.The flow chart is shown in Figure5. We establish global coordinate system o-xgyg and local coordinate system pl-xlyl according to (14)–(17) firstly. Then the pose of robot (xr,yr,ϕ) is converted to the local coordinate value (xr′,yr′,ϕ′) according to (18). Within the time interval dt, the PGR along x-axis of local coordinate system is to control robot and a new pose is obtained according to (9) and (12). Then the new pose of robot is converted to global coordinate value according to the inverse transformation of (18). Finally, the robot judges whether the new location is the goal or not. If the new location is not the goal, the new local coordinate system is needed to be established based on the new robot pose and the center of circle/arc. Program is running along this cycle process until the robot reaches the goal.Figure 5
Flow chart under PGR along circle/arc passage.


## 4. The Improved PGR with the Adjustable Look-Ahead Method along Circle/Arc Passage

The PGR is extended to drive the robot move along circle/arc passage based on the straight passage theory in Section3. The improved PGR with the adjustable look-ahead method is proposed to make the robot’s trajectory converge to the target circle/arc.Global and local coordinate systems with the adjustable look-ahead method are shown in Figure6. The distance between the robot location (xr,yr) and the center of the circle/arc c(x0,y0) is assumed as d in (19). The central angle between robot location and local coordinate origin is assumed as β in (20), which is named as adjustable look-ahead central angle, because β will change if d changes:
(19)d=(xr-x0)2+(yr-y0)2,(20)β=cos⁡-1⁡(rd).Figure 6
Global and local coordinate systems for the improved PGR with the adjustable look-ahead method.The originpl′(xl′,yl′) which is described in (21) in the new local coordinate system is the tangent point of the circle/arc at the front of the robot location, whose tangent line passes through the (xr,yr). xl′-axis is the tangential direction of the arc and yl′-axis is the normal direction. μ′ means the rotation angle that rotates from the new local coordinate system to the global coordinate system:
(21)xl′=xr+dsin⁡βcos⁡⁡(3π2-β-α),yl′=yr+dsin⁡βsin⁡(3π2-β-α),μ′=π2+α+β.The local coordinate system is established at the front of robot location and is adjusted with the change ofβ, so this method is named as adjustable look-ahead method.The flow chart under the improved PGR with the adjustable look-ahead method along circle/arc passage is shown in Figure7. The difference with the method in Section 3 is the introduction of β. When the robot’s new location is outside of target circle/arc, that is, d>r, the program calculates β then the new local coordinate system is established based on (21). Otherwise, when the robot’s new location is inside of target circle/arc, that is, d<r, the process is the same with the flow chart in Figure 6.Figure 7
Flow chart under the improved PGR with the adjustable look-ahead method along circle/arc passage.


## 5. Numerical Simulations

To confirm the efficiency of the proposed PGR method in Sections3 and 4 for the robot’s path tracking along circle/arc passage, the numerical simulations are performed in several aspects, respectively, in this section.We investigate the influence of coefficient constantλ and the time interval dt to the robot’s trajectory. In addition, limited random disturbances are imposed to the inputs of velocity u1 and steering angle u2 to investigate the robustness of the two methods. The overall simulation results are discussed finally. In the simulation, the simulation time t is set separately as 40 seconds in circle/arc passage and 50 seconds in the S-shaped passage; that is to say, when the simulation time t is equal to 40 seconds or 50 seconds, the robot receives a command of velocity u1=0 and steering angle u2=0 and stops.The numerical simulations are performed with the software MATLAB 7.11.0 (The MathWorks, Inc.). The default parameter values for the simulations are listed in Table1. In the simulation results, the red dashed line of (C) or (D) represents the target circle/arc. The red cross represents the center of circle/arc. The robot’s trajectories are shown in the x-y plain. Initial condition is designated by an icon with an arrow. The thick arrow represents the direction of the robot’s motion.Table 1
Default parameter values for numerical simulations.
Parameters
Values
Unit
r
4
m
W
1,W2
2.5
m
a
1
—
ε
0.001
—
V
m
1
m/s
c
1
—
c
m
1
—
k
m
1
—
γ
π
/
4
rad
θ
2π
rad
Initial condition
(
0
,
-
1
,
-
π
/
4
)
—


### 5.1. The Influence of Coefficient Constantλ

In the numerical simulation process, we only change the value of coefficient constantλ and keep the other parameters constant. The parameters are listed in Table 2.Table 2
Default parameter values for numerical simulations.
No.
λ
d
t
t
Color
(A)
0.2
0.1 s
40 s
Green
(B)
0.5
0.1 s
40 s
Magenta
(C)
0.9
0.1 s
40 s
BlueThe robot’s trajectories and control commands of PGR proposed in Section3 at different λ values are depicted in Figure 8. The value of λ is 0.2 for (A), 0.5 for (B), and 0.9 for (C). As described in (8), λ is a coefficient constant for adjusting the response speed of u2; therefore, the trajecotry tends to converge the target circle if λ becomes large. It is found from Figure 8(a) that the convergence property is the best when λ is 0.9, but the trajectory does not yet converge to the target circle/arc.Trajectories in thex-y plain and time response of control commands u1 and u2 by the method in Section 3 at different values of λ, from (A) to (C).
(a)
(b)
(c)Figure9 depicts the robot’s trajectories and control commands of the improved PGR with the adjustable look-ahead method at different λ values. The value of λ is 0.2 for (A), 0.5 for (B), and 0.9 for (C). It is observed from Figure 9(a) that even if λ is large or small, the trajectories can converge to the target circle/arc well, which indicates that the value of λ has no influence to the convergence property. The improved PGR with the adjustable look-ahead method has improved the performance of path tracking along circle/arc passage for robot. In Figures 9(b) and 9(c), the values of u1 and u2 have small fluctuation after 5 seconds when λ is 0.5 and 0.9, respectively. The fluctuation range of u1 is 0.04 m/s when λ is 0.5 and 0.09 m/s when λ is 0.9. Because the fluctuation range is very little, it can be ignored. The fluctuation range of u2 is 0.3 rad when λ is 0.5 and 0.5 rad when λ is 0.9. It is considered that the fluctuation is caused by the local coordinate system changing constantly and fluctuation range of u2 has proportional relation with λ.Trajectories in thex-y plain and time response of control commands u1 and u2 by the PGR with the adjustable look-ahead method at different values of λ, from (A) to (C).
(a)
(b)
(c)


### 5.2. The Influence of Time Intervalsdt

In this numerical simulation, three values of time intervaldt are given. The parameters are listed in Table 3.Table 3
Default parameter values for numerical simulations.
No.
d
t
λ
t
Color
(A)
0.1 s
0.5
40 s
Green
(B)
0.5 s
0.5
40 s
Magenta
(C)
1 s
0.5
40 s
BlueThe robot’s trajectories and control commands of PGR proposed in Section3 at different time intervals dt are depicted in Figure 10. The value of dt is 0.1 s for (A), 0.5 s for (B), and 1 s for (C). When the value of time interval dt becomes short, the move distance of the robot becomes short and the orientation is unchanged. The results point out that the convergence property tends to be better when the time interval dt becomes shorter, but the trajectory is not able to converge to the target circle/arc. The velocity u1 tends to be stable after 8 seconds. The steering angle u2 tends to be stable after 6 seconds.Trajectories in thex-y plain and time response of control commands u1 and u2 by the method in Section 3 at different time interval values of dt, from (A) to (C).
(a)
(b)
(c)Figure11 depicts the robot’s trajectories and control commands by improved PGR with the adjustable look-ahead method at different dt values. The value of dt is 0.1 s for (A), 0.5 s for (B), and 1 s for (C). From Figure 11(a), we discover when the value of dt is 1 s the trajectory in the interval of dt tends to become straight line and the trajectory fluctuates around the target circle/arc, which indicates that the convergence property becomes poor when dt becomes long. If we chose the proper dt value, the robot trajectory is able to converge to the target circle/arc perfectly. Figures 11(b) and 11(c) show that the fluctuation range of velocitiy u1 tends to be wide when the value of dt becomes long. The steering angles u2 have the same fluctuation range with the different values of dt, but the fluctuation period tends to be long when dt becomes long.Trajectories in thex-y plain and time response of control commands u1 and u2 by improved PGR with the adjustable look-ahead method at different time interval values of dt, from (A) to (C).
(a)
(b)
(c)


### 5.3. The Influence with Disturbance Imposed on the Inputs ofu1 and u2

In fact, because of the restrictions of robot itself and external environment, the inputs are often accompanied by some disturbance. For instance, when the robot runs on uneven ground, the steering wheel may receive disturbance force from the ground. To investigate the robustness of the two proposed PGR methods, two different sizes limited random disturbancese1 and e2 (listed in Table 4) are imposed to the inputs of velocity command u1 and steering angle command u2, respectively.Table 4
Default parameter values for numerical simulations.
No.
e
1
,
e
2
λ
d
t
t
Color
(A)
0.2
×
rand
(
1
)
-
0.1
0.5
0.1 s
40 s
Blue
(B)
0.5
×
rand
(
1
)
-
0.1
0.5
0.1 s
40 s
GreenThe robot’s trajectories and control commands by the method proposed in Section3 at different disturbances are depicted in Figure 12. The trajectories are the same with the two different disturbances, which indicates that this method has strong capacity of resisting disturbance. The fluctuation range of control commands tends to be wide with the increasement of disturbance.Trajectories in thex-y plain and time response of control commands of PGR proposed in Section 3 at different disturbance values of e1 and e2, from (A) to (B).
(a)
(b)
(c)Similarly, Figure13 depicts the robot’s trajectories and control commands by the improved PGR with the adjustable look-ahead method at different disturbances. The results point out that the trajectories converge to the target perfectly with the two different disturbances, which indicates that the improved PGR has strong capacity of resisting disturbance as well. The fluctuation range of control commands tends to be wide with the increasement of disturbance.Trajectories in thex-y plain and time responses of control commands by improved PGR with the adjustable look-ahead method for robot at different disturbance values of e1 and e2, from (A) to (B).
(a)
(b)
(c)


### 5.4. The PGR and Improved PGR with Adjustable Look-Ahead Method to Track the S-Shaped Passage

In this section we apply that the PGR and the improved PGR with the adjustable look-ahead method applied to track the S-shaped passage.Shown in Figure14, the S-shaped passage consists of two arcs. The centers of two arcs are o1(x1,y1) and o2(x2,y2), the radiuses are r1 and r2, and the intersection point of two arcs is p(xp,yp) that can be solved by (22) and (23):
(22)xp=12(x1+x2),(23)yp=12(y1+y2).
Firstly, the robot moves along the arc o1 counterclockwise, when it reaches the intersection point p; then it starts from p and moves along the arc o2 clockwise.Figure 14
The S-shaped model.The condition (A) does not consider error in input and the condition (B) imposes the disturbance on the inputs ofu1 and u2. The default parameter values for numerical simulations are shown in Table 5.Table 5
Default parameter values for numerical simulations.
No.
Method
λ
d
t
t
Color
(A)
The PGR
0.35
0.1 s
50 s
blue
(B)
The improved PGR
0.35
0.1 s
50 s
greenFigure15 depicts the robot’s trajectories and control commands by the PGR and the improved PGR with adjustable look-ahead method to track the circle/arc passage. As can be seen in the upper graph, the trajectory by the PGR is distributed in the outside of the target S-shaped passage and the trajectories converge to the target perfectly by the improved PGR with adjustable look-ahead method. In the below graph, around the intersection point p, the steering angle has two sudden changes from 29 seconds to 31 seconds. The first sudden change depicts that the trajectory switches from arc o1 to o2 and the second sudden change depicts that the trajectory changes from inside to outside of o2. The steering angle of u2 has only a sudden change in 28 seconds at intersection point p, which indicates that the improved PGR method with adjustable look-ahead method has good performance to converge the target S-shape passage. Similarly, the PGR and the improved PGR also can be applied in the complicate passage which consists of many arcs.Trajectories in thex-y plain and time responses of control commands by the PGR in (A) and the improved PGR with the adjustable look-ahead method in (B).
(a)
(b)
(c)


### 5.5. Discussion on Numerical Simulation Results

According to the above simulation results, we discuss the convergence property of the two methods for two-wheeled robot in this section.The first issue concerns the influence ofλ in the two methods. By the PGR method in Section 3, the trajecotry is closer to the target circle if the value of λ is larger, but the trajectory does not converge to the target circle/arc. However, by the improved PGR with adjustable look-ahead method, even if λ is large or small, the robot trajectory is able to converge to the target circle/arc perfectly. The change of the value of λ has no influence on the convergence property. The improved PGR with the adjustable look-ahead method for two-wheeled robot has better performance.The second issue concerns the influence of time intervaldt. By the PGR method in Section 3, convergence property has some improvement as dt becomes short, but the trajectory is not able to converge to the target circle/arc. However, by the improved PGR with adjustable look-ahead method, when dt becomes long, the trajectory fluctuates around the target circle/arc. If we choose the proper dt value, the robot trajectory is able to converge to the target circle/arc perfectly.The third issue concerns the capacity of resisting disturbance by the two methods. The two sizes of bound random disturbances are imposed; the results point out to two methods which have strong capacity of resisting disturbance.The fourth issue concerns the application in S-shaped passage. The simulations are performed on the PGR and the PGR with the adjustable look-ahead method. The results show that robot trajectory is consistent with the target S-shaped passage on the improved PGR with adjustable look-ahead method.In general, the improved PGR with adjustable look-ahead method has better performance along circle/arc passage. Compared with the other research, like references [12–19], the improved PGR with the adjustable look-ahead method has not only the merits of convergence perfectly, but also the strong capacity of resisting disturbance. However, this method has the limitation in application that is just for circle/arc passage problem. It will be extended to the complicated passage environment in the future work.


## 5.1. The Influence of Coefficient Constantλ

In the numerical simulation process, we only change the value of coefficient constantλ and keep the other parameters constant. The parameters are listed in Table 2.Table 2
Default parameter values for numerical simulations.
No.
λ
d
t
t
Color
(A)
0.2
0.1 s
40 s
Green
(B)
0.5
0.1 s
40 s
Magenta
(C)
0.9
0.1 s
40 s
BlueThe robot’s trajectories and control commands of PGR proposed in Section3 at different λ values are depicted in Figure 8. The value of λ is 0.2 for (A), 0.5 for (B), and 0.9 for (C). As described in (8), λ is a coefficient constant for adjusting the response speed of u2; therefore, the trajecotry tends to converge the target circle if λ becomes large. It is found from Figure 8(a) that the convergence property is the best when λ is 0.9, but the trajectory does not yet converge to the target circle/arc.Trajectories in thex-y plain and time response of control commands u1 and u2 by the method in Section 3 at different values of λ, from (A) to (C).
(a)
(b)
(c)Figure9 depicts the robot’s trajectories and control commands of the improved PGR with the adjustable look-ahead method at different λ values. The value of λ is 0.2 for (A), 0.5 for (B), and 0.9 for (C). It is observed from Figure 9(a) that even if λ is large or small, the trajectories can converge to the target circle/arc well, which indicates that the value of λ has no influence to the convergence property. The improved PGR with the adjustable look-ahead method has improved the performance of path tracking along circle/arc passage for robot. In Figures 9(b) and 9(c), the values of u1 and u2 have small fluctuation after 5 seconds when λ is 0.5 and 0.9, respectively. The fluctuation range of u1 is 0.04 m/s when λ is 0.5 and 0.09 m/s when λ is 0.9. Because the fluctuation range is very little, it can be ignored. The fluctuation range of u2 is 0.3 rad when λ is 0.5 and 0.5 rad when λ is 0.9. It is considered that the fluctuation is caused by the local coordinate system changing constantly and fluctuation range of u2 has proportional relation with λ.Trajectories in thex-y plain and time response of control commands u1 and u2 by the PGR with the adjustable look-ahead method at different values of λ, from (A) to (C).
(a)
(b)
(c)


## 5.2. The Influence of Time Intervalsdt

In this numerical simulation, three values of time intervaldt are given. The parameters are listed in Table 3.Table 3
Default parameter values for numerical simulations.
No.
d
t
λ
t
Color
(A)
0.1 s
0.5
40 s
Green
(B)
0.5 s
0.5
40 s
Magenta
(C)
1 s
0.5
40 s
BlueThe robot’s trajectories and control commands of PGR proposed in Section3 at different time intervals dt are depicted in Figure 10. The value of dt is 0.1 s for (A), 0.5 s for (B), and 1 s for (C). When the value of time interval dt becomes short, the move distance of the robot becomes short and the orientation is unchanged. The results point out that the convergence property tends to be better when the time interval dt becomes shorter, but the trajectory is not able to converge to the target circle/arc. The velocity u1 tends to be stable after 8 seconds. The steering angle u2 tends to be stable after 6 seconds.Trajectories in thex-y plain and time response of control commands u1 and u2 by the method in Section 3 at different time interval values of dt, from (A) to (C).
(a)
(b)
(c)Figure11 depicts the robot’s trajectories and control commands by improved PGR with the adjustable look-ahead method at different dt values. The value of dt is 0.1 s for (A), 0.5 s for (B), and 1 s for (C). From Figure 11(a), we discover when the value of dt is 1 s the trajectory in the interval of dt tends to become straight line and the trajectory fluctuates around the target circle/arc, which indicates that the convergence property becomes poor when dt becomes long. If we chose the proper dt value, the robot trajectory is able to converge to the target circle/arc perfectly. Figures 11(b) and 11(c) show that the fluctuation range of velocitiy u1 tends to be wide when the value of dt becomes long. The steering angles u2 have the same fluctuation range with the different values of dt, but the fluctuation period tends to be long when dt becomes long.Trajectories in thex-y plain and time response of control commands u1 and u2 by improved PGR with the adjustable look-ahead method at different time interval values of dt, from (A) to (C).
(a)
(b)
(c)


## 5.3. The Influence with Disturbance Imposed on the Inputs ofu1 and u2

In fact, because of the restrictions of robot itself and external environment, the inputs are often accompanied by some disturbance. For instance, when the robot runs on uneven ground, the steering wheel may receive disturbance force from the ground. To investigate the robustness of the two proposed PGR methods, two different sizes limited random disturbancese1 and e2 (listed in Table 4) are imposed to the inputs of velocity command u1 and steering angle command u2, respectively.Table 4
Default parameter values for numerical simulations.
No.
e
1
,
e
2
λ
d
t
t
Color
(A)
0.2
×
rand
(
1
)
-
0.1
0.5
0.1 s
40 s
Blue
(B)
0.5
×
rand
(
1
)
-
0.1
0.5
0.1 s
40 s
GreenThe robot’s trajectories and control commands by the method proposed in Section3 at different disturbances are depicted in Figure 12. The trajectories are the same with the two different disturbances, which indicates that this method has strong capacity of resisting disturbance. The fluctuation range of control commands tends to be wide with the increasement of disturbance.Trajectories in thex-y plain and time response of control commands of PGR proposed in Section 3 at different disturbance values of e1 and e2, from (A) to (B).
(a)
(b)
(c)Similarly, Figure13 depicts the robot’s trajectories and control commands by the improved PGR with the adjustable look-ahead method at different disturbances. The results point out that the trajectories converge to the target perfectly with the two different disturbances, which indicates that the improved PGR has strong capacity of resisting disturbance as well. The fluctuation range of control commands tends to be wide with the increasement of disturbance.Trajectories in thex-y plain and time responses of control commands by improved PGR with the adjustable look-ahead method for robot at different disturbance values of e1 and e2, from (A) to (B).
(a)
(b)
(c)


## 5.4. The PGR and Improved PGR with Adjustable Look-Ahead Method to Track the S-Shaped Passage

In this section we apply that the PGR and the improved PGR with the adjustable look-ahead method applied to track the S-shaped passage.Shown in Figure14, the S-shaped passage consists of two arcs. The centers of two arcs are o1(x1,y1) and o2(x2,y2), the radiuses are r1 and r2, and the intersection point of two arcs is p(xp,yp) that can be solved by (22) and (23):
(22)xp=12(x1+x2),(23)yp=12(y1+y2).
Firstly, the robot moves along the arc o1 counterclockwise, when it reaches the intersection point p; then it starts from p and moves along the arc o2 clockwise.Figure 14
The S-shaped model.The condition (A) does not consider error in input and the condition (B) imposes the disturbance on the inputs ofu1 and u2. The default parameter values for numerical simulations are shown in Table 5.Table 5
Default parameter values for numerical simulations.
No.
Method
λ
d
t
t
Color
(A)
The PGR
0.35
0.1 s
50 s
blue
(B)
The improved PGR
0.35
0.1 s
50 s
greenFigure15 depicts the robot’s trajectories and control commands by the PGR and the improved PGR with adjustable look-ahead method to track the circle/arc passage. As can be seen in the upper graph, the trajectory by the PGR is distributed in the outside of the target S-shaped passage and the trajectories converge to the target perfectly by the improved PGR with adjustable look-ahead method. In the below graph, around the intersection point p, the steering angle has two sudden changes from 29 seconds to 31 seconds. The first sudden change depicts that the trajectory switches from arc o1 to o2 and the second sudden change depicts that the trajectory changes from inside to outside of o2. The steering angle of u2 has only a sudden change in 28 seconds at intersection point p, which indicates that the improved PGR method with adjustable look-ahead method has good performance to converge the target S-shape passage. Similarly, the PGR and the improved PGR also can be applied in the complicate passage which consists of many arcs.Trajectories in thex-y plain and time responses of control commands by the PGR in (A) and the improved PGR with the adjustable look-ahead method in (B).
(a)
(b)
(c)


## 5.5. Discussion on Numerical Simulation Results

According to the above simulation results, we discuss the convergence property of the two methods for two-wheeled robot in this section.The first issue concerns the influence ofλ in the two methods. By the PGR method in Section 3, the trajecotry is closer to the target circle if the value of λ is larger, but the trajectory does not converge to the target circle/arc. However, by the improved PGR with adjustable look-ahead method, even if λ is large or small, the robot trajectory is able to converge to the target circle/arc perfectly. The change of the value of λ has no influence on the convergence property. The improved PGR with the adjustable look-ahead method for two-wheeled robot has better performance.The second issue concerns the influence of time intervaldt. By the PGR method in Section 3, convergence property has some improvement as dt becomes short, but the trajectory is not able to converge to the target circle/arc. However, by the improved PGR with adjustable look-ahead method, when dt becomes long, the trajectory fluctuates around the target circle/arc. If we choose the proper dt value, the robot trajectory is able to converge to the target circle/arc perfectly.The third issue concerns the capacity of resisting disturbance by the two methods. The two sizes of bound random disturbances are imposed; the results point out to two methods which have strong capacity of resisting disturbance.The fourth issue concerns the application in S-shaped passage. The simulations are performed on the PGR and the PGR with the adjustable look-ahead method. The results show that robot trajectory is consistent with the target S-shaped passage on the improved PGR with adjustable look-ahead method.In general, the improved PGR with adjustable look-ahead method has better performance along circle/arc passage. Compared with the other research, like references [12–19], the improved PGR with the adjustable look-ahead method has not only the merits of convergence perfectly, but also the strong capacity of resisting disturbance. However, this method has the limitation in application that is just for circle/arc passage problem. It will be extended to the complicated passage environment in the future work.


## 6. Conclusion and Future Work

This paper presented the PGR and the improved PGR with the adjustable look-ahead method to track the circle/arc passage for two-wheeled robots. The robot’s trajectory tended to deviate outward from the target circle in the first method. To improve this weakness, the adjustable coefficient angleβ is introduced. The robot adjusted the local coordinate system constantly according to the deviate between the trajectory and the target circle/arc, which made the trajectory converge to the target circle/arc perfectly. The simulation results also verified the improved PGR with adjustable look-ahead method had better performance on path tracking along the circle/arc passage. This approach was also validated on the S-shaped passage, which indicated that it could be applied to multiarc passage tracing problem.In this paper, we focused on the control method to track the circle/arc passage and verify the efficiency on simulation environment without considering obstacles. However it does not mean that we neglect the obstacle avoidance problem. Actually, some members in our research group have proposed and are testing the obstacle avoidance algorithms with the PGR. In the future work, we will perform the experiments to verify the effectiveness of the method proposed in this paper in the real environment in the future.



---

*Source: 254503-2014-07-23.xml*