METHODS article

Front. Artif. Intell., 07 August 2020

Sec. Fuzzy Systems

Volume 3 - 2020 | https://doi.org/10.3389/frai.2020.00050

This article is part of the Research Topic Applied Fuzzy Technological Systems (AFTS) View all 4 articles

Intelligent Multirobot Navigation and Arrival-Time Control Using a Scalable PSO-Optimized Hierarchical Controller

$\nYu-Cheng Chang$ Yu-Cheng Chang¹^*

Anna Dostovalova²

Chin-Teng Lin¹

Jijoong Kim²

¹Computational Intelligence and Brain Computer Interface (CIBCI) Lab, Centre for Artificial Intelligence (CAI), University of Technology, Sydney, NSW, Australia
²Defence Science & Technology Group, Adelaide, SA, Australia

We present a hierarchical fuzzy logic system for precision coordination of multiple mobile agents such that they achieve simultaneous arrival at their destination positions in a cluttered urban environment. We assume that each agent is equipped with a 2D scanning Lidar to make movement decisions based on local distance and bearing information. Two solution approaches are considered and compared. Both of them are structured around a hierarchical arrangement of control modules to enable synchronization of the agents' arrival times while avoiding collision with obstacles. The proposed control module controls both moving speeds and directions of the robots to achieve the simultaneous target-reaching task. The control system consists of two levels: the lower-level individual navigation control for obstacle avoidance and the higher-level coordination control to ensure the same time of arrival for all robots at their target. The first approach is based on cascading fuzzy logic controllers, and the second approach considers the use of a Long Short-Term Memory recurrent neural network module alongside fuzzy logic controllers. The parameters of all the controllers are optimized using the particle swarm optimization algorithm. To increase the scalability of the proposed control modules, an interpolation method is introduced to determine the velocity scaling factors and the searching directions of the robots. A physics-based simulator, Webots, is used as a training and testing environment for the two learning models to facilitate the deployment of codes to hardware, which will be conducted in the next phase of our research.

Introduction

Mobile robot control has been widely used in automated navigation system. The aim of the automated navigation is to guide the robot or vehicle moving between obstacles to reach the target from the start point with collision-free performance (Kashyap and Pandey, 2018; Patle et al., 2019). During the navigation control, observations are made by the sensors and actuators equipped on a real robot or vehicle; the input signal is noisy and uncertain. Therefore, fuzzy logic system (FLS) (Zhu and Yang, 2007; Juang and Chang, 2011; Pothal and Parhi, 2015; Lai et al., 2016; Din et al., 2018; Jhang et al., 2019; Mohanta and Keshari, 2019; Pradhan et al., 2019) has been used in an automated navigation takes in order to enhance the robot control quality. Fuzzy logic systems (FLSs) provides a robust solution with anti-noise ability to defeat the uncertainty. However, the performance of fuzzy logic system depends on the design of membership function and efficient rules, which often takes a considerable amount of time to analyze the experimental input and output data. Machine learning technology, therefore, has been used for fuzzy system design. Zhu and Yang (2007) and Pothal and Parhi (2015), respectively, exploit supervised learning to train neuro-fuzzy model for single and multiple robots to perform navigation task. The precise input–output training data should be collected in advance for supervised learning. To reduce the training effort, evolutionary algorithms have been used to design FLS. Two popular optimization algorithms are genetic algorithms (GAs) (Chia-Feng, 2005; Mansoori et al., 2008; Nantogma et al., 2019; Pradhan et al., 2019) and particle swarm optimization (PSO) (Juang and Lo, 2008; Juang and Chang, 2011; Ding et al., 2019). These two methods can be easily applied to the design of FLS since it can be formulated as an optimization problem by defining a metric for solution performance evaluation.

Apart from single-agent navigation, the last few years have seen an increase in research topic (Pothal and Parhi, 2015; Misra et al., 2018; Babel, 2019; Chandrasekhar Rao and Kabat, 2019; Yao and Qi, 2019) for multirobot coordination across multiple disciplines. The multirobot coordination entails time synchronization among individuals to accomplish a given task. This study considers time-arrival control during the multiple robots performing navigation task; the robots not only need to move toward their targets with collision-free motion in a timely manner. Yao and Qi (2019) propose a novel dynamical model to adjust the path length and voyage speed of each autonomous underwater vehicle (AUV) to achieve the simultaneous arrival at destination between multi-AUVs. Misra et al. (2018) combine cooperative localization technique with proportional navigation (PN) guidance law to manipulate multiple unmanned vehicles to simultaneously reach a moving target in GPS-denied environment. Babel (Lin and Lee, 1996; Chia-Feng and Chin-Teng, 1998) develops a multi-agent path planning algorithm considering shortest paths between all pairs of air vehicles and targets, target allocation, and concatenating feasible and suitable short path, which guarantees that all UAVs arrive at the targets in a timely manner and without the risk of mutual collision.

This paper developed a fuzzy-based control system that has two levels: the lower-level individual navigation control for obstacle avoidance and the higher-level coordination to ensure the same time of arrival for all robots at their destination points. An FLS methodology (Lin and Lee, 1996; Chia-Feng and Chin-Teng, 1998; Juang and Chang, 2011), combining the Takagi-Sugeno-Kang (TSK) type of a fuzzy inference system with a derivative-free global optimization technique, is used to design the fuzzy “IF–THEN” rules and tune the parameters of membership functions. The controllers are trained in a cascading manner. In the first phase of training, we employ the particle swarm optimization (PSO) algorithm (Shi and Eberhart, 1998) to optimize the fuzzy rules that comprise individual navigation control. The role of this controller is to generate the motion direction command that steers the robot away from obstacles but toward the target location based on the robot's sensory inputs (each robot is equipped with a laser ranger) and information about target location. In the second phase of training, the same technique is used for multiple robots to learn how to coordinate with each other to reach their targets at the same time. The coordination controller controls both moving speeds and moving direction of each robot to achieve the simultaneous target reaching task. We developed a fuzzy-logic-based coordinator and a recurrent-based coordinator. The fuzzy-logic-based coordinator is implemented by a PSO-optimized FLS. The recurrent-based coordinator includes a PSO-trained long short-term memory (LSTM) block (Greff et al., 2017). Webots software (Webots: Robot simulator) has been used as a physics-based robot simulation environment for the training and testing of the proposed solutions.

The Proposed Models

This section describes the proposed models for multirobot navigation and arrival-time control. Figure 1 shows the configuration. There are two hierarchical levels of control module. The lower-level controllers are the robot navigation controllers (RNCs). They enable each robot to perform collision-free navigation. The higher-level controller is the multiple robot coordinator (MRC), which coordinates the robots' speed and direction so that they reach their targets at the same time.

FIGURE 1

Figure 1. The block diagram of the control configuration for multirobot navigation and arrival-time control.

In the proposed model, each RNC controls a robot, and all RNCs share an identical structure and a set of parameters. The RNC receives the adjustment angle, i.e., θ_adj(t), from the output of MRC, the distances between the robot and nearby obstacles, i.e., $\overset{⇀}{L}$ (t) from a 2D Lidar and the direction angle to the target from the robot, i.e., θ_goal(t). Specifically, a 2D Lidar rangefinder on the front of the robot scans from 0 to 180° and outputs $\overset{⇀}{L}$ (t) = (L₁, …, L₈), which are the minimum distances to any obstacle in each of eight sectors (Figure 2). The output of an RNC is the motion direction of the robot. To achieve collision-free navigation, a fuzzy logic controller (FLC) was added to the RNC. The robot avoids obstacles using boundary-following (BF) behavior. A behavior supervisor (BS) decides what the robot should do at each control time step.

FIGURE 2

Figure 2. Scanning area of the 2D Lidar in the simulation setting.

The MRC is a centralized controller to determine the speed and direction of each robot for the next control time step with five inputs: $D_{g o a l}^{r a n k_{1}} (t - 1)$ , $D_{g o a l}^{r a n k_{n}} (t - 1)$ , $v_{r}^{r a n k_{1}} (t - 1)$ , $v_{r}^{r a n k_{n}} (t - 1)$ , and ΔD(t−1). For each control loop, the robots are ranked in ascending distance from the target. Accordingly, robot_rank₁ is the closest robot to the target, and robot_{rank_n} is the robot farthest away. $D_{g o a l}^{r a n k_{1}}$ and $D_{g o a l}^{r a n k_{n}}$ are, respectively, the distances from robot_rank₁ and robot_{rank_n}to the target. $v_{r}^{r a n k_{1}}$ and $v_{r}^{r a n k_{n}}$ are, respectively, the speeds of robot_rank₁ and robot_{rank_n}. Finally, $Δ D (t - 1) = D_{g o a l}^{r a n k_{n}} (t - 1) - D_{g o a l}^{r a n k_{1}} (t - 1)$ . The outputs of MRC to the RNCs are the speed v_r(t) and heading angle θ_adj(t) for robot, rank₁, …, rank_n. We developed two types of MRC, one with a fuzzy-logic-based model and the other with a recurrent-based model. The fuzzy-logic-based MRC is implemented by an FLC, while the recurrent-based model uses long short-term memory (LSTM). Details of the proposed models are introduced in the following sections.

Fuzzy-Logic-Based Multiple Robot Coordinator

The proposed fuzzy-logic-based MRC is responsible for speed regulation and heading angle adjustment. The robot speed is changed at each control time step. If a robot is much closer to the target than the other robots, heading angle adjustment is made so that it moves away from the target; otherwise it would need to stop and wait for the others.

Speed Regulation

For each control loop, n robots are ranked based on their distance to the target in ascending order. An FLC called FLC_SR is used for robot speed regulation, which directly controls robot_rank₁ and robot_{rank_n}. The outputs of FLC_SR are speed factors α₁ and α_n for these two robots, which are used to increase or decrease their speeds. For the remaining robots (robot_rank₂, …, robot_{rank_(n−1)}), the speed scale factors α₂, …, α_(n−1) are generated by the following interpolation process:

\begin{array}{l} α_{i} = \frac{i - 1}{n - 1} \cdot (α_{n} - α_{1}) + α_{1}, & (1) \end{array}

where i = 2, …, n − 1, and α_i ∈ [0.5, 1.5]. The speeds have upper and lower bounds, which define a safe operating region.

The robots are not allowed to stop. The speeds for the robots at control time step t are given by

\begin{array}{l} v_{r}^{i} (t) = α_{i} v_{r}^{i} (t - 1), i = 1, \dots, n . & (2) \end{array}

FLC_SR uses zero-order Takagi–Sugeno–Kang (TSK) fuzzy IF–THEN rules with the form

\begin{array}{l} R_{i}^{S R} : If x_{1} is A_{i 1} And \dots And x_{5} is A_{i 5} Then y is {\overset{⇀}{a}}_{i} & (3) \end{array}

where x₁, …, x₅ correspond to the input variables; $D_{g o a l}^{r a n k_{1}} (t - 1)$ , $D_{g o a l}^{r a n k_{n}} (t - 1)$ , $v_{r}^{r a n k_{1}} (t - 1)$ , $v_{r}^{r a n k_{n}} (t - 1)$ , and D(t−1); A_i1,…, A_i5 are fuzzy sets; and ${\overset{⇀}{a}}_{i} = (a_{i 1}, a_{i 2})$ is a real vector. Here we use a Gaussian membership function. Thus, A_ij is given by

\begin{array}{l} μ_{i j} (x_{i}) = e x p {- {(\frac{x_{i} - m_{i j}}{σ_{i j}})}^{2}} & (4) \end{array}

where m_ij and σ_ij represent the center and the width of the fuzzy set A_ij, respectively. The firing strength of rule $R_{i}^{S R}$ is obtained by implementing the following algebraic product:

\begin{array}{l} Φ_{i} = \prod_{j = 1}^{M} μ_{i j} (x_{i}), & (5) \end{array}

where M is the dimension of the input variable, e.g., M = 5.

Suppose that FLC_SR has r rules. An output $\overset{⇀}{y} = (y_{1}, y_{2}) = (α_{1}, α_{n})$ can be obtained using the weighted average defuzzification method:

\begin{array}{l} \overset{⇀}{y} = \frac{\sum_{i = 1}^{r} Φ_{i} {\overset{⇀}{a}}_{i}}{\sum_{i = 1}^{r} Φ_{i}} . & (6) \end{array}

Heading Angle Adjustment

To make the length of the robot paths roughly equal, the MRC adjusts each robot's heading angle as part of its arrival-time control. An adjusted heading angle for robot i at control time step t is calculated by

\begin{array}{l} θ_{a d j}^{i} (t) = θ_{g o a l}^{i} (t) + {β_{i} \cdot θ}_{max_a d j}, & (7) \end{array}

where β_i is a scale factor that determines the strength of heading angle adjustment, $θ_{g o a l}^{i}$ is the search angle for robot i, and θ_{max_adj} is the maximum angle in changing the direction of robot i, e.g., θ_{max_adj} = 90. $θ_{g o a l}^{i} = θ_{t} - θ_{f r o n t}^{i}$ is the deviation between the target angle θ_t and the robot orientation angle $θ_{f r o n t}^{i}$ , as shown in Figure 3. β_i is calculated from $D_{g o a l}^{r a n k_{n}}$ , $D_{g o a l}^{i}$ and α_i, as follows:

\begin{array}{l} β_{i} = \sqrt{\frac{1}{α_{i}} (1 - \frac{D_{g o a l}^{i} (t - 1)}{D_{g o a l}^{r a n k_{n}} (t - 1)})} & (8) \end{array}

As β_i increases, robot i will be guided away from the target; on the other hand, as β_i decreases, robot i will be guided toward the target. This adjustment keeps changing the search behavior of each robot, except for the furthest robot_{rank_n}, until either $(D_{g o a l}^{r a n k_{n}} - D_{g o a l}^{r a n k_{1}}) < 0.1 m$ or each robot is within 10 m of the target. Algorithm 1 is an overview of the fuzzy-logic-based MRC for the multirobot navigation and arrival-time control.

FIGURE 3

Figure 3. Target angle and robot orientation angle.

ALGORITHM 1

Algorithm 1. Pseudocode for the multirobot navigation and arrival-time control.

Recurrent-Based Multiple Robot Coordinator

In addition to fuzzy-logic-based MRC, we also consider an LSTM-based model because these perform well for problems involving sequential data with long time dependencies. Its memory mechanism allows the use of historical data, which could be useful for optimizing trajectory-related problems. The vanilla version of LSTM is used because it is simple to implement, and its performance is close to that of other variants. Figure 4 shows the architecture of the LSTM block. In the recurrent-based MRC configuration, we use two LSTM blocks, with input (W_z, W_i, W_f, W_o), recurrent (R_z, R_i, R_f, R_o), peephole (p_i, p_f, p_o), and bias (b_z, b_i, b_i, b_o) weights. The input/output interface of the LSTM controller matches that of the fuzzy-logic-based MRC. Given input $x^{k} = (D_{g o a l}^{r a n k_{1}} (t - 1), D_{g o a l}^{r a n k_{n}} (t - 1) v_{r}^{r a n k_{1}} (t - 1), v_{r}^{r a n k_{n}} (t - 1), Δ D (t - 1))$ , then the LSTM block forward pass is

\begin{array}{l} Block input : z^{k} & = & h (W_{z} x^{k} + R_{z} y^{k - 1} + b_{z}), & (9) \end{array}

\begin{array}{l} Input gate : i^{k} & = & σ (W_{i} x^{k} + R_{i} y^{k - 1} + p_{i} ⊙ c^{k - 1} + b_{i}), & (10) \end{array}

\begin{array}{l} Forget gate : f^{k} & = & σ (W_{f} x^{k} + R_{f} y^{k - 1} + p_{f} ⊙ c^{k - 1} + b_{i}), & (11) \end{array}

\begin{array}{l} Cell : c^{k} & = & z^{k} ⊙ i^{k} + c^{k - 1} ⊙ f^{k}, & (12) \end{array}

\begin{array}{l} Output gate : o^{k} & = & σ (W_{o} x^{k} + R_{o} y^{k - 1} + p_{o} ⊙ c^{k} + b_{o}), & (13) \end{array}

\begin{array}{l} Block output : y^{k} & = & h (c^{k}) ⊙ o^{k}, & (14) \end{array}

where σ is the logistic sigmoid function used for gate activation, and h is the hyperbolic tangent function for the block input/output activation. During the training process, all bias weights are set to 0.5.

FIGURE 4

Figure 4. Long short-term memory block.

Robot Behavior Controller

The robot behavior controller (RBC) controls a robot to avoid obstacles by performing left BF behavior or right BF behavior. It consists of a behavior supervisor (BS) to determine behavior according to its current position, target position, and real-time outputs from the 2D Lidar sensor.

Behavior Supervisor

In the simulation for robot navigation, the mobile robot is equipped with a 2D Lidar sensor that scans the area in front of the robot from right (0±) to left (180±). The coverage area is divided into eight sectors L₁,…,L₈, as shown in Figure 2. The behavior supervisor uses a simple logic proposed in Juang and Chang (2011) to switch between the target-searching (TS) behavior and left and right BF behavior. If there are no obstacles detected within the sensing range of the robot's Lidar, then the robot starts moving directly toward the target. Figure 5 shows the logic of the behavior selection based on the robot-target distance and time-step counter. When the robot switches behavior from target searching (TS) to BF, the distance d₁ between the robot and the target is recorded, and the step counter c_step is set to zero. At the location where the robot decides to switch the behavior from BF to TS, the distance d₂ between the robot and the target is calculated. If d₁ > d₂, or if the step counter c_step > 100, the robot keeps the original BF behavior; otherwise, the robot switches from BF to TS. This time-step constraint prevents the robot from immediately switching between the TS and BF behaviors.

FIGURE 5

Figure 5. The block diagram of the navigation control.

The control of a robot performing BF in the navigation task is implemented by two fuzzy controllers—a left BF controller and a right BF controller. The left BF controller controls when the robot is closing an obstacle at the left-hand-side region, whereas the right BF controller is for the right-hand-side region. The number of rules in the right BF controller is identical to that in the left BF controller. The rules for the right BF behavior share the same antecedent part with those for the left BF behavior except that the left sensor inputs L₅, …, L₈ are changed to the right sensor inputs L₁, …, L₄. For the rule consequent part, the steering angle in each rule for the right BF behavior is simply a reverse of that for the left BF behavior. For example, suppose that the ith rule in the left BF controller is represented as follows:

\begin{array}{l} R_{i}^{l e f t} : If L_{5} i s B_{i 1} and L_{6} i s B_{i 2} \dots and L_{8} i s B_{i 4} Then θ_{B F} is θ_{i} . & (15) \end{array}

Then, the corresponding rule for the right BF controller is

\begin{array}{l} R_{i}^{r i g h t} : If L_{1} i s B_{i 1} and L_{2} i s B_{i 2} \dots and L_{4} i s B_{i 4} \\ Then θ_{B F} is {- θ}_{i}, & (16) \end{array}

where B_i1, …, B_i4 are a fuzzy sets defined by a Gaussian membership function and given as Equation (4). The output of the left BF controller is computed as Equation (6) with a singleton consequent value a_i = θ_i; and similarly, the output of the right BF controller is with a consequent value a_i = −θ_i. During a navigation task, the robot should decide to carry out either the left or right BF behavior at each control time step.

Training Strategy and Simulation Configuration

In this study, both fuzzy-logic-based MRC and recurrent-based MRC are trained in a cascading manner. First, we train the BF controller in RBC to perform collision-free navigation toward the target. In the second phase of training, fuzzy-logic-based MRC and recurrent-based MRC learn to coordinate a group of RBC-equipped robots to arrive at a target at the same time. The particle swarm optimization (PSO) algorithm (Shi and Eberhart, 1998) is used to optimize the tunable parameters of all controllers.

Particle Swarm Optimization

PSO is a swarm intelligence optimization approach in which each solution is represented as a particle [3]. Each particle has a position, represented by vector s_i. The swarm in PSO is initialized with a population of random solutions. A swarm of particles moves through the solution space, and the velocity of each particle is represented by vector v_i. The performance of a particle is measured by a fitness function f, which is evaluated using s_i. Each particle keeps track of its own best position p_i, which is associated with the best fitness that the particle has achieved. Also, it is guided toward the best position found by any member of the swarm (the global best position g). For particle i at iteration t, each element k of the new velocity can be calculated as

\begin{array}{l} v_{i}^{(t)} (k) = w v_{i}^{(t - 1)} (k) + c_{1} r_{1} (p_{i} (k) - s_{i}^{(t - 1)} (k)) \\ + c_{2} r_{2} (g (k) - s_{i}^{(t - 1)} (k)), & (17) \end{array}

where w is the inertia weight, c₁ and c₂ are positive acceleration coefficients, and r₁ and r₂ are uniformly distributed random numbers in the interval [0, 1]. All components of v_i have lower and upper bounds defined by the geometry of the search space. The new position of each particle is calculated with

\begin{array}{l} s_{i}^{(t)} (k) = s_{i}^{(t - 1)} (k) + v_{i}^{(t)} (k) . & (18) \end{array}

With a careful choice of parameters w, c₁, and c₂, Equations (17) and (18) ensure that the particle population clusters around the best solution.

Training Phase 1: BF Behavior

Figure 6 illustrates the environment for training phase 1. The main goal of this phase is to control the robot in BF behavior at a constant speed using the PSO-based fuzzy controller. Without loss of generality, this value is set as 0.4 m/s in this paper. The BF behavior enables collision-free movement of the robot during navigation. Since only the left BF controller is trained, the distances detected by sectors L₅, L₆, L₇, and L₈ are used and fed as the inputs to the left BF controller. The right BF behavior is directly available by a slight modification of the learned consequents for the left BF behavior. The left BF controller output is the steering angle of the robot boundary-following behavior θ_BF, where θ_BF ∈ [−3.14, 3.14] in radians. A positive value of θ_BF means a clockwise rotation.

FIGURE 6

Figure 6. The environment for training phase 1.

The constraints for successful left BF behavior at each time step during the learning process are

\begin{array}{l} min (L_{5}, L_{6}, L_{7}, L_{8}) > D_{m i n}, and L_{5} \leq D_{m a x} & (19) \end{array}

In this simulation, D_min and D_max are set to 0.5 and 1.5, respectively. The first constraint prevents a collision with the object, and the second constraint prevents the robot from moving too far from the object. In the PSO-optimized training phase 1, a particle represents a whole fuzzy controller for left BF behavior. The performance of left BF behavior is evaluated as follows. The robot moves along the side of an object and stops when one of the constraints in (19) is violated, which indicates that the controller has failed. If the robot stops, the total number of control time steps is recorded as T_control. The fitness function f_{phase_1} for training phase 1 is

\begin{array}{l} f_{p h a s e_1} = \frac{1}{T_{c o n t r o l}} . & (20) \end{array}

A low f_{phase_1} indicates good left BF behavior. The control process from when movement starts to when it stops is called a trial. If left BF behavior fails, the robot moves back to its initial position for the next trial, and a new fuzzy controller is constructed and evaluated. The learning process is repeated until a successful fuzzy controller is found or the maximum number of iterations is met. A left BF behavior is deemed successful if it successfully controls the robot for a total of T_suc time steps. In the training phase 1, T_suc is set to 4,000 so that the robot moves along the object boundary for over two cycles. The maximum number of iterations is set to 200 for a trial.

Training Phase 2: Multi-Robot Navigation and Arrival-Time Coordination Learning

In training phase 2, there are three robots moving in a complex environment, as shown in Figure 7. Each robot is controlled by the BRC whose BF controller was optimized in training phase 1. During training, both fuzzy-logic-based MRC and recurrent-based MRC are applied in the navigation of three robots so that they reach the target simultaneously. The robots start from different positions and head toward the same target. The performance of MRC is evaluated using a fitness function f_{phase_ 2}:

\begin{array}{l} f_{p h a s e_2} = 10 \cdot f_{1} + 0.1 \cdot f_{2} . & (21) \end{array}

The first term of (21), f₁, is used to optimize the difference in the arrival times of robot_rank₁ and robot_{rank_n}:

\begin{array}{l} f_{1} = | T_{r a n k_{1}} - T_{r a n k_{n}} |, & (22) \end{array}

where T_rank₁ is the time that robot_rank₁ takes to reach the target, and T_{rank_n} is the time for robot_{rank_n}.

FIGURE 7

Figure 7. Environment for training phase 2.

The second term of (21), f₂, is to get the robot to move as fast as possible:

\begin{array}{l} f_{2} = \frac{| T_{r a n k_{1}} - T_{r a n k_{n}} |}{2} . & (23) \end{array}

Simulation Results

Simulation 1 (BF Behavior Learning)

This example shows the simulation results of training phase 1: left BF learning result using the PSO-optimized FLC. The number of fuzzy rules is set to 10. The simulation environment is as shown in Figure 6. The environment is built using Webots 8.5.3 on a platform equipped with Intel i5-4200H 3.40 GHz CPU, NVIDIA GT 745M 2GB graphics card, and 8G 1600 MHz RAM. The learning objective is to find a successful FLC for left BF behavior satisfying the constraints in (19) for a total of 4000 time steps. The control loop stops when the robot violates the constraint of the left-BF FLC. For this optimization problem, the objective is to design a successful FLC using as minimum number of iterations as possible. Figure 8 shows the left-BF behavior-learning results for all 50 runs. The PSO fails to find a successful left-BF FLC for one of the 50 runs. The average number of iterations of the PSO to find a successful FLC is 13.987.

FIGURE 8

Figure 8. Robot left-BF behavior-learning results for all 50 runs.

Simulation 2 (Multirobot Navigation and Arrival-Time Coordination Learning)

The objective of this simulation is to optimize MRC for three robots to navigate and simultaneously reach the target in the clutter environment as shown in Figure 7. We set the centre point of the map as the origin of coordinate (x, z) = (0, 0), and the target is located at (x, z) = (−11, −23). The initial distance between robot₁ is 30.4 m, robot₂ is 39.5 m, and robot₃ is 43.8 m. The performance of both fuzzy-logic-based MRC and recurrent-based MRC are evaluated by Equation (21). A smaller solution to Equation (21) means that the MRC can control the three robots moving toward to the target as fast as possible and coordinate their arrival time as precise as well. For each evaluation process, the MRC controls all robots until they all reach the target. Once all robots have reached the target, the positions of the robots will be set to their initial positions, which are fixed during the whole training process. The number of learning iterations is set to 50. The PSO optimization process for training phase 2 conducts 50 runs for statistical evaluation. Figure 9 demonstrates the average best-so-far fitness of the MRCs. Table 1 presents the performance of fuzzy-logic-based MRC and recurrent-based MRC in training phase 2. The average best-so-far fitness of fuzzy-logic-based MRC converges at 57.2 (average value of f₁ is 532.0 time steps, average value of f₂ is 0.41 time steps), while the recurrent-based is 54.46 (average value of f₁ is 524.62 time steps, average value of f₂ is 0.20 time steps).

FIGURE 9

Figure 9. Average best-so-far fitness value at each iteration for the MRCs during the training phase 2.

TABLE 1

Table 1. Performance of fuzzy-logic-based and recurrent-based MRC in the training phase 2.

Simulation 3 (Multirobot Navigation and Arrival-Time Coordination)

In this simulation, the optimized MRCs and BF controller are applied to perform navigation and arrival-time task. We deployed three robots and six robots in a clutter environment with variant starting position to testify the scalability of the optimized MRCs. Both fuzzy-logic-based and recurrent-based MRCs are used in this simulation. To demonstrate the ability of time-arrival coordination, examples of robots controlled without MRC are included for comparison with those examples applied with MRCs.

Three-Robot Navigation and Arrival Time Control

To validate the performance of the proposed control systems, we deployed three robots in a complex environment (see Figure 10), and the target building is set at (x, z) = (−19.54, 8.78). The initial distance between the robot₁ is 19.34 m, robot₂ is 32.94 m, and robot₃ is 39.05 m. Figure 11 illustrates the trajectories of the three robots, respectively, controlled by fuzzy-logic-based MRC, recurrent-based MRC, and in the absence of MRC during the navigation task. Figure 12 shows the remaining distance between the target and the three robots. The performance of time arrival coordination with three-robot setting is shown in Table 2. The time difference is evaluated by measuring the difference of arrival time of the fastest robot and the slowest robot in the simulation. The best achieved time difference controlled by fuzzy-logic-based MRC is five time steps, while it takes 785 time steps for the slowest robot to complete the navigation task. The recurrent-based configuration showed a result with an eight-time-step difference between the first and last arriving robots, while it takes 778 time steps for the slowest robot to complete the navigation task. By comparing Figures 12A,B, the robots controlled by recurrent-based MRC have faster convergence speed, but fuzzy-logic-based has a better coordinating ability in this simulation. We further compare with the case without MRC control; see Figures 11C, 12C. The three robots directly move toward to the target without changing their searching direction and the moving speed so that robot₁ arrives at the target much earlier than the other two robots.

FIGURE 10

Figure 10. An environment setting for three-robot navigation.

FIGURE 11

Figure 11. The moving speeds of four-robot navigation in a complex environment setting. (A) Robots are controlled by the fuzzy-logic-based MRC. (B) Robots are controlled by the recurrent-based MRC. (C) Robots are controlled by only their own RBC.

FIGURE 12

Figure 12. The remaining distance between the target and the three robots during the three-robot navigation and arrival time control simulation. (A) Robots are controlled by the fuzzy-logic-based MRC. (B) Robots are controlled by the recurrent-based MRC. (C) Robots are controlled by only their own RBC.

TABLE 2

Table 2. The performance of time arrival coordination with three-robot setting.

Six-Robot Navigation and Arrival Time Control

The reason for us to use the simple interpolation method to decide the velocity scaling factors and searching direction of robots is to increase the scalability of the proposed methods such that they can deal with a different and changing number of robots without retraining the neural networks. To validate the scalability of the proposed methods, we deployed six robots in this simulation, as shown in Figure 13, and the target building is set at (x, z) = (−17.71, −20.34). The initial distance between robot₁ is 50.11 m, robot₂ is 15.26 m, robot₃ is 49.44 m, robot₄ is 41.69 m, robot₅ is 24.08 m, and robot₆ is 34.27 m. Each proposed model uses identical parameters, which are used in the simulation of section IV-C.

FIGURE 13

Figure 13. An environment setting for six-robot navigation.

The trajectories of the six-robot setting controlled by each proposed model are illustrated in Figure 14. Figure 15 shows the remaining distance between the target and the six robots. Table 3 presents performance of the arrival-time coordination in the six-robot setting. Fuzzy-logic-based MRC achieves 68-time-step time difference between the fastest robot and the slowest robot, while it takes 965 time steps for the slowest robot to complete the navigation task. The recurrent-based MRC has a better result with a 34-time-step difference between the first and last arriving robots, while it takes 907 time steps for the slowest robot to complete the navigation task. The robots controlled by recurrent-based MRC have faster convergence speed, as well as smaller time difference between the fastest robot and the slowest robot. In this simulation, recurrent-based MRC shows its better performance in arrival-time control than fuzzy-logic-based MRC does. The control results also demonstrated that the proposed models have the scalability and are both able to navigate different number of robots without retraining the model.

FIGURE 14

Figure 14. The remaining distance between the target and the three robots during the three-robot navigation and arrival time control simulation. (A) Robots are controlled by the fuzzy-logic-based MRC. (B) Robots are controlled by the recurrent-based MRC. (C) Robots are controlled by only their own RBC.

FIGURE 15

Figure 15. The moving speeds of six-robot navigation in complex environment setting. (A) Robots are controlled by the speed coordination controller. (B) Robots are controlled by the improved controller. (C) Robots are controlled by only their own RBC.

TABLE 3

Table 3. The performance of time arrival coordination with six-robot setting.

Conclusion and Future Work

We developed a fuzzy-logic-based coordinator and a recurrent-based coordinator for safely navigating multiple robots in cluttered environments, where the controller regulates their speeds and adjusts their searching direction to enable simultaneous arrival time on targets. The environment for the test was designed in an imbalanced setting, in which each robot starts at the positions with totally different distances to the target. The simulation results demonstrate that the two proposed models successfully control a different number of robots to safely navigate and reach the target on time. In the future, we intend to develop a systematic method for optimizing the hyper-parameters of this cascaded model, including the number of rules in FLS. We are currently designing a technique for automatically tidying up the membership functions for improved interpretability. We will also consider scenarios where the robots lose communication when they are separated by building structures, losing a direct line of sight. We believe that intermittent sharing of controller policy will allow the agent to predict the future motions of the other agents when the communication is blocked and to make correct motion decisions.

Data Availability Statement

The datasets generated for this study are available on request to the corresponding author.

Author's Note

We developed a fuzzy-logic-based coordinator and recurrent-based coordinator for safely navigating multiple robots in clutter environments, where the controller regulates their speeds and adjusts their searching direction to enable simultaneous arrival time on targets. The environment for the test was designed in an imbalanced setting, in which each robot starts at the positions with totally different distances between it and the targets. The simulation results demonstrate that the two proposed models successfully control a different number of robots to safely navigate and reach the target on time.

Author Contributions

Y-CC developed the methodology, performed the experiments, and wrote the manuscript. AD proposed the experiments and partially contributed to the manuscript. The project was administered by C-TL and JK.

Funding

This research has been supported by the generous funding of Defence Science & Technology Group, Australia.

Conflict of Interest

The authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.

Acknowledgments

We gratefully acknowledge our colleague Dr. Shi Ye for his assistance in simulations and for his contribution to an earlier version of this manuscript.

References

Babel, L. (2019). Coordinated target assignment and UAV path planning with timing constraints. J. Intelligent Robot. Syst. 94, 857–869. doi: 10.1007/s10846-018-0910-9

CrossRef Full Text | Google Scholar

Chandrasekhar Rao, D., and Kabat, M. R. (2019). “A study on cooperation and navigation planning for multi-robot using intelligent water drops algorithm,” in Emerging Research in Computing, Information, Communication and Applications, eds N. R. Shetty, L. M. Patnaik, H. C. Nagaraj, P. N. Hamsavath, and N. Nalini (Singapore: Springer). 577–590.

Google Scholar

Chia-Feng, J. (2005). Combination of online clustering and Q-value based GA for reinforcement fuzzy system design. IEEE Trans. Fuzzy Syst. 13, 289–302. doi: 10.1109/TFUZZ.2004.841726

CrossRef Full Text | Google Scholar

Chia-Feng, J., and Chin-Teng, L. (1998). An online self-constructing neural fuzzy inference network and its applications. IEEE Trans. Fuzzy Syst. 6, 12–32. doi: 10.1109/91.660805

CrossRef Full Text | Google Scholar

Din, A., Jabeen, M., Zia, K., Khalid, A., and Saini, D. K. (2018). Behavior-based swarm robotic search and rescue using fuzzy controller. Comput. Elect. Eng. 70, 53–65. doi: 10.1016/j.compeleceng.2018.06.003

CrossRef Full Text | Google Scholar

Ding, W., Lin, C., and Cao, Z. (2019). Deep neuro-cognitive co-evolution for fuzzy attribute reduction by quantum leaping PSO with nearest-neighbor memeplexes. IEEE Trans. Cybern. 49, 2744–2757. doi: 10.1109/TCYB.2018.2834390

PubMed Abstract | CrossRef Full Text | Google Scholar

Greff, K., Srivastava, R. K., Koutník, J., Steunebrink, B. R., and Schmidhuber, J. (2017). LSTM: a search space odyssey. IEEE Trans. Neural Netw. Learn. Syst. 28, 2222–2232. doi: 10.1109/TNNLS.2016.2582924

PubMed Abstract | CrossRef Full Text | Google Scholar

Jhang, J.-Y., Lin, C.-J., and Young, K.-Y. (2019). Cooperative carrying control for multi-evolutionary mobile robots in unknown environments. Electronics 8:298. doi: 10.3390/electronics8030298

CrossRef Full Text | Google Scholar

Juang, C., and Chang, Y. (2011). Evolutionary-group-based particle-swarm-optimized fuzzy controller with application to mobile-robot navigation in unknown environments. IEEE Trans. Fuzzy Syst. 19, 379–392. doi: 10.1109/TFUZZ.2011.2104364

CrossRef Full Text | Google Scholar

Juang, C.-F., and Lo, C. (2008). Zero-order TSK-type fuzzy system learning using a two-phase swarm intelligence algorithm. Fuzzy Sets Syst. 159, 2910–2926. doi: 10.1016/j.fss.2008.02.003

CrossRef Full Text | Google Scholar

Kashyap, A. K., and Pandey, A. (2018). Different nature-inspired techniques applied for motion planning of wheeled robot: a critical review. Int. J. Adv. Robot. Autom. 3, 1–10. doi: 10.15226/2473-3032/3/2/00136

CrossRef Full Text | Google Scholar

Lai, M., Zeng, W., and Juang, C. (2016). “Navigation for two fuzzy controlled cooperative object-carrying robots in concave maps with the consideration of dead-cycle problem,” in 2016 IEEE International Conference on Fuzzy Systems (FUZZ-IEEE) (Vancouver, BC: IEEE), 1905–1909. doi: 10.1109/FUZZ-IEEE.2016.7737923

PubMed Abstract | CrossRef Full Text | Google Scholar

Lin, C.-T., and Lee, C. S. G. (1996). Neural Fuzzy Systems: A Neuro-Fuzzy Synergism to Intelligent Systems (Har/Dskt edition). Upper Saddle River, NJ: Prentice Hall.

Google Scholar

Mansoori, E. G., Zolghadri, M. J., and Katebi, S. D. (2008). SGERD: a steady-state genetic algorithm for extracting fuzzy classification rules from data. IEEE Trans. Fuzzy Syst. 16, 1061–1071. doi: 10.1109/TFUZZ.2008.915790

PubMed Abstract | CrossRef Full Text | Google Scholar

Misra, S., Chakraborty, A., Sharma, R., and Brink, K. (2018). “Cooperative simultaneous arrival of unmanned vehicles onto a moving target in gps-denied environment,” in 2018 IEEE Conference on Decision and Control (CDC), 5409–5414. doi: 10.1109/CDC.2018.8619652

CrossRef Full Text | Google Scholar

Mohanta, J. C., and Keshari, A. (2019). A knowledge based fuzzy-probabilistic roadmap method for mobile robot navigation. Appl. Soft Comput. 79, 391–409. doi: 10.1016/j.asoc.2019.03.055

CrossRef Full Text | Google Scholar

Nantogma, S., Ran, W., Yang, X., and Xiaoqin, H. (2019). “Behavior-based genetic fuzzy control system for multiple usvs cooperative target protection,” in 2019 3rd International Symposium on Autonomous Systems (ISAS), 181–186. doi: 10.1109/ISASS.2019.8757732

CrossRef Full Text | Google Scholar

Patle, B. K., Babu, L. G., Pandey, A., Parhi, D. R. K., and Jagadeesh, A. (2019). A review: on path planning strategies for navigation of mobile robot. Defence Technol. 15, 582–606. doi: 10.1016/j.dt.2019.04.011

CrossRef Full Text | Google Scholar

Pothal, J. K., and Parhi, D. R. (2015). Navigation of multiple mobile robots in a highly clutter terrains using adaptive neuro-fuzzy inference system. Robot. Auton. Syst. 72, 48–58. doi: 10.1016/j.robot.2015.04.007

CrossRef Full Text | Google Scholar

Pradhan, B., Roy, D. S., and Hui, N. B. (2019). “Multi-agent navigation and coordination using GA-fuzzy approach,” in Soft Computing for Problem Solving, eds J. C. Bansal, K. N. Das, A. Nagar, K. Deep, & A. K. Ojha (Singapore: Springer). 793–805.

Google Scholar

Shi, Y., and Eberhart, R. C. (1998). “A modified particle swarm optimizer”. In Presented at the 1998 IEEE International Conference on Evolutionary Computation Proceedings. IEEE World Congress on Computational Intelligence (Cat. No.98TH8360), Anchorage, AK.

Google Scholar

Webots: Robot simulator. Available online at: https://cyberbotics.com/ (accessed September 30, 2019).

Yao, P., and Qi, S. (2019). Obstacle-avoiding path planning for multiple autonomous underwater vehicles with simultaneous arrival. Sci. China Technol. Sci. 62, 121–132. doi: 10.1007/s11431-017-9198-6

CrossRef Full Text | Google Scholar

Zhu, A., and Yang, S. X. (2007). Neurofuzzy-based approach to mobile robot navigation in unknown environments. IEEE Trans. Syst. Man Cybern. Part C 37, 610–621. doi: 10.1109/TSMCC.2007.897499

CrossRef Full Text | Google Scholar

Keywords: hierarchical fuzzy system, fuzzy logic control, multi-agent control, navigation, arrival-time control

Citation: Chang Y-C, Dostovalova A, Lin C-T and Kim J (2020) Intelligent Multirobot Navigation and Arrival-Time Control Using a Scalable PSO-Optimized Hierarchical Controller. Front. Artif. Intell. 3:50. doi: 10.3389/frai.2020.00050

Received: 04 October 2019; Accepted: 15 June 2020;
Published: 07 August 2020.

Edited by:

Cesar Isaza, Polytechnic University of Querétaro, Mexico

Reviewed by:

Vicente García, Universidad Autónoma de Ciudad Juárez, Mexico
Jonny Paul Zavala De Paz, Polytechnic University of Querétaro, Mexico

Copyright © 2020 Chang, Dostovalova, Lin and Kim. This is an open-access article distributed under the terms of the Creative Commons Attribution License (CC BY). The use, distribution or reproduction in other forums is permitted, provided the original author(s) and the copyright owner(s) are credited and that the original publication in this journal is cited, in accordance with accepted academic practice. No use, distribution or reproduction is permitted which does not comply with these terms.

*Correspondence: Yu-Cheng Chang, Yu-Cheng.Chang@student.uts.edu.au

Disclaimer: All claims expressed in this article are solely those of the authors and do not necessarily represent those of their affiliated organizations, or those of the publisher, the editors and the reviewers. Any product that may be evaluated in this article or claim that may be made by its manufacturer is not guaranteed or endorsed by the publisher.