# A Novel Relative Navigation Control Strategy Based on Relation Space Method for Autonomous Underground Articulated Vehicles

Authors: Fengqian Dou; Yu Meng; Li Liu; Qing Gu
Journal: Journal of Control Science and Engineering
 (2016)

---

## Abstract

This paper proposes a novel relative navigation control strategy based on the relation space method (RSM) for articulated underground trackless vehicles. In the RSM, a self-organizing, competitive neural network is used to identify the space around the vehicle, and the spatial geometric relationships of the identified space are used to determine the vehicle’s optimal driving direction. For driving control, the trajectories of the articulated vehicles are analyzed, and data-based steering and speed control modules are developed to reduce modeling complexity. Simulation shows that the proposed RSM can choose the correct directions for articulated vehicles in different tunnels. The effectiveness and feasibility of the resulting novel relative navigation control strategy are validated through experiments.


---

## Body

## 1. Introduction

Underground mining has an important role in the acquisition of many of the world’s natural resources, and articulated vehicles are typically used for underground mining operations, since they have the small turning radii required for navigating the narrow tunnels in most underground environments. With the application of new equipment and technology, intelligent underground mining vehicles have been the object of significant development in recent decades, which has greatly improved mining safety and efficiency [1]. Autonomous navigation is central to the operation of such vehicles, and many navigation techniques are in use, including global positioning (GPS), inertial navigation (INS), and ultrasonic positioning systems [2–4]. Many existing autonomous robots use computer vision and other sensors to supplement GPS data when navigating. However, most of these navigation methods cannot be applied in the underground due to the inherent uncertainty in the environment. For instance, there are no detectable GPS signals in underground environments, the detection range of normal ultrasonic radar is limited and unstable underground, and the cost of an INS is too high. Compared to the above-mentioned three positioning methods, laser radar is an ideal positioning device in underground environments owing to its wide detection range and reasonable cost; laser range finders have been successfully used in agricultural robots [5], for example.Navigation methods can be divided into absolute and relative navigation according to whether the environmental model (e.g., map information) is needed or not [6]. For absolute navigation, the driving path for the vehicle must be planned beforehand. Optimal path planning and integrated local trajectory planning have been used for autonomous ground vehicles [7–9]. The vehicles’ absolute position with respect to some fixed real-world coordinate system must be known (known as localization), which is normally obtained by dead reckoning through the data transferred by sensors installed in the vehicle [10–12]. This type of navigation should keep the vehicle following the predetermined path, which requires map path and artificial marking equipment. However, the cost of the positioning device in a large-scale mining operation is extremely high, and underground mining environments change with the depth of the mine, which requires the planned path to be updated in real time. Therefore, the utilization of absolute navigation is restricted to some extent in underground mining operations.Relative navigation, on the other hand, does not require an environmental model, and it is unnecessary to plan the driving path using an accurate position on the map. By applying the relative navigation method, the vehicle can sense its surrounding via on-board sensors that detect the shape and size of the tunnel in front of the vehicle in order to avoid collisions; the method has been widely applied by some mining companies by implementing supersonic detectors [13–15]. Traditional relative navigation has limitations in complex tunnel environments, such as the inability to choose the correct way to proceed at intersections. Therefore, Roberts has proposed a “nodal map” method to enable the relative navigation method to choose the correct way to proceed intersections [16]. However, improving the navigation driving efficiency remains a problem. In this paper, a novel relative navigation control strategy that considers the structural and driving features of articulated vehicles is proposed to improve autonomous driving efficiency. The kinematics model is built based on the articulated structure, and the steering and speed control models are built based on the vehicle’s operation data, which has both high applicability and low complexity. The space information is processed using a self-organizing, competitive neural network, through which the space is divided into free space and trap space. According to the different impacts of the space information in front of the vehicle, the relation space method (RSM) is proposed as the key to a vehicle being able to choose the correct driving direction.The remainder of this paper is organized as follows. In Section2, we describe how to identify the space information using a self-organizing, competitive neural network and how to find the optimal strategy direction using the RSM. In Section 3, we outline the kinematics and dynamic models of an articulated vehicle. The dynamic model is built based on the data that are collected from the prototype. The control method is also described in this section. In Section 4, we focus on the results of simulation and experiment; we present conclusions in Section 5.


## 2. Relation Space Method

In underground mining operations, tunnel environments change over the course of tunnel length. Since there is no planned path for the vehicle using relative navigation, the information about the space around the vehicle therefore becomes very important, which not only affects the vehicle’s driving mode but also determines navigational accuracy. The vehicle’s navigation is designed based on the space information, and thus the navigational method proposed in this paper is designated as the relation space method. The first step in the RSM is to identify the space around the vehicle using a self-organizing, competitive neural network, which can be used to determine the vehicle’s optimal driving direction based on the existing spatial geometric relationships.


### 2.1. Space Identification

As mentioned above, the first step in the RSM is to identify the space. Since artificial neural networks have been widely used in statistical classification problems owing to their strong self-organizing characteristics, adaptability, fault tolerance, and reasoning ability, they have given good results [17, 18]. Thus, in this paper, we apply a self-organizing, competitive neural network to identify the space information, which is a way of training the network’s self-organizing feature. In this paper, laser radar is used to detect the underground environment, leveraging its features of high resolution, strong antijamming ability, small volume, and low cost.Figure1 shows the basic self-organizing, competitive network structure, which includes input and competitive layers. The input sample of the network is X=x1,x2,…,xn and the output is U=u1,u2,…,uq. wij denotes the competitive weight from input nodes to neurons, and it can be modified through training. The neurons in the input layer of the self-organizing network are connected to neurons in the output layer through the weight, and the neurons in the competitive layer compete with each other, and only one or a few neurons can “win” to adapt to the current input sample. The competitive learning rule is the main factor. The connection-weight value of the network is wiji=1,2,…,N,j=1,2,…,M, and it satisfies the constraint conditions(1)∑i=1Nwij=1.The input samples are binary vectors, and, for the state of competitive-layer neurons j, the weight sum of the input node is given according to (2) as follows:(2)Si=∑i=1nwij·xi.xi in (2) are the ith elements of the input sample vector. According to the mechanism of competition, k neurons with maximum weight values win. The output is (3)uk=1,Sk>Sj,∀j,k≠j,0,others.For each i, the weights after the competition are amended in accordance with(4)wij=wij+η·xi-wij,where η is the learning parameter, which is generally taken to be in the range of 0 to 1. In consideration of the learning efficiency, in this paper, η is set to 0.1.Figure 1
General structure of self-organizing, competitive neural network.Figure2 is a flowchart of the space identification using a self-organizing, competitive neural network. The first step is to obtain the space data, collected from the laser radar, which were normalized using a normalized formula. The second step is to create the neural network, which needs to be initialized and trained. The competitive neural network is applied in no-teacher learning, and there is no desired output, so there is no need to set up the training process to judge whether the end of network training results in an error. The network training number must be set to determine the training efficiency; in this paper, it is set to 1000. After training, a simulation function is used to check the network-classified space model. If the space identification is not successful, the network should be reinitialized, retrained, and retested. There are two output types, denoted as free space and trap space. Free space is the region that the vehicle can go through and trap space is the region that the vehicle should avoid.Figure 2
Flowchart of space identification process.


### 2.2. Optimal Driving Direction

After the space is divided into free space and trap space using the self-organizing, competitive neural network, the vehicle’s optimal driving direction is determined based on the spatial geometric relationships. Figure3 shows the free space and trap space for the vehicle in the tunnel environment, as well as an obstacle in front of the vehicle. Figure 3(a) shows all of the free and trap spaces identified using the neural network; the points marked with asterisks represent the free space and those marked with open circles represent the trap space. Figure 3(b) shows the coordinate system built for the navigational method proposed in this paper. Its origin point is located at the center of the laser radar, its y-axis is in the direction of the course angle of the vehicle, and its x-axis can be obtained by applying the right-hand screw rule. Pi(xi,yi) are the detected points in steps of Δθ, and Δθ=1° in this paper; i(i=1,2,…,N) is the index of the detected points and DOPi is the distance between the origin point O and Pi. It is known that Pi(xi,yi) are the positions of the wall or the obstacles. In the complex environment, the free space is not unique, which is defined as the sub-free space (SFS), based on whether the index of the detected points, I, is continuous. The SFS is denoted as SFj (j∈Z,j=1,2,…,M). There are two SFSs depicted in Figure 3(b), and therefore M=2.Figure 3
Free space and trap spacea,b,c,d∈Z,2<a<b<c<d<N.
(a) (b)All of the SFSs are candidate driving regions, but the best direction for the vehicle still needs to be determined. The optimal strategic direction is defined as the angular bisector of two laser beams in the largest-area SFS. In order to calculate the area of the subspaces, the area formula of a triangle can be applied. The area of the two laser beams is denoted asΔ, which can be approximately calculated by(5)Δ=12·DOPi·DOPi+1·sin⁡Δθ.In Figure 3, the triangles POPaPb and POPcPd are two SFSs, θj refers to the detection angle of SFj, and the straight lines OBj form the angular bisector of θj. Each OBj is a candidate optimal strategic direction. The area of SFj is denoted as ΔSFj, and the indexes of the detected points in the two boundary beams of SFj are denoted as Uj and Vj, respectively. On the basis of (5), ΔSFj can be calculated approximately by (6)ΔSFj=12·∑k=UjVj-1DOPk·DOPk+1·sinΔθ.We call ΔSFj the relation space, and the larger ΔSFj is, the more likely the optimal strategic direction is contained in it. However, if the areas of two SFSs are equal, it is impossible to find the optimal strategic direction by only comparing the areas. Both the area and the space angle of a SFS affect the selection of the optimal strategic direction. The larger the space angle, the wider the SFS. Therefore, an impact factor M is introduced and designated as the relation space factor, and it is written as(7)Mj=ΔSFj·θj.The optimal strategic direction is Mmax, which can be obtained by(8)Mmax=max⁡M1,M2,…,Mj.


## 2.1. Space Identification

As mentioned above, the first step in the RSM is to identify the space. Since artificial neural networks have been widely used in statistical classification problems owing to their strong self-organizing characteristics, adaptability, fault tolerance, and reasoning ability, they have given good results [17, 18]. Thus, in this paper, we apply a self-organizing, competitive neural network to identify the space information, which is a way of training the network’s self-organizing feature. In this paper, laser radar is used to detect the underground environment, leveraging its features of high resolution, strong antijamming ability, small volume, and low cost.Figure1 shows the basic self-organizing, competitive network structure, which includes input and competitive layers. The input sample of the network is X=x1,x2,…,xn and the output is U=u1,u2,…,uq. wij denotes the competitive weight from input nodes to neurons, and it can be modified through training. The neurons in the input layer of the self-organizing network are connected to neurons in the output layer through the weight, and the neurons in the competitive layer compete with each other, and only one or a few neurons can “win” to adapt to the current input sample. The competitive learning rule is the main factor. The connection-weight value of the network is wiji=1,2,…,N,j=1,2,…,M, and it satisfies the constraint conditions(1)∑i=1Nwij=1.The input samples are binary vectors, and, for the state of competitive-layer neurons j, the weight sum of the input node is given according to (2) as follows:(2)Si=∑i=1nwij·xi.xi in (2) are the ith elements of the input sample vector. According to the mechanism of competition, k neurons with maximum weight values win. The output is (3)uk=1,Sk>Sj,∀j,k≠j,0,others.For each i, the weights after the competition are amended in accordance with(4)wij=wij+η·xi-wij,where η is the learning parameter, which is generally taken to be in the range of 0 to 1. In consideration of the learning efficiency, in this paper, η is set to 0.1.Figure 1
General structure of self-organizing, competitive neural network.Figure2 is a flowchart of the space identification using a self-organizing, competitive neural network. The first step is to obtain the space data, collected from the laser radar, which were normalized using a normalized formula. The second step is to create the neural network, which needs to be initialized and trained. The competitive neural network is applied in no-teacher learning, and there is no desired output, so there is no need to set up the training process to judge whether the end of network training results in an error. The network training number must be set to determine the training efficiency; in this paper, it is set to 1000. After training, a simulation function is used to check the network-classified space model. If the space identification is not successful, the network should be reinitialized, retrained, and retested. There are two output types, denoted as free space and trap space. Free space is the region that the vehicle can go through and trap space is the region that the vehicle should avoid.Figure 2
Flowchart of space identification process.


## 2.2. Optimal Driving Direction

After the space is divided into free space and trap space using the self-organizing, competitive neural network, the vehicle’s optimal driving direction is determined based on the spatial geometric relationships. Figure3 shows the free space and trap space for the vehicle in the tunnel environment, as well as an obstacle in front of the vehicle. Figure 3(a) shows all of the free and trap spaces identified using the neural network; the points marked with asterisks represent the free space and those marked with open circles represent the trap space. Figure 3(b) shows the coordinate system built for the navigational method proposed in this paper. Its origin point is located at the center of the laser radar, its y-axis is in the direction of the course angle of the vehicle, and its x-axis can be obtained by applying the right-hand screw rule. Pi(xi,yi) are the detected points in steps of Δθ, and Δθ=1° in this paper; i(i=1,2,…,N) is the index of the detected points and DOPi is the distance between the origin point O and Pi. It is known that Pi(xi,yi) are the positions of the wall or the obstacles. In the complex environment, the free space is not unique, which is defined as the sub-free space (SFS), based on whether the index of the detected points, I, is continuous. The SFS is denoted as SFj (j∈Z,j=1,2,…,M). There are two SFSs depicted in Figure 3(b), and therefore M=2.Figure 3
Free space and trap spacea,b,c,d∈Z,2<a<b<c<d<N.
(a) (b)All of the SFSs are candidate driving regions, but the best direction for the vehicle still needs to be determined. The optimal strategic direction is defined as the angular bisector of two laser beams in the largest-area SFS. In order to calculate the area of the subspaces, the area formula of a triangle can be applied. The area of the two laser beams is denoted asΔ, which can be approximately calculated by(5)Δ=12·DOPi·DOPi+1·sin⁡Δθ.In Figure 3, the triangles POPaPb and POPcPd are two SFSs, θj refers to the detection angle of SFj, and the straight lines OBj form the angular bisector of θj. Each OBj is a candidate optimal strategic direction. The area of SFj is denoted as ΔSFj, and the indexes of the detected points in the two boundary beams of SFj are denoted as Uj and Vj, respectively. On the basis of (5), ΔSFj can be calculated approximately by (6)ΔSFj=12·∑k=UjVj-1DOPk·DOPk+1·sinΔθ.We call ΔSFj the relation space, and the larger ΔSFj is, the more likely the optimal strategic direction is contained in it. However, if the areas of two SFSs are equal, it is impossible to find the optimal strategic direction by only comparing the areas. Both the area and the space angle of a SFS affect the selection of the optimal strategic direction. The larger the space angle, the wider the SFS. Therefore, an impact factor M is introduced and designated as the relation space factor, and it is written as(7)Mj=ΔSFj·θj.The optimal strategic direction is Mmax, which can be obtained by(8)Mmax=max⁡M1,M2,…,Mj.


## 3. Driving Control for an Articulated Vehicle

### 3.1. Kinematics Model of an Articulated Vehicle

Driving control for articulated vehicles includes steering and speed control. An underground mining vehicles’ top speed is usually low (25km/h) and its gross dead weight is very large; therefore, we assume that the wheels of the articulated vehicle do not slip. Figure 4 shows the geometry of an articulated vehicle in steering operations. The dynamic model of the articulated vehicle considered in this paper has a front section and rear section, which are connected by a joint H. The front and rear sections can rotate relative to each other, and steering is achieved by driving the articulation joint. In Figure 4, λ refers to the articulated angle and V refers to the ground speed of the front body; η1 and η2 are defined as the orientation angle of the front body and back body with respect to x-axis, respectively. The half-length of the body is defined as the distance between the front bumper or rear bumper of the vehicle and the articulation joint, referred to as l1 and l2, respectively. P1x1,y1 and P2x2,y2 refer to the coordinates of the middle point of the vehicle’s front and rear bumpers, respectively. Point O′′ is the center of the turning circle, and r1 and r2 are defined as the distance between O′′ and P1,P2, respectively [19–23].Figure 4
Geometry of the articulated vehicle while steering.The equations of linesP1H and P2H are, respectively, defined as (9)y=k1·x+b1,(10)y=k2·x+b2,where k1 and b1 are the linear slope and intercept of line P1H, respectively, and k2 and b2 are the linear slope and intercept of line P2H, respectively. Combining (9) and (10), it is straightforward to obtain the coordinates of point O′′ as follows:(11)x=b2-b1k1-k2,y=k1·b2-b1k1-k2+b1.Based on the dynamic characteristics of the articulated vehicle, for the first body, we have (12)x1˙=v·cos⁡η1,y1˙=v·sin⁡η1.According to the geometric relationship of P1 and P2, we can show that(13)x2+l2·cos⁡η2+l1·cos⁡η1=x1,y2+l2·sin⁡η2+l1·sin⁡η1=y1,and it is straightforward to obtain(14)η1=η2-γ.Since we have assumed that there is no slip, we have(15)x2˙·sin⁡η2-y2˙·cos⁡η2=0,x1˙·sin⁡η1-y1˙·cos⁡η1=0.Differentiating (11) with respect to time, substituting in (12) and (15), the angular velocity equation is obtained as follows:(16)η1˙=-v·sin⁡γ-l2·γ˙l1·cos⁡γ+l2.


### 3.2. Obstacles along the Vehicle’s Trajectory

It is important to determine the obstacles along the vehicle’s trajectory, since they affect the vehicle’s driving strategy. Figure5 shows the obstacles along the trajectory, where O is the center of the laser radar and also the original point of the coordinate system; the points a,b,c,d and a′,b′,c′,d′ refer to the vehicle’s edge points on the right-hand side and left-hand side, respectively. λ refers to the articulated angle, O′ refers to the center point of the trajectory ring, Pi refers to the position of the obstacle, DOPi refers to the linear distance between O and Pi, and β refers to the orientation of line OPi with respect to the x-axis. Rc and Rf are the inner and outer diameters of the trajectory ring, respectively, and l1 and l2 are the lengths of the front and rear parts of the trajectory ring, respectively.Figure 5
Obstacles along the vehicle’s trajectory.Based on the geometric relationship, we have(17)xi=DOPi·cos⁡β,yi=DOPi·sin⁡β.The coordinate of point O′ can be written as(18)xO′=l2·sin⁡λ+l1+l2·cos⁡λtan⁡λ,yO′=0.It can be seen that when the vehicle turns right,(19)Rc=min⁡DO′a,DO′d,Rf=max⁡DO′b′,DO′c′,where DO′a, DO′d, DO′b′, and DO′c′ refer to the distance between O′ and a,d,b′, and c′, respectively, especially when l1=l2, DO′a=DO′d, and DO′b′=DO′c′. The distance between Pi and O′ is denoted as disi(i=1,2,3,…,N):(20)disi=DOPi·cos⁡β-l2·sin⁡λ+l1+l2·cos⁡λtan⁡λ2+DOPi·sin⁡β2.The obstacles along the trajectory ring actually affect the vehicle’s driving; these obstacles are designated as positive obstacles in this paper. These positive obstacles can be selected by the following equation:(21)Rc≤disi≤Rf.The coordinates of the positive obstacles are saved in array Q as (22)Q=x1,y1,x2,y2,x3,y3,…,xi,yi.


### 3.3. Data-Based Steering and Speed Control Module

The trajectory of the articulated vehicle and the obstacles affecting the vehicle’s driving have been analyzed in the preceding sections. The steering and speed control are very important parts of the vehicle’s overall driving control, the effects of which mostly depend on the vehicle’s kinematics model [24, 25]. Therefore, it is essential to build the vehicle’s steering and speed kinematics models as accurately as possible, a strategy validated by the fact that a data-driven approach to control methodology has improved the navigational efficiency of ground robots [26, 27]. For the method described in this paper, the steering and speed models are built based on the vehicle’s operation data in order to reduce the modeling complexity.


#### 3.3.1. Data-Based Steering Control Module

It is easy to collect the vehicle’s articulated angle, steering time, and so forth, which can clearly reflect the vehicle’s steering kinematics model. The optimal strategic direction has been found using the RSM. The articulated angle is denoted asλ and the angle of optimal strategic direction with respect to the x-axis in the coordinate system is denoted as φ, with each φ relative to an articulated angle λ(strategy). It is known that each articulated angle is relative to a time point; therefore, the steering time TS(L-R) (steering from left to right) or TS(R-L) (steering from right to left) from a given current position to a strategic direction can be obtained using the dichotomy principle. In consideration of driving smoothness and safety, a threshold value, denoted as TS, is set. TS is an experience parameter that can prevent the vehicle from steering too often. The steering rules are as follows:(i)
Ifλ-λ(strategy)>0 and TS(R-L)≤TS, then steer left.(ii)
Ifλ-λ(strategy)<0 and TS(L-R)≤TS, then steer right.(iii)
TS(L-R)>TS and TS(R-L)>TS; then maintain the current articulated angle.These rules not only make the vehicle drive along the strategic direction but also improve its driving smoothness.


#### 3.3.2. Data-Based Speed Control Module

Unlike passenger vehicles, the articulated mining vehicles’ driving mode is much simpler, typically consisting of constant, acceleration, deceleration, and braking modes. It is easy to collect the vehicle’s driving speed and time, which can clearly reflect the vehicle’s speed kinematics model.The effects of positive obstacles on the vehicle’s speed control have been analyzed previously. To ensure the safety of articulated vehicles, allowanceδ′ is introduced in the speed control. The trajectory for speed control can be rewritten as (23)Rc-δ′≤disi≤Rf+δ′,in which allowance δ′ acts as an experience parameter that can offset speed control errors. Based on (23), the objective obstacle points in the speed control are obtained, which are saved in array QV: (24)QV=xV1,yV1,xV2,yV2,xV3,yV3,…,xVi,yVi.The distance between the vehicle and the obstacles in QV is actually arcs, denoted as DVi; therefore, we have(25)DVi=arcsin⁡yViyVi2+xV1-xVi2·disti1≤i≤N,and the minimum value of DVi is(26)DVmin=minDV1,DV2,DV3,…,DVi.The vehicle’s driving time considering DVmin at a speed v can be written as(27)T=DVminv.It can be seen from (25)–(27) that each velocity is relative to a time point, and therefore the driving times considering DVmin in deceleration and braking modes are denoted as Td and Tb, respectively.The drivers can change the vehicle’s driving mode by comparingT, Td, and Tb. In the method described in this paper, the vehicle’s speed control is achieved by imitating the driver’s driving habits, and the control rules are as follows:(i)
IfT>kd·Td, then speed up.(ii)
IfTd<T≤kd·Td, then maintain current speed.(iii)
IfkbTb<T≤Td, then slow down.(iv)
IfT≤kb·Tb, then brake.In the above rules,kb and kd are amplification factors for braking and deceleration times, respectively (0<kb<1,kd>1). These amplification factors provide allowance for not only eliminating errors but also ensuring the safety of the vehicle; they can be adjusted according to the sizes of the vehicle and of the tunnel. The amplification factors and safety distance, denoted as L, are indispensable. The vehicle will initiate emergency braking immediately if the distance between the vehicle and the obstacles is shorter than L, which is the highest priority. The safety distance is related to the vehicle’s structure, and it can further increase the vehicle’s security; and L=15cm in this paper.


## 3.1. Kinematics Model of an Articulated Vehicle

Driving control for articulated vehicles includes steering and speed control. An underground mining vehicles’ top speed is usually low (25km/h) and its gross dead weight is very large; therefore, we assume that the wheels of the articulated vehicle do not slip. Figure 4 shows the geometry of an articulated vehicle in steering operations. The dynamic model of the articulated vehicle considered in this paper has a front section and rear section, which are connected by a joint H. The front and rear sections can rotate relative to each other, and steering is achieved by driving the articulation joint. In Figure 4, λ refers to the articulated angle and V refers to the ground speed of the front body; η1 and η2 are defined as the orientation angle of the front body and back body with respect to x-axis, respectively. The half-length of the body is defined as the distance between the front bumper or rear bumper of the vehicle and the articulation joint, referred to as l1 and l2, respectively. P1x1,y1 and P2x2,y2 refer to the coordinates of the middle point of the vehicle’s front and rear bumpers, respectively. Point O′′ is the center of the turning circle, and r1 and r2 are defined as the distance between O′′ and P1,P2, respectively [19–23].Figure 4
Geometry of the articulated vehicle while steering.The equations of linesP1H and P2H are, respectively, defined as (9)y=k1·x+b1,(10)y=k2·x+b2,where k1 and b1 are the linear slope and intercept of line P1H, respectively, and k2 and b2 are the linear slope and intercept of line P2H, respectively. Combining (9) and (10), it is straightforward to obtain the coordinates of point O′′ as follows:(11)x=b2-b1k1-k2,y=k1·b2-b1k1-k2+b1.Based on the dynamic characteristics of the articulated vehicle, for the first body, we have (12)x1˙=v·cos⁡η1,y1˙=v·sin⁡η1.According to the geometric relationship of P1 and P2, we can show that(13)x2+l2·cos⁡η2+l1·cos⁡η1=x1,y2+l2·sin⁡η2+l1·sin⁡η1=y1,and it is straightforward to obtain(14)η1=η2-γ.Since we have assumed that there is no slip, we have(15)x2˙·sin⁡η2-y2˙·cos⁡η2=0,x1˙·sin⁡η1-y1˙·cos⁡η1=0.Differentiating (11) with respect to time, substituting in (12) and (15), the angular velocity equation is obtained as follows:(16)η1˙=-v·sin⁡γ-l2·γ˙l1·cos⁡γ+l2.


## 3.2. Obstacles along the Vehicle’s Trajectory

It is important to determine the obstacles along the vehicle’s trajectory, since they affect the vehicle’s driving strategy. Figure5 shows the obstacles along the trajectory, where O is the center of the laser radar and also the original point of the coordinate system; the points a,b,c,d and a′,b′,c′,d′ refer to the vehicle’s edge points on the right-hand side and left-hand side, respectively. λ refers to the articulated angle, O′ refers to the center point of the trajectory ring, Pi refers to the position of the obstacle, DOPi refers to the linear distance between O and Pi, and β refers to the orientation of line OPi with respect to the x-axis. Rc and Rf are the inner and outer diameters of the trajectory ring, respectively, and l1 and l2 are the lengths of the front and rear parts of the trajectory ring, respectively.Figure 5
Obstacles along the vehicle’s trajectory.Based on the geometric relationship, we have(17)xi=DOPi·cos⁡β,yi=DOPi·sin⁡β.The coordinate of point O′ can be written as(18)xO′=l2·sin⁡λ+l1+l2·cos⁡λtan⁡λ,yO′=0.It can be seen that when the vehicle turns right,(19)Rc=min⁡DO′a,DO′d,Rf=max⁡DO′b′,DO′c′,where DO′a, DO′d, DO′b′, and DO′c′ refer to the distance between O′ and a,d,b′, and c′, respectively, especially when l1=l2, DO′a=DO′d, and DO′b′=DO′c′. The distance between Pi and O′ is denoted as disi(i=1,2,3,…,N):(20)disi=DOPi·cos⁡β-l2·sin⁡λ+l1+l2·cos⁡λtan⁡λ2+DOPi·sin⁡β2.The obstacles along the trajectory ring actually affect the vehicle’s driving; these obstacles are designated as positive obstacles in this paper. These positive obstacles can be selected by the following equation:(21)Rc≤disi≤Rf.The coordinates of the positive obstacles are saved in array Q as (22)Q=x1,y1,x2,y2,x3,y3,…,xi,yi.


## 3.3. Data-Based Steering and Speed Control Module

The trajectory of the articulated vehicle and the obstacles affecting the vehicle’s driving have been analyzed in the preceding sections. The steering and speed control are very important parts of the vehicle’s overall driving control, the effects of which mostly depend on the vehicle’s kinematics model [24, 25]. Therefore, it is essential to build the vehicle’s steering and speed kinematics models as accurately as possible, a strategy validated by the fact that a data-driven approach to control methodology has improved the navigational efficiency of ground robots [26, 27]. For the method described in this paper, the steering and speed models are built based on the vehicle’s operation data in order to reduce the modeling complexity.


### 3.3.1. Data-Based Steering Control Module

It is easy to collect the vehicle’s articulated angle, steering time, and so forth, which can clearly reflect the vehicle’s steering kinematics model. The optimal strategic direction has been found using the RSM. The articulated angle is denoted asλ and the angle of optimal strategic direction with respect to the x-axis in the coordinate system is denoted as φ, with each φ relative to an articulated angle λ(strategy). It is known that each articulated angle is relative to a time point; therefore, the steering time TS(L-R) (steering from left to right) or TS(R-L) (steering from right to left) from a given current position to a strategic direction can be obtained using the dichotomy principle. In consideration of driving smoothness and safety, a threshold value, denoted as TS, is set. TS is an experience parameter that can prevent the vehicle from steering too often. The steering rules are as follows:(i)
Ifλ-λ(strategy)>0 and TS(R-L)≤TS, then steer left.(ii)
Ifλ-λ(strategy)<0 and TS(L-R)≤TS, then steer right.(iii)
TS(L-R)>TS and TS(R-L)>TS; then maintain the current articulated angle.These rules not only make the vehicle drive along the strategic direction but also improve its driving smoothness.


### 3.3.2. Data-Based Speed Control Module

Unlike passenger vehicles, the articulated mining vehicles’ driving mode is much simpler, typically consisting of constant, acceleration, deceleration, and braking modes. It is easy to collect the vehicle’s driving speed and time, which can clearly reflect the vehicle’s speed kinematics model.The effects of positive obstacles on the vehicle’s speed control have been analyzed previously. To ensure the safety of articulated vehicles, allowanceδ′ is introduced in the speed control. The trajectory for speed control can be rewritten as (23)Rc-δ′≤disi≤Rf+δ′,in which allowance δ′ acts as an experience parameter that can offset speed control errors. Based on (23), the objective obstacle points in the speed control are obtained, which are saved in array QV: (24)QV=xV1,yV1,xV2,yV2,xV3,yV3,…,xVi,yVi.The distance between the vehicle and the obstacles in QV is actually arcs, denoted as DVi; therefore, we have(25)DVi=arcsin⁡yViyVi2+xV1-xVi2·disti1≤i≤N,and the minimum value of DVi is(26)DVmin=minDV1,DV2,DV3,…,DVi.The vehicle’s driving time considering DVmin at a speed v can be written as(27)T=DVminv.It can be seen from (25)–(27) that each velocity is relative to a time point, and therefore the driving times considering DVmin in deceleration and braking modes are denoted as Td and Tb, respectively.The drivers can change the vehicle’s driving mode by comparingT, Td, and Tb. In the method described in this paper, the vehicle’s speed control is achieved by imitating the driver’s driving habits, and the control rules are as follows:(i)
IfT>kd·Td, then speed up.(ii)
IfTd<T≤kd·Td, then maintain current speed.(iii)
IfkbTb<T≤Td, then slow down.(iv)
IfT≤kb·Tb, then brake.In the above rules,kb and kd are amplification factors for braking and deceleration times, respectively (0<kb<1,kd>1). These amplification factors provide allowance for not only eliminating errors but also ensuring the safety of the vehicle; they can be adjusted according to the sizes of the vehicle and of the tunnel. The amplification factors and safety distance, denoted as L, are indispensable. The vehicle will initiate emergency braking immediately if the distance between the vehicle and the obstacles is shorter than L, which is the highest priority. The safety distance is related to the vehicle’s structure, and it can further increase the vehicle’s security; and L=15cm in this paper.


## 3.3.1. Data-Based Steering Control Module

It is easy to collect the vehicle’s articulated angle, steering time, and so forth, which can clearly reflect the vehicle’s steering kinematics model. The optimal strategic direction has been found using the RSM. The articulated angle is denoted asλ and the angle of optimal strategic direction with respect to the x-axis in the coordinate system is denoted as φ, with each φ relative to an articulated angle λ(strategy). It is known that each articulated angle is relative to a time point; therefore, the steering time TS(L-R) (steering from left to right) or TS(R-L) (steering from right to left) from a given current position to a strategic direction can be obtained using the dichotomy principle. In consideration of driving smoothness and safety, a threshold value, denoted as TS, is set. TS is an experience parameter that can prevent the vehicle from steering too often. The steering rules are as follows:(i)
Ifλ-λ(strategy)>0 and TS(R-L)≤TS, then steer left.(ii)
Ifλ-λ(strategy)<0 and TS(L-R)≤TS, then steer right.(iii)
TS(L-R)>TS and TS(R-L)>TS; then maintain the current articulated angle.These rules not only make the vehicle drive along the strategic direction but also improve its driving smoothness.


## 3.3.2. Data-Based Speed Control Module

Unlike passenger vehicles, the articulated mining vehicles’ driving mode is much simpler, typically consisting of constant, acceleration, deceleration, and braking modes. It is easy to collect the vehicle’s driving speed and time, which can clearly reflect the vehicle’s speed kinematics model.The effects of positive obstacles on the vehicle’s speed control have been analyzed previously. To ensure the safety of articulated vehicles, allowanceδ′ is introduced in the speed control. The trajectory for speed control can be rewritten as (23)Rc-δ′≤disi≤Rf+δ′,in which allowance δ′ acts as an experience parameter that can offset speed control errors. Based on (23), the objective obstacle points in the speed control are obtained, which are saved in array QV: (24)QV=xV1,yV1,xV2,yV2,xV3,yV3,…,xVi,yVi.The distance between the vehicle and the obstacles in QV is actually arcs, denoted as DVi; therefore, we have(25)DVi=arcsin⁡yViyVi2+xV1-xVi2·disti1≤i≤N,and the minimum value of DVi is(26)DVmin=minDV1,DV2,DV3,…,DVi.The vehicle’s driving time considering DVmin at a speed v can be written as(27)T=DVminv.It can be seen from (25)–(27) that each velocity is relative to a time point, and therefore the driving times considering DVmin in deceleration and braking modes are denoted as Td and Tb, respectively.The drivers can change the vehicle’s driving mode by comparingT, Td, and Tb. In the method described in this paper, the vehicle’s speed control is achieved by imitating the driver’s driving habits, and the control rules are as follows:(i)
IfT>kd·Td, then speed up.(ii)
IfTd<T≤kd·Td, then maintain current speed.(iii)
IfkbTb<T≤Td, then slow down.(iv)
IfT≤kb·Tb, then brake.In the above rules,kb and kd are amplification factors for braking and deceleration times, respectively (0<kb<1,kd>1). These amplification factors provide allowance for not only eliminating errors but also ensuring the safety of the vehicle; they can be adjusted according to the sizes of the vehicle and of the tunnel. The amplification factors and safety distance, denoted as L, are indispensable. The vehicle will initiate emergency braking immediately if the distance between the vehicle and the obstacles is shorter than L, which is the highest priority. The safety distance is related to the vehicle’s structure, and it can further increase the vehicle’s security; and L=15cm in this paper.


## 4. Simulation and Experiment

The original data of the vehicle’s kinematics model are collected from the articulated vehicle prototype and include speed, articulated angle, and time. Two steering and three speed kinematics models of an articulated vehicle are generated using these data. In this paper, the order of the steering and speed fitting equations is 3. Figure6 shows the fitting curves of the vehicle steering process. The black asterisks represent the original data, the blue line represents the fitting curve, and the red line indicates the fitting error. The two steering kinematics models include steering from left to right and steering from right to left.Figure 6
Fitting curves for the vehicle steering from (a) left to right and from (b) right to left.
(a) (b)The cubic fitting equations of steering from left to right and steering from right to left are written, respectively, as(28)λL-R=0.0538t3-1.4437t2+15.9857t-50.92670≤t≤13.6,λR-L=-0.0376t3+1.0408t2-14.8118t-48.15760≤t≤12.6.Figure 7 shows the vehicle speed fitting curves in different driving modes. The three speed kinematics modes include acceleration, deceleration, and braking.Figure 7
Fitting curves of different speed modes: (a) acceleration; (b) deceleration; and (c) braking.
(a) (b) (c)The cubic fitting equations of the vehicle acceleration, deceleration, and braking modes can be written, respectively, as(29)Va=0.039528t3-0.435515t2+1.645189t-0.09138330≤t≤4.8,Vd=0.004281t3-0.077942t2+0.149005t+2.02599280≤t≤9.7,Vb=-24.309795t3-56.591949t2-32.670702t+2.2320530≤t≤1.4.


### 4.1. Simulation

We have developed software, the interface of which is shown in Figure8, to simulate an articulated vehicle driving in a tunnel environment. The articulated vehicle kinematics models were built before running the simulation. The structure parameters of the articulated vehicle and tunnel can be reset in the software, which were initially set according to an articulated vehicle prototype in our lab and the corridor of our laboratory building.Figure 8
Simulation software interface.Figure9 shows the driving tracks of the articulated vehicle based on the RSM in different tunnels. In the tunnel depicted in Figure 9(a), there is one sharp curve and one intersection; in that depicted in Figure 9(b), there is one right-angle curve and several obtuse-angle curves. The simulation result shows that the vehicle can drive in different tunnels smoothly.Figure 9
Simulation results of the articulated vehicle driving in different tunnels.
(a) (b)


### 4.2. Experiment

#### 4.2.1. Articulated Vehicle Prototype

After the algorithms have been verified in the simulation environment, we conducted experiments on our autonomous prototype research platform to verify the proposed control strategy. Figure10(a) is a structural diagram of the prototype, while Figure 10(b) is a photograph of the prototype in our laboratory. The prototype is scaled down based on a real mining vehicle, which includes one SICK LMS511-10100 laser radar, one ADVANTEC ARK-3500 (Intel i5, 2.5 GHz processor) industrial personal computer (IPC), one EPEC (3724) programmable logic controller, two DSP (TMS320F2808) drivers, one steering motor, one angle encoder, and one remote controller. The laser radar is mounted in the front body, with a detection range of 80 m and a detection angle range of −5° to 185° from left to right in steps of 1°, including 190 detection points. The update frequency of the data detection is 100 Hz. The IPC is physically the upper computer depicted in the figure used to identify the space information and run the relation space algorithm, while the EPEC is the lower computer. Two DSP drivers are used to drive the brushless direct current (BLDC) motors. The angle encoder is used to detect the articulated angle of the prototype.Figure 10
Articulated vehicle prototype.
(a) (b)Table1 lists the characteristics of the prototype.Table 1
Characteristics of articulated vehicle prototype.
Spec. Value Length of front body 521.5 mm Length of rear body 528.2 mm Width 1049.7 mm Tire radius 201.5 mm Rotation range Right, 47.9°; left, 44.4° Top speed 2.14 m/sFigure11 shows the map of the laboratory corridor in which the experiments were conducted. The width of the corridor is 2.2 m and the driving distance in the experiment is 40 m, starting from point A and stopping at D. The width ratio of the prototype to the corridor is very close to reality.Figure 11
Map of corridor.


#### 4.2.2. Experimental Results

We chose positions A, B, and C for space identification using a self-organizing, competitive neural network. Position A is the general tunnel, position B is the cross-road tunnel, and position C is the bend tunnel. We tested the space identification twice at C, once with no obstacles in the corner and once with an obstacle set up in the corner. The experiments essentially covered all navigational situations that an articulated vehicle may encounter driving in underground mining tunnels. Figure12 shows the result of space identification; the blue asterisks represent the free space, the red open circles represent the trap space, and the five-pointed stars represent the normalized center of the self-organizing, competitive neural network. It can be seen in the figure that the space can be classified into free space and trap space effectively in various driving situations using a self-organizing, artificial neural network.Figure 12
Result of space identification at (a) position A, (b) position B, (c) position C without a barrier in the corner, and (d) position C with an obstacle in the corner.
(a) (b) (c) (d)We also performed multigroup driving experiments in auto and manual modes, respectively. The space identification and driving control methods proposed in this paper are applied in auto mode. The most skilled person drives the prototype by remote controller in manual mode. Figure13 shows the vehicle’s articulated angle and speed during this experiment. The blue lines represent manual mode and the red lines represent auto mode. Specifically, Figure 13(a) shows that the articulated angle varies with time in both auto and manual modes, with right turns marked with a positive number and left turns marked with a negative number. It can be seen in the figure that the articulated angle has little fluctuation in auto mode. In the course of turning the corner, the articulated angle changes from left 11° to right 47° in manual mode, while it changes from left 10° to right 40° in auto mode. The smaller fluctuation of the articulated angle could make the prototype drive more smoothly and more stably. Figure 13(b) shows that the velocity varies with time in both auto and manual modes. It can be seen that the maximum speed in both modes is approximately 2 m/s; however, the average speeds are 0.8 and 0.75 m/s in auto and manual modes, respectively. These results prove that the relative navigation method proposed in this paper is efficient.Figure 13
Driving experiment results.
(a) (b)


## 4.1. Simulation

We have developed software, the interface of which is shown in Figure8, to simulate an articulated vehicle driving in a tunnel environment. The articulated vehicle kinematics models were built before running the simulation. The structure parameters of the articulated vehicle and tunnel can be reset in the software, which were initially set according to an articulated vehicle prototype in our lab and the corridor of our laboratory building.Figure 8
Simulation software interface.Figure9 shows the driving tracks of the articulated vehicle based on the RSM in different tunnels. In the tunnel depicted in Figure 9(a), there is one sharp curve and one intersection; in that depicted in Figure 9(b), there is one right-angle curve and several obtuse-angle curves. The simulation result shows that the vehicle can drive in different tunnels smoothly.Figure 9
Simulation results of the articulated vehicle driving in different tunnels.
(a) (b)


## 4.2. Experiment

### 4.2.1. Articulated Vehicle Prototype

After the algorithms have been verified in the simulation environment, we conducted experiments on our autonomous prototype research platform to verify the proposed control strategy. Figure10(a) is a structural diagram of the prototype, while Figure 10(b) is a photograph of the prototype in our laboratory. The prototype is scaled down based on a real mining vehicle, which includes one SICK LMS511-10100 laser radar, one ADVANTEC ARK-3500 (Intel i5, 2.5 GHz processor) industrial personal computer (IPC), one EPEC (3724) programmable logic controller, two DSP (TMS320F2808) drivers, one steering motor, one angle encoder, and one remote controller. The laser radar is mounted in the front body, with a detection range of 80 m and a detection angle range of −5° to 185° from left to right in steps of 1°, including 190 detection points. The update frequency of the data detection is 100 Hz. The IPC is physically the upper computer depicted in the figure used to identify the space information and run the relation space algorithm, while the EPEC is the lower computer. Two DSP drivers are used to drive the brushless direct current (BLDC) motors. The angle encoder is used to detect the articulated angle of the prototype.Figure 10
Articulated vehicle prototype.
(a) (b)Table1 lists the characteristics of the prototype.Table 1
Characteristics of articulated vehicle prototype.
Spec. Value Length of front body 521.5 mm Length of rear body 528.2 mm Width 1049.7 mm Tire radius 201.5 mm Rotation range Right, 47.9°; left, 44.4° Top speed 2.14 m/sFigure11 shows the map of the laboratory corridor in which the experiments were conducted. The width of the corridor is 2.2 m and the driving distance in the experiment is 40 m, starting from point A and stopping at D. The width ratio of the prototype to the corridor is very close to reality.Figure 11
Map of corridor.


### 4.2.2. Experimental Results

We chose positions A, B, and C for space identification using a self-organizing, competitive neural network. Position A is the general tunnel, position B is the cross-road tunnel, and position C is the bend tunnel. We tested the space identification twice at C, once with no obstacles in the corner and once with an obstacle set up in the corner. The experiments essentially covered all navigational situations that an articulated vehicle may encounter driving in underground mining tunnels. Figure12 shows the result of space identification; the blue asterisks represent the free space, the red open circles represent the trap space, and the five-pointed stars represent the normalized center of the self-organizing, competitive neural network. It can be seen in the figure that the space can be classified into free space and trap space effectively in various driving situations using a self-organizing, artificial neural network.Figure 12
Result of space identification at (a) position A, (b) position B, (c) position C without a barrier in the corner, and (d) position C with an obstacle in the corner.
(a) (b) (c) (d)We also performed multigroup driving experiments in auto and manual modes, respectively. The space identification and driving control methods proposed in this paper are applied in auto mode. The most skilled person drives the prototype by remote controller in manual mode. Figure13 shows the vehicle’s articulated angle and speed during this experiment. The blue lines represent manual mode and the red lines represent auto mode. Specifically, Figure 13(a) shows that the articulated angle varies with time in both auto and manual modes, with right turns marked with a positive number and left turns marked with a negative number. It can be seen in the figure that the articulated angle has little fluctuation in auto mode. In the course of turning the corner, the articulated angle changes from left 11° to right 47° in manual mode, while it changes from left 10° to right 40° in auto mode. The smaller fluctuation of the articulated angle could make the prototype drive more smoothly and more stably. Figure 13(b) shows that the velocity varies with time in both auto and manual modes. It can be seen that the maximum speed in both modes is approximately 2 m/s; however, the average speeds are 0.8 and 0.75 m/s in auto and manual modes, respectively. These results prove that the relative navigation method proposed in this paper is efficient.Figure 13
Driving experiment results.
(a) (b)


## 4.2.1. Articulated Vehicle Prototype

After the algorithms have been verified in the simulation environment, we conducted experiments on our autonomous prototype research platform to verify the proposed control strategy. Figure10(a) is a structural diagram of the prototype, while Figure 10(b) is a photograph of the prototype in our laboratory. The prototype is scaled down based on a real mining vehicle, which includes one SICK LMS511-10100 laser radar, one ADVANTEC ARK-3500 (Intel i5, 2.5 GHz processor) industrial personal computer (IPC), one EPEC (3724) programmable logic controller, two DSP (TMS320F2808) drivers, one steering motor, one angle encoder, and one remote controller. The laser radar is mounted in the front body, with a detection range of 80 m and a detection angle range of −5° to 185° from left to right in steps of 1°, including 190 detection points. The update frequency of the data detection is 100 Hz. The IPC is physically the upper computer depicted in the figure used to identify the space information and run the relation space algorithm, while the EPEC is the lower computer. Two DSP drivers are used to drive the brushless direct current (BLDC) motors. The angle encoder is used to detect the articulated angle of the prototype.Figure 10
Articulated vehicle prototype.
(a) (b)Table1 lists the characteristics of the prototype.Table 1
Characteristics of articulated vehicle prototype.
Spec. Value Length of front body 521.5 mm Length of rear body 528.2 mm Width 1049.7 mm Tire radius 201.5 mm Rotation range Right, 47.9°; left, 44.4° Top speed 2.14 m/sFigure11 shows the map of the laboratory corridor in which the experiments were conducted. The width of the corridor is 2.2 m and the driving distance in the experiment is 40 m, starting from point A and stopping at D. The width ratio of the prototype to the corridor is very close to reality.Figure 11
Map of corridor.


## 4.2.2. Experimental Results

We chose positions A, B, and C for space identification using a self-organizing, competitive neural network. Position A is the general tunnel, position B is the cross-road tunnel, and position C is the bend tunnel. We tested the space identification twice at C, once with no obstacles in the corner and once with an obstacle set up in the corner. The experiments essentially covered all navigational situations that an articulated vehicle may encounter driving in underground mining tunnels. Figure12 shows the result of space identification; the blue asterisks represent the free space, the red open circles represent the trap space, and the five-pointed stars represent the normalized center of the self-organizing, competitive neural network. It can be seen in the figure that the space can be classified into free space and trap space effectively in various driving situations using a self-organizing, artificial neural network.Figure 12
Result of space identification at (a) position A, (b) position B, (c) position C without a barrier in the corner, and (d) position C with an obstacle in the corner.
(a) (b) (c) (d)We also performed multigroup driving experiments in auto and manual modes, respectively. The space identification and driving control methods proposed in this paper are applied in auto mode. The most skilled person drives the prototype by remote controller in manual mode. Figure13 shows the vehicle’s articulated angle and speed during this experiment. The blue lines represent manual mode and the red lines represent auto mode. Specifically, Figure 13(a) shows that the articulated angle varies with time in both auto and manual modes, with right turns marked with a positive number and left turns marked with a negative number. It can be seen in the figure that the articulated angle has little fluctuation in auto mode. In the course of turning the corner, the articulated angle changes from left 11° to right 47° in manual mode, while it changes from left 10° to right 40° in auto mode. The smaller fluctuation of the articulated angle could make the prototype drive more smoothly and more stably. Figure 13(b) shows that the velocity varies with time in both auto and manual modes. It can be seen that the maximum speed in both modes is approximately 2 m/s; however, the average speeds are 0.8 and 0.75 m/s in auto and manual modes, respectively. These results prove that the relative navigation method proposed in this paper is efficient.Figure 13
Driving experiment results.
(a) (b)


## 5. Conclusions

This paper reports the results of an investigation of a relative navigation strategy based on the relation space method (RSM) for autonomous underground articulated vehicles. In the RSM, a self-organizing neural network was used to identify the vehicle’s driving space, and the vehicle’s optimal driving direction was determined using the spatial geometric relationships of the identified space, which allowed us to automatically obtain the correct direction to drive in various kinds of tunnels. The kinematics model of the articulated structure was deeply analyzed and applied to the speed and steering control of the vehicle. In order to reduce modeling complexity and improve computational efficiency, straightforward steering and speed control modules were built on the basis of the vehicle’s operation data, which is straightforward to implement in different vehicles even without knowing the specific vehicle parameters. Software was developed to verify the feasibility of primarily the driving control method. An additional set of experiments were carried out in the corridor of our laboratory using an articulated vehicle prototype. One set of experiments featured driving the prototype in manual mode by a driver with a remote controller; the other set used the automated driving method proposed in this paper. The results show that the vehicle can choose the correct direction over the course of the entire journey by applying the new method. Moreover, the articulated angle of the prototype in auto mode is less volatile than the articulated angle in manual mode, and, moreover, the average speed is improved. Comparisons of the results demonstrate the feasibility and effectiveness of the new strategy.



---

*Source: 2352805-2016-10-11.xml*