Formation control for multiple nonholonomic wheeled mobile robots based on integrated sliding mode controller and force function

Abstract

In this paper, we present a novel method to achieve collision-free formation control for multiple nonholonomic wheeled mobile robots. By utilizing the leader–follower strategy, an integrated controller that combines a sliding mode controller for formation control and a force function for obstacle avoidance is proposed. To address the common chattering issue associated with sliding mode control, a novel depletion model is developed, which constrains the controller input to vary smoothly within a small range and effectively eliminates chattering. Additionally, a dynamic-gain structure is introduced to reconcile the conflicting demands of formation control and obstacle avoidance, providing enhanced coordination between the two tasks. Simulation and experiments’ results are provided to illustrate the effectiveness of the proposed method.

Keywords

Formation control integrated sliding mode controller artificial potential field multi-robot system

Introduction

With the improvement of the embedded computing and communication capabilities, the multi-agent systems (MASs) that possess good robustness, high fault tolerance, and strong scalability, could carry out complex tasks more flexibly and effectively (Sun et al., 2022; Wang et al., 2023a, 2023b). The formation control of multiple mobile robot systems has wide applications in both military and civilian fields (Hosseinzadeh et al., 2018; Li et al., 2022; Lin et al., 2018), such as target tracking, search and rescue, and patrol. In the formation control, multiple agents move toward a specific target or direction, while maintaining a predetermined geometric shape among each other and adapting to environmental constraints (Oh et al., 2015). To achieve this objective, various formation control strategies have been developed, including virtual-structure approach (Zhang et al., 2012), behavior-based control (Antonelli et al., 2009), and leader–follower strategy (Consolini et al., 2008; Dai et al., 2019; Zhao et al., 2022). Due to its simplicity and ease of implementation, the leader–follower strategy has received much attention (Liu et al., 2024b).

Formation control imposes high demands on the controller. The sliding mode control is a special type of variable structure control (Utkin et al., 1978), which has strong robustness against the external disturbances and the internal uncertainties of the system (Sabiha et al., 2022; Sun et al., 2021; Zheng et al., 2015). The trajectory tracking performance of nonholonomic wheeled mobile robots (NWMRs) may be affected by the disturbances and the internal uncertainties (Xie et al., 2022). Therefore, the sliding mode control is introduced into formation control (Chang et al., 2011; Damani et al., 2023; Elayaperumal et al., 2023; Fei et al., 2020; Li et al., 2018; Yang et al., 2023). For extremely complex environments, the formation tracking control of autonomous underwater vehicles with model parameter uncertainties and external disturbances was investigated, and the followers could track and guide the leader robot within a given stability time based on sliding mode control (Gao et al., 2020). In Yu et al. (2023), the neural adaptive sliding mode controllers were proposed for multiple unmanned aerial vehicles (UAVs), which could compensate for composite uncertainties to ensure good tracking performance. Despite its excellent characteristics, chattering is commonly present in sliding mode control (Norsahperi et al., 2020). In this paper, a sliding mode tracking controller for nonholonomic wheeled robots is designed, and a depletion model is constructed to solve the chattering problem commonly existing in the sliding mode controller.

Furthermore, the application of robot formation control in the obstacle environment remains challenging (Liu et al., 2024a). The artificial potential field (APF) method (Khatib, 1986) is a classic obstacle avoidance method for robots, which has good real-time performance and smooth obstacle avoidance trajectory and is widely used in path planning for mobile robots (Chen et al., 2016; Hao et al., 2022; Peng et al., 2023; Wu et al., 2023). The APF method was adopted in formation control of the multi-robot by designing the appropriate controller (Mu et al., 2020; Pan et al., 2021; Shou et al., 2022). By adopting an improved APF method, the formation obstacle avoidance method was proposed for multi-robot path planning and preventing collisions between machines based on the adaptive proportional–integral–derivative (PID) controller (Pan et al., 2019). In order to ensure collision-free formation of MASs, the APFs and time-varying topology were introduced to the original controller (Fei et al., 2023). Path-planning methods based on APF are also commonly used to address obstacle avoidance issues in robot formation (Tong et al., 2022). Different from most obstacle avoidance methods by adopting the pre-path-planning (Wang et al., 2017), this paper introduces a force function and a dynamic-gain structure to achieve obstacle avoidance in formation, which could effectively save computing resources and improve the formation efficiency of multi-robot systems.

Motivated by the aforementioned research, we propose an integrated collision-free formation control method based on sliding mode control and force function for NWMRs. The primary contributions are summarized as follows:

Based on the leader–follower strategy, a sliding mode tracking controller is designed for NWMRs. In order to address the chattering problem caused by abrupt changes in controller output due to large or rapidly changing inputs, a novel depletion model is constructed, which smoothly constrains the controller input within a small range and effectively eliminates the chattering issue.

In Wang et al. (2017), the obstacle avoidance is achieved through path -planning using the APF method, which requires each robot to complete its path planning independently. To relax this limitation, attractive force and repulsive force functions are constructed to address the obstacle avoidance problem, where the attractive and repulsive forces act as control inputs on the robot rather than being used for path planning.

In most previous results, the integrated controller adopts the sum of the formation control input and the obstacle avoidance control input. However, robots may deviate from the formation in order to avoid obstacles. Hence, a dynamic-gain structure is developed to adjust the formation control input and obstacle avoidance control input, which enables robots to have a certain autonomous -decision-making capability between maintaining formation and avoiding obstacles.

The structure of this article is as follows. In Section “Problem formulation,” the system models and the control objective are introduced. The main results are presented in Section “Main results.” The simulation and experiment results are provided in Section “Evaluation and experimental results.” The conclusion is drawn in Section “Conclusion.”

Problem formulation

Based on the leader–follower strategy, the formation control problem of the nonholonomic wheeled robots is described in this section.

System model

Consider a multi-mobile robots system with $n$ follower robots, and one leader robot in the global coordinate system ${X O Y}$ . As illustrated in Figure 1, we denote the leader as the $0$ th robot and the follower as the $i$ th robot $(i = 1, 2, \dots, n)$ . $(x_{i}, y_{i})$ is the $i$ th robot’s position, where $i = 0, 1, 2, \dots, n$ . $θ_{i}$ is the heading angle of the $i$ th robot. $v_{i}$ and $ω_{i}$ are velocity and angular velocity of the $i$ th robot. The kinematic model of the $i$ th nonholonomic mobile robot can be described as follows:

{\overset{\cdot}{R}}_{i} = [\begin{matrix} {\overset{\cdot}{x}}_{i} \\ {\overset{\cdot}{y}}_{i} \\ {\overset{\cdot}{θ}}_{i} \end{matrix}] = [\begin{matrix} \cos θ_{i} & 0 \\ \sin θ_{i} & 0 \\ 0 & 1 \end{matrix}] [\begin{matrix} v_{i} \\ ω_{i} \end{matrix}],

(1)

where $R_{i}$ denotes the states of the $i$ th robot.

Figure 1.

The leader–follower formation.

In order to achieve multi-robot formation, we adopt the leader–follower strategy. The trajectory of the leader is planned in advance by the upper computer, and followers are driven to follow the leader with a desired formation. The $i$ th virtual robot is introduced to always maintain the desired states of the $i$ th robot, that is, desired position and heading angle. Therefore, the $i$ th virtual robot’s states $R_{vi}$ are described as follows:

R_{vi} = [\begin{matrix} x_{vi} \\ y_{vi} \\ θ_{vi} \end{matrix}] = R_{0} + [\begin{matrix} l_{i} \cos φ_{i} \\ l_{i} \sin φ_{i} \\ 0 \end{matrix}] = [\begin{matrix} x_{0} + l_{i} \cos φ_{i} \\ y_{0} + l_{i} \cos φ_{i} \\ θ_{0} \end{matrix}],

(2)

where $[x_{vi}, y_{vi}]^{T}$ and $θ_{vi}$ are the $i$ th virtual robot’s position and heading angle, respectively. $l_{i}$ and $φ_{i}$ are the distance and bearing angle between the leader and the $i$ th virtual robot, respectively.To achieve formation, it is desirable for the $i$ th follower to track the trajectory of the $i$ th virtual robot. Furthermore, the tracking error $[x_{ei}, y_{ei}, θ_{ei}]^{T}$ between the $i$ th virtual robot and the $i$ th follower is obtained as follows:

[\begin{matrix} x_{ei} \\ y_{ei} \\ θ_{ei} \end{matrix}] = R_{vi} - R_{i} = [\begin{matrix} x_{vi} - x_{i} \\ y_{vi} - x_{i} \\ θ_{vi} - θ_{i} \end{matrix}] .

(3)

Then, the tracking error $[e_{xi}, e_{yi}, e_{θ i}]^{T}$ in the local coordinates can be deduced as follows:

[\begin{matrix} e_{xi} \\ e_{yi} \\ e_{θ i} \end{matrix}] = [\begin{matrix} \cos θ_{i} & \sin θ_{i} & 0 \\ - \sin θ_{i} & \cos θ_{i} & 0 \\ 0 & 0 & 1 \end{matrix}] [\begin{matrix} x_{ei} \\ y_{ei} \\ θ_{ei} \end{matrix}] .

(4)

Combining (1) and (3), the time derivative of $[e_{xi}, e_{yi}, e_{θ i}]^{T}$ is calculated as

[\begin{matrix} {\overset{\cdot}{e}}_{xi} \\ {\overset{\cdot}{e}}_{yi} \\ {\overset{\cdot}{e}}_{θ i} \end{matrix}] = [\begin{matrix} v_{0} \cos e_{θ i} - v_{i} + ω_{i} e_{yi} \\ v_{0} \sin e_{θ i} - ω_{i} e_{xi} \\ ω_{0} - ω_{i} \end{matrix}] .

(5)

Therefore, the tracking control problem is transformed into an origin stability problem in the error system (5).

Objective

The objective of our work is to devise a distributed controller for the error system (5) in an obstacle environment, such that

all the tracking errors $[e_{xi}, e_{yi}, e_{θ i}]^{T}$ globally asymptotically converge to zero;

follower robots could autonomously avoid obstacles upon encounter and resume formation after obstacle avoidance, that is, the formation performance is resilient.

Main results

By combining the sliding mode controller and force function, the integrated controller is constructed in this paper, and the entire controller structure is shown in the Figure 2.

Figure 2.

The integrated controller structure.

Design of sliding mode controller

In order to make the error system (5) converge to the origin, the sliding mode controller is designed in this section.

We adopt the backstepping method to construct the sliding mode surface as follows:

s_{i} = [\begin{matrix} s_{1 i} \\ s_{2 i} \end{matrix}] = [\begin{matrix} e_{xi} \\ μ e_{θ i} + \arctan (v_{0} e_{yi}) \end{matrix}],

(6)

where $μ > 1 / 2$ is a constant. Then, ${\overset{\cdot}{s}}_{i}$ is computed as

\begin{matrix} {\overset{\cdot}{s}}_{i} = [\begin{matrix} {\overset{\cdot}{s}}_{1 i} \\ {\overset{\cdot}{s}}_{2 i} \end{matrix}] = [\begin{matrix} {\overset{\cdot}{e}}_{xi} \\ μ {\overset{\cdot}{e}}_{θ i} + \frac{{\overset{\cdot}{v}}_{0} e_{yi} + v_{0} {\overset{\cdot}{e}}_{yi}}{1 + {(v_{0} e_{yi})}^{2}} \end{matrix}] \\ = [\begin{matrix} ω_{0} e_{yi} - v_{i} + v_{0} \cos e_{θ i} \\ μ ω_{0} - μ ω_{i} + \frac{v_{0} (- ω_{i} e_{xi} + v_{0} \sin e_{θ i}) + {\overset{\cdot}{v}}_{0} e_{yi}}{1 + {(v_{0} e_{yi})}^{2}} \end{matrix}] . \end{matrix}

(7)

Then, in order to converge system states to the designed manifold $s$ from arbitrary initial conditions within a finite time, the reaching law (Elayaperumal et al., 2023) is selected as follows:

{\overset{\cdot}{s}}_{1 i}^{'} = - ε_{1} | s_{1 i} |^{α_{1}} sgn (s_{1 i}) - ε_{1^{'}} s_{1 i},

(8)

{\overset{\cdot}{s}}_{2 i}^{'} = - ε_{2} | s_{2 i} |^{α_{2}} sgn (s_{2 i}) - ε_{2^{'}} s_{2 i},

(9)

where $α_{1}, α_{2}, ε_{1}, ε_{2}, ε_{1^{'}}, ε_{2}^{'}$ are positive constants, and $0 < α_{1}, α_{2} < 1$ .

By setting ${\overset{\cdot}{s}}_{1 i} = {\overset{\cdot}{s}}_{1 i}^{'}$ and ${\overset{\cdot}{s}}_{2 i}^{'} = {\overset{\cdot}{s}}_{2 i}^{'}$ , the sliding mode control law is obtained as

[\begin{matrix} v_{i} \\ ω_{i} \end{matrix}] = [\begin{matrix} v_{0} \cos e_{θ i} + ω_{i} e_{yi} + ε_{1} | s_{1 i} |^{α_{1}} sgn (s_{1 i}) + ε_{1^{'}} s_{1 i} \\ μ ω_{0} + ((v_{0}^{2} \sin e_{θ i} + {\overset{\cdot}{v}}_{0} e_{yi}) / (1 + {(v_{0} ω_{0})}^{2})) \\ \frac{+ ε_{2} | s_{2 i} |^{α_{2}} sgn (s_{2 i}) + ε_{2^{'}} s_{2 i}}{μ + (v_{0} e_{xi} / (1 + {(v_{0} e_{yi})}^{2}))} \end{matrix}] .

(10)

Theorem 1. Under formation control law (10), the closed-loop error system (5) is globally asymptotically stable.

Proof. First, we prove that the reaching phase is completed within a finite time. Then, we prove that $e_{xi}$ , $e_{yi},$ and $e_{θ i}$ converge to zero on the sliding mode surface.

Step 1. Consider the following Lyapunov function:

W_{1 i} (t) = | s_{1 i} | .

(11)

Combining (8), the derivative of $W_{1 i}$ is calculated as

\begin{matrix} {\overset{\cdot}{W}}_{1 i} (t) = - ε_{1} | s_{1 i} |^{α_{1}} - ε_{1^{'}} | s_{1 i} | \\ = - ε_{1} W_{1 i} (t)^{α_{1}} - ε_{1^{'}} W_{1 i} (t) \\ \leq 0 . \end{matrix}

(12)

From Yu et al. (2005), it can be deduced that $s_{1 i}$ will converge to zero within a finite time

T_{1} \leq \frac{1}{{ε_{1}}^{'} (1 - α_{1})} \ln \frac{{ε_{1}}^{'} W^{1 - α_{1}} (0) + ε_{1}}{ε_{1}} .

The convergence of $s_{2 i}$ can be proved according to a similar procedure.

Step 2. When $s_{i} = 0$ , we have $e_{xi} = 0$ . Consider the Lyapunov function as follows:

V_{yi} = \frac{1}{2} e_{yi}^{2} .

(13)

From $s_{2 i} = 0$ , that is,i.e. $μ e_{θ i} = - \arctan (v_{0} e_{yi}), μ > \frac{1}{2}$ , the time derivative of $V_{yi}$ is given as

\begin{matrix} {\overset{\cdot}{V}}_{yi} = e_{yi} {\overset{\cdot}{e}}_{yi} \\ = v_{0} e_{yi} \sin (e_{θ i}) \\ = - v_{0} e_{yi} \sin (\frac{1}{μ} \arctan (v_{0} e_{yi})) \\ \leq 0 . \end{matrix}

(14)

Thus, $e_{yi}$ will converge to zero.□

Remark 1. Note that $s_{i}$ will converge to zero within a finite time, and $e_{yi}$ will converge to zero. According to the LaSalle’s invariance principle, $s_{2 i}$ will converge within the set ${[e_{xi}, e_{yi}, e_{θ i}]^{T} | e_{xi} = 0 and e_{yi} = 0 and μ e_{θ i} + \arctan (v_{0} e_{yi}) = 0}$ . Therefore, $e_{θ i}$ will converge to zero. Furthermore, the closed-loop error system is globally asymptotically stable.

Depletion model

In order to solve the chattering, the following depletion model (15) is introduced to process the system input:

h (x) = \frac{c_{2} x}{c_{1} + | x |} (1 - e^{- (c_{1} + | x |) δ}),

(15)

where $c_{1}$ , $c_{2}$ , and $δ$ are positive constants. This model is a continuous bounded function, and its output only varies smoothly within a small range. Furthermore, the tracking errors $[e_{xi}^{'}, e_{yi}^{'}, e_{θ i}^{'}]^{T}$ processed by the depletion model can be obtained as follows:

e_{xi}^{'} = h (e_{xi})

(16)

e_{yi}^{'} = h (e_{yi}),

(17)

e_{θ i}^{'} = h (e_{θ i}) .

(18)

Remark 2. In the sliding mode control law (10), $μ$ is an important parameter, which has an impact on the response speed and stability of the system. Increasing the value $μ$ appropriately can improve the system’s response speed, but it may also lead to chattering. The reason for chattering is due to the controller’s input changing too quickly, resulting in velocit y a velocity jump. Therefore, we utilize (15) to process the controller inputs, ensuring they vary smoothly while remaining within a relatively small range.

From (16) to (18), the modified sliding mode control law is proposed as

\begin{matrix} [\begin{matrix} v_{i} \\ ω_{i} \end{matrix}] = [\begin{matrix} v_{0} \cos {e^{'}}_{θ i} + ω_{i} {e^{'}}_{yi} + ε_{1} | {s_{1 i}}^{'} |^{α_{1}} sgn ({s^{'}}_{1 i}) + ε_{1^{'}} {s^{'}}_{1 i} \\ μ ω_{0} + ((v_{0}^{2} \sin {e^{'}}_{θ i} + {\overset{\cdot}{v}}_{0} e_{yi}) / (1 + {(v_{0} ω_{0})}^{2})) \\ \frac{+ ε_{2} | {s^{'}}_{2 i} |^{α_{2}} sgn ({s^{'}}_{2 i}) + ε_{2^{'}} {s^{'}}_{2 i}}{μ + (v_{0} {e^{'}}_{xi} / (1 + {(v_{0} {e^{'}}_{yi})}^{2}))} \end{matrix}] \\ + [\begin{matrix} φ_{1 i} \\ φ_{2 i} \end{matrix}], \end{matrix}

(19)

where $s_{1 i}^{'} = e_{xi}^{'}$ , $s_{2 i}^{'} = μ e_{θ i}^{'} + \arctan (v_{0} e_{yi}^{'})$ . Two first-order low-pass filters $φ_{1}$ and $φ_{2}$ for increasing system stability are described as follows:

[\begin{matrix} φ_{1 i} (n) \\ φ_{2 i} (n) \end{matrix}] = [\begin{matrix} (1 - γ_{1}) φ_{1 i} (n - 1) + γ_{1} \frac{e_{xi}}{\sqrt{1 + e_{xi}^{2} + e_{yi}^{2}}} \\ (1 - γ_{2}) φ_{2 i} (n - 1) + γ_{2} \sin e_{θ i} \end{matrix}],

(20)

where $0 < γ_{1}, γ_{2} < 1$ are constants. From the modified control law (19), the system chattering could be effectively eliminated in this paper.

Formation obstacle avoidance

In order to achieve the formation task of realistic scenarios, the obstacle avoidance method combined with the sliding mode control law is given to form an integrated formation controller.

Inspired by the APF method,the obstacles exert a repulsive force on the follower, while the virtual robot exerts an attractive force on the corresponding follower. Under the resultant force, the robots could avoid the obstacles. The attractive force function (21) and repulsive force function (22) are constructed as follows:

F_{att}^{i} (d_{l - f}^{i}) = \frac{d_{l - f}^{i} - l_{i}}{l_{i} - 2 r_{i}} - \ln \frac{d_{l - f}^{i} - 2 r_{i}}{l_{i} - 2 r_{i}},

(21)

F_{rep}^{i, l} (d_{i, l}) = {\begin{matrix} (\frac{1}{d_{i, l}} - \frac{1}{ρ}) \frac{1}{d_{i, l}^{2}} & d_{i, l} \leq ρ, \\ 0 & d_{i, l} > ρ, \end{matrix}

(22)

where $F_{att}^{i}$ denotes the attractive force exerted on the $i$ th follower, and $F_{rep}^{i, l}$ represents the repulsive force exerted by the $l$ th $(l = 1, 2, \dots, m)$ obstacle on the $i$ th follower. $d_{l - f}^{i}$ denotes the distance between the $i$ th followers and the leader. $r_{i}$ is the collision radius of the $i$ th followers, and $d_{i, l}$ is the distance between the $i$ th followers and the $l$ th obstacle. $ρ$ represents the maximum impact range of the obstacles.

As shown in Figure 3, $ϕ_{att}^{i}$ and $ϕ_{rep}^{i, l}$ represent the $i$ th robot’s line of sight angle relative to the $i$ th virtual robot and the $l$ th obstacle in the global coordinate system, respectively. The force acting on the $i$ th robot in the local coordinate system ${x_{ri} o y_{ri}}$ can be represented as

F_{xi} = λ_{att, x} F_{att}^{i} \cos (ϕ_{att}^{i} - θ_{i}) - λ_{rep, x} \sum_{l = 1}^{m} F_{rep}^{i, l} \cos (ϕ_{rep}^{i, l} - θ_{i}),

(23)

F_{yi} = λ_{att, y} F_{att}^{i} \sin (ϕ_{att}^{i} - θ_{i}) - λ_{rep, y} \sum_{l = 1}^{m} F_{rep}^{i, l} \sin (ϕ_{rep}^{i, l} - θ_{i}),

(24)

where $F_{xi}$ and $F_{yi}$ denote the resultant force in the $x_{ri}$ -axis and $y_{ri}$ -axis, respectively. $λ_{att, x}$ , $λ_{att, y}$ , $λ_{rep, x},$ and $λ_{rep, y}$ are positive constants. Furthermore, the velocity increment $Δ v_{i}$ and angular velocity increment $Δ ω_{i}$ can be obtained as follows:

[\begin{matrix} Δ v_{i} \\ Δ ω_{i} \end{matrix}] = [\begin{matrix} F_{x} \\ F_{y} \end{matrix}] Δ t,

(25)

where $Δ t$ denotes the sampling time.

Figure 3.

The decomposition of forces acting on the ith follower robot.

In order to coordinate formation and obstacle avoidance capabilities, we introduce a dynamic-gain structure as follows:

[\begin{matrix} k_{smc}^{i} \\ k_{att}^{i} \\ k_{rep}^{i} \end{matrix}] = {\begin{matrix} {[\begin{matrix} 1 - e^{- d_{i, min}} & β (1 - e^{- d_{i, min}}) & 1 \end{matrix}]}^{T} & d_{i, min} \leq ρ, \\ {[\begin{matrix} 1 & 1 & 0 \end{matrix}]}^{T} & d_{i, min} > ρ, \end{matrix}

(26)

where $k_{smc}^{i}, k_{att}^{i},$ and $k_{rep}^{i}$ denotehe sliding mode controller (19) output gain, attractive force output gain (21), and repulsive force (22) output gain for the $i$ th robot, respectively. $d_{i, min}$ represents the distance between the $i$ th robot and the nearest obstacle. $β$ is a positive constant. By utilizing the output gains in (26), the output of (19), (23), and (24) can be adjusted according to the environment in real-time. Thus, the integrated formation controller can be obtained as follows:

\begin{matrix} [\begin{matrix} v_{i} \\ ω_{i} \end{matrix}] = k_{smc}^{i} [\begin{matrix} v_{0} \cos {e^{'}}_{θ i} + ω_{i} {e^{'}}_{yi} + ε_{1} | {s^{'}}_{1 i} |^{α_{1}} sgn ({s^{'}}_{1 i}) + ε_{1^{'}} {s^{'}}_{1 i} \\ \frac{μ ω_{0} + ((v_{0}^{2} \sin {e^{'}}_{θ i} + {\overset{\cdot}{v}}_{0} e_{yi}) / (1 + {(v_{0} ω_{0})}^{2})) + ε_{2} | {s^{'}}_{2 i} |^{α_{2}} sgn ({s^{'}}_{2 i}) + ε_{2^{'}} {s^{'}}_{2 i}}{μ + (v_{0} {e^{'}}_{xi} / (1 + {(v_{0} {e^{'}}_{yi})}^{2}))} \end{matrix}] + k_{smc}^{i} [\begin{matrix} φ_{1 i} \\ φ_{2 i} \end{matrix}] \\ + [\begin{matrix} k_{att}^{i} λ_{att, x} F_{att}^{i} \cos (ϕ_{att}^{i} - θ_{i}) - k_{rep}^{i} λ_{rep, x} \sum_{l = 1}^{m} F_{rep}^{i, l} \cos (ϕ_{rep}^{i, l} - θ_{i}) \\ k_{att}^{i} λ_{att, y} F_{att}^{i} \sin (ϕ_{att}^{i} - θ_{i}) - k_{rep}^{i} λ_{rep, y} \sum_{l = 1}^{m} F_{rep}^{i, l} \sin (ϕ_{rep}^{i, l} - θ_{i}) \end{matrix}] Δ t . \end{matrix}

(27)

Remark 3. From (26) and (27), the composition of the integrated controller outputs varies in different environments. When $d_{i, min} > ρ$ , there is no obstacle in the vicinity of the robot, thus, repulsive force is not needed, and thus $k_{rep}^{i, l} = 0$ . Besides, $k_{smc}^{i} = 1$ and $k_{att}^{i} = 1$ imply that sliding mode controller and attractive force will output to maintain formation.

Otherwise, when $d_{i, min} \leq ρ$ , it is indicated that the robot is in an obstacles environment, thus $k_{rep}^{i, l} = 1$ such that repulsive force output to avoid obstacles. It should be pointed out that the excessive output of the sliding mode controller and attractive forces is detrimental to the robot’s obstacle avoidance capabilities. Moreover, we aim for the robot to prioritize obstacle avoidance over maintaining formation in the presence of obstacles. Therefore, we design $k_{smc}^{i} = 1 - e^{- d_{i, min}}$ and $k_{att}^{i} = β (1 - e^{- d_{i, min}})$ when $d_{i, min} \leq ρ$ , which means that the sliding mode controller and attractive force will gradually weaken as $d_{i, min}$ decreases. Furthermore, the robot will rejoin the formation after successfully avoiding the obstacles.

Hence, the dynamic-gain structure (26) enables the robots to make better autonomous decisions between maintaining formation and avoiding obstacles. Therefore, the integrated controller (27) in this paper is more reasonable than the controller in Pan et al. (2021), that is,i.e. the sum of the formation control input and the obstacle avoidance control input.

Remark 4. It should be pointed out that when $d_{i, min} > ρ$ , the output of the attractive force is necessary. From (13) and (14), it is deduced that ${\overset{\cdot}{V}}_{yi} = 0$ when $v_{0} = 0$ , which means the tracking error $e_{yi}$ will not converge to zero if the leader’s velocity $v_{0} = 0$ equal to zero. Thus, if $v_{0} = 0$ , the multi-robot system may not be able to form a formation. The attractive force $F_{att}^{i}$ can move the follower to the desired formation position, even when $v_{0} = 0$ .

Remark 5. In Wang et al. (2017), the formation obstacle avoidance is achieved by pre-planning the paths for each robot, which implies that each path needs to be independently planned before robot’s movement. It could not ensure good real-time performance because the system can only start working after all robots have completed their path planning. In fact, when the trajectory of the leader is determined, the trajectories of other followers are largely determined as well, which makes independent redundant planning unnecessary. In this paper, followers only need to receive the leader’s state information and detect obstacles in their immediate vicinity to achieve formation obstacle avoidance, which eliminates the need for path planning of the followers. Therefore, the method proposed in this paper is more applicable.

Evaluation and experimental results

The performance evaluation and experimental results of the proposed method are presented in this section to demonstrate its effectiveness. The MASs consisting of three robots are considered, and the communication topologies are shown in Figure 4.

Figure 4.

The communication topology.

Simulation

Firstly, the effectiveness of the proposed depletion model (15) will be demonstrated through simulation. The sliding mode controller parameters are set as follows: $μ = 12, ε_{1} = 0.001, ε_{1^{'}} = 3, ε_{2} = 0.0015, ε_{2^{'}} = 4.5, α_{1} = α_{2} = 0.2, c_{2} = 3.0, c_{1} = 0.8, δ = 0.1$ , and $γ_{1} = γ_{2} = 0.8$ . The initial values of the robots are set as follows: $[x_{0} (0), y_{0} (0), θ_{0} (0)]^{T} = [0, 0, π / 8]^{T}$ , $[x_{1} (0), y_{1} (0), θ_{1} (0)]^{T} = [5, 0, 0]^{T}, [x_{2} (0), y_{2} (0), θ_{2} (0)]^{T}, = [0, - 5, 0]^{T}$ . The formation is configured as a linear formation with $l_{i} = 5 m$ . The leader’s velocity and angle velocity are given as $v_{0} = 2 m / s$ and $ω_{0} = 0.6 \sin (t) rad / s$ , respectively. Besides, the maximum velocity and angular velocity of the followers are limited to $4 m / s$ and $5 rad / s$ , respectively.

The trajectories, tracking errors, and controller outputs of robots with (10) and (19) are shown in the left and right sides of Figure 5, respectively. By adopting (10), the controller output $v_{i}$ exhibits chattering, which prevents the tracking errors from quickly converging to zero. In contrast, through adopting (19), no chattering occurs, and the tracking errors could quickly converge. Therefore, the depletion model (15) is effective in eliminating chattering.

Figure 5.

The simulation results with control law (10) (left) and with modified control law (19) (right): (a) the trajectories of robots with control law (10); (b) the trajectories of robots with modified control law (19); (c) the formation tracking error for each follower with control law (10); (d) the formation tracking error for each follower with control law (19); (e) the control input for each follower with control law (10); and (f) the control input for each follower with control law (19).

Experiment

To verify the proposed method in actual implementation, we will examine integrated controller (27) performance based on SCOUT MINI unmanned ground vehicles (UGVs) in obstacle environments.

The real formation experiments are carried out in an indoor obstacle environment. The diagram of the experimental system is illustrated in Figure 6. The four-wheeled UGVs SCOUT MINI (Zhang et al., 2023) is adopted as the experiment platforms. The leader’s trajectory and formation shape are preseted on a laptop (Intel Core i5, CPU@ 2.4 Hz equipped). The directed communication topology is imitated with a robot operating system (ROS Noteic). For the $i$ th UGV, thread $i$ is adopted to receive the UGV’s state, compute the controller output, and send the control command to the onboard computing device (NVIDIA Jeston Nano and NVIDIA Jeston AGX Xavier). The onboard computing device will send control commands to the UGV and transmit the UGV’s state back to the laptop. Due to the limited size of the environment, UGVs rely on odometry for localization. In the majority of practical application scenarios, UGVs can be located using relative methods such as Global Positioning System (outdoor environment) and visual-inertial odometry (indoor environment). The obstacles position is prior knowledge in experiments. Note that the obstacles position and environment map can also be obtained online with sensors such as depth cameras and laser radar.

Figure 6.

The diagram of experimental system.

The integrated controller parameters are set as follows: $μ = 60$ , $c_{1} = 0.8$ , $c_{2} = 0.5$ , $δ = 0.405$ , $l_{i} = 2$ , $2 r_{i} = 0.845$ , $ρ = 1.5$ , $λ_{att, x} = 2.25$ , $λ_{att, y} = 3.25$ , $λ_{rep, x} = 2.75$ , $λ_{rep, y} = 5.75$ , $β = 0.9$ , $Δ t = 0.1$ , and the other parameters are the same as those in the simulation. To achieve better system performance, $μ = 60$ is chosen as a relatively large parameter. According to previous analysis, the large $μ$ can lead to chattering in the system. Therefore, it is necessary to employ the proposed depletion model (14) in the actual system. The initial values of UGVs are set as follows: $[x_{0} (0), y_{0} (0), θ_{0} (0)]^{T} = [- 1, 0, 0]^{T}$ , $[x_{1} (0), y_{1} (0), θ_{1} (0)]^{T} = [- 2.732, 1, 0]^{T}$ , and $[x_{2} (0), y_{2} (0),$ $θ_{2} (0)]^{T} = [- 2.732, - 1, 0]^{T}$ . The leader’s velocity and angle velocity are given as $v_{0} = 0.24$ m/s and $ω_{0} = 0$ rad/s. The maximum velocity and angular velocity of the UGVs are limited to 0.6 m/s and 0.4 rad/s, respectively.

The experiment results are displayed in Figure 7. It can be observed that UGVs can leave the formation to avoid obstacles and quickly return to the desired formation after obstacle avoidance is completed. Therefore, the integrated controller (27) is effective. The formation trajectories of obstacle avoidance experiments in different environments are shown in Figure 8, which further demonstrates the effectiveness and reliability of the proposed method.

Figure 7.

The experiment results in the obstacle environment with (27): (a) the trajectories of unmanned ground vehicles (UGVs) in the obstacle environment; (b) the formation tracking error for each follower; and (c) the velocities and angle velocities of UGVs.

Figure 8.

The formation trajectories in different obstacle environments: (a) Case I; (b) Case II; (c) Case III; and (d) Case IV.

Conclusion

In this paper, the formation obstacle avoidance problem has been investigated for multiple NWMRs. A novel integrated controller that combines a sliding mode controller and a force function is proposed, and a dynamic-gain structure is introduced to coordinate the outputs of the sliding mode controller and the force function. Then, the formation obstacle avoidance task is realized by the proposed integrated controller using minimal computational resources, which ensure good real-time performance. Simulation and experiment results demonstrate the effectiveness of the proposed collision-free formation control scheme. However, the formation approach in this paper only tracks the virtual robot’s trajectory, without employing distributed consensus theory in the controller design. Additionally, the designed controller does not account for uncertainties, such as unknown model parameters and external disturbances. The possible future work includes formation control for multiple NWMRs with unknown disturbances and cyber attacks.

Footnotes

Declaration of conflicting interests

The authors declared no potential conflicts of interest with respect to the research, authorship, and/or publication of this article.

Funding

The authors disclosed receipt of the following financial support for the research, authorship, and/or publication of this article: This work received financial support from the Science and Technology Small and Medium-sized Enterprise Innovation Capability Enhancement Project of Shandong Province (grant no. 2023TSGC0226), and the National Science and Technology Innovation Platform Open Project of China Academy of Railway Sciences (grant no. RITS2024KF01), and the Guangdong Basic and Applied Basic Research Foundation (grant nos. 2022A1515140126 and 2023A1515011172), and the Young and Middle-aged Science and Technology Innovation Talent of Shenyang (grant no. RC220485), and the Chunhui Plan Cooperative Project of Ministry of Education (grant no. HZKY20220424), and the Fundamental Research Funds for the Central Universities under grant no. N2426002.

Data availability statement

The data collected in this study are available from the corresponding author upon reasonable request.

ORCID iD

Junyi Wang

References

Antonelli

Arrichiello

Chiaverini

(2009) Experiments of formation control with multirobot systems using the null-space-based behavioral control. IEEE Transactions on Control Systems Technology 17: 1173–1182.

Chang

Chen

, et al. (2011) Fuzzy sliding-mode formation control for multirobot systems: Design and implementation. IEEE Transactions on Systems, Man, and Cybernetics, Part B (Cybernetics) 42: 444–457.

Chen

Luo

Mei

, et al. (2016) UAV path planning using artificial potential field method updated by optimal control theory. International Journal of Systems Science 47: 1407–1420.

Consolini

Morbidi

Prattichizzo

, et al. (2008) Leader–follower formation control of nonholonomic mobile robots with input constraints. Automatica 44: 1343–1349.

Dai

Chen

, et al. (2019) Adaptive leader–follower formation control of nonholonomic mobile robots with prescribed transient and steady-state performance. IEEE Transactions on Industrial Informatics 16: 3662–3671.

Damani

Benselama

Hedjar

(2023) Formation control of nonholonomic wheeled mobile robots via fuzzy fractional-order integral sliding mode control. International Journal of Dynamics and Control 11: 2273–2284.

Elayaperumal

Joo

(2023) Robust swarm formation for multiple nonholonomic two-wheeled mobile robots using leader–follower approach via sliding mode controller and neural dynamic model. Journal of Electrical Engineering & Technology 18: 2245–2252.

Fei

Shi

Lim

(2020) Neural network adaptive dynamic sliding mode formation control of multi-agent systems. International Journal of Systems Science 51: 2025–2040.

Fei

Shi

Lim

(2023) Robust and collision-free formation control of multiagent systems with limited information. IEEE Transactions on Neural Networks and Learning Systems 34: 4286–4295.

10.

Gao

Guo

(2020) Fixed-time sliding mode formation control of AUVs based on a disturbance observer. IEEE/CAA Journal of Automatica Sinica 7: 539–545.

11.

Hao

Zhao

, et al. (2022) Dynamic path planning of a three-dimensional underwater AUV based on an adaptive genetic algorithm. Ocean Engineering 263: 112421.

12.

Hosseinzadeh Yamchi

Mahboobi Esfanjani

(2018) A decentralized receding horizon optimal approach to formation control of networked mobile robots. Optimal Control Applications and Methods 39: 51–64.

13.

Khatib

(1986) Real-time obstacle avoidance for manipulators and mobile robots. The International Journal of Robotics Research 5: 90–98.

14.

Kuang

Xia

, et al. (2022) Formation control of nonholonomic mobile robots with inaccurate global positions and velocities. International Journal of Robust and Nonlinear Control 32: 9776–9790.

15.

Zhao

Chen

CLP

, et al. (2018) Finite-time formation control of under-actuated ships using nonlinear sliding mode control. IEEE Transactions on Cybernetics 48: 3243–3253.

16.

Lin

Liu

HHT

(2018) Topology-based distributed optimization for multi-UAV cooperative wildfire monitoring. International Journal of Robust and Nonlinear Control 39: 1530–1548.

17.

Liu

Wei

Wang

, et al. (2024a) Trajectory optimization for adaptive deformed wheels to overcome steps using an improved hybrid genetic algorithm and an adaptive particle swarm optimization. Mathematics 12: 2077.

18.

Liu

Xie

, et al. (2024b) Secure Lleader–follower formation control of networked mobile robots under replay attacks. IEEE Transactions on Industrial Informatics 20: 4149–4159.

19.

Peng

(2020) Learning-based cooperative multiagent formation control with collision avoidance. IEEE Transactions on Systems, Man, and Cybernetics: Systems 52: 7341–7352.

20.

Norsahperi

NMH

Danapalasingam

(2020) An improved optimal integral sliding mode control for uncertain robotic manipulators with reduced tracking error, chattering, and energy consumption. Mechanical Systems and Signal Processing 142: 106747.

21.

Park

Ahn

(2015) A survey of multi-agent formation control. Automatica 53: 424–440.

22.

Pan

Yang

, et al. (2019) Multi-robot obstacle avoidance based on the improved artificial potential field and PID adaptive tracking control algorithm. Robotica 37: 1883–1903.

23.

Pan

Zhang

Xia

, et al. (2021) An improved artificial potential field method for path planning and formation control of the multi-UAV systems. IEEE Transactions on Circuits and Systems II: Express Briefs 69: 1129–1133.

24.

Peng

Zhang

Xie

, et al. (2023) Potential field-based dual heuristic programming for path-following and obstacle avoidance of wheeled mobile robots. Robotica 41: 1931–1946.

25.

Sabiha

Kamel

Said

, et al. (2022) ROS-based trajectory tracking control for autonomous tracked vehicle using optimized backstepping and sliding mode control. Robotics and Autonomous Systems 152: 104058.

26.

Shou

, et al. (2022) Finite-time formation control and obstacle avoidance of multi-agent system with application. International Journal of Robust and Nonlinear Control 32: 2883–2901.

27.

Sun

Xia

(2022) Fully distributed event-triggered consensus for a class of second-order nonlinear multi-agent systems. Circuits Systems and Signal Processing 41: 725–742.

28.

Sun

Xie

Zheng

, et al. (2021) Path-following control of Mecanum-wheels omnidirectional mobile robots using nonsingular terminal sliding mode. Mechanical Systems and Signal Processing 147: 107128.

29.

Tong

Liu

, et al. (2022) A hybrid formation path planning based on A* and multi-target improved artificial potential field algorithm in the 2D random environments. Advanced Engineering Informatics 54: 101755.

30.

Utkin

(1978) Sliding Modes and Their Applications in Variable Structure Systems. Moscow: MIR.

31.

Wang

Zhang

, et al. (2023a) Dissipativity-based consensus tracking control of nonlinear multiagent systems with generally uncertain Markovian switching topologies and event-triggered strategy. IEEE Transactions on Cybernetics 53: 4763–4778.

32.

Wang

Chen

, et al. (2023b) Cooperative target search and tracking for multi-UAVs based on control barrier functions. Transactions of the Institute of Measurement and Control 45: 2582–2589.

33.

Wang

Yang

Chen

, et al (2017) Leader–follower formation control based on artificial potential field and sliding mode control. In: Intelligent robotics and applications: 10th international conference, ICIRA, 2017, pp. 203–214

34.

Dai

Jiang

, et al. (2023) Robot path planning based on artificial potential field with deterministic annealing. ISA Transactions 138: 74–87.

35.

Xie

Zheng

Sun

, et al. (2022) Finite-time tracking control for nonholonomic wheeled mobile robot using adaptive fast nonsingular terminal sliding mode. Nonlinear Dynamics 110: 1437–1453.

36.

Yang

Ding

, et al. (2023) Sliding mode fault-tolerant consensus control for heterogeneous multi-agent systems based on finite-time observer and controller. Transactions of the Institute of Measurement and Control 45: 2081–2090.

37.

Shirinzadeh

, et al. (2005) Continuous finite-time control for robotic manipulators with terminal sliding mode. Automatica 41: 1957–1964.

38.

Guo

Ahn

, et al. (2023) Neural adaptive distributed formation control of nonlinear multi-UAVs with unmodeled dynamics. IEEE Transactions on Neural Networks and Learning Systems 34: 9555–9561.

39.

Zhang

Chen

, et al. (2023) CoNi-MPC: Cooperative non-inertial frame based model predictive control. IEEE Robotics and Automation Letters 8: 8082–8089.

40.

Zhang

Lapierre

Xiang

(2012) Distributed control of coordinated path tracking for networked nonholonomic mobile vehicles. IEEE Transactions on Industrial Informatics 9: 472–484.

41.

Zhao

Peng

Wang

, et al. (2022) Concise leader–follower formation control of underactuated unmanned surface vehicle with output error constraints. Transactions of the Institute of Measurement and Control 44: 1081–1094.

42.

Zheng

Wang

Man

, et al. (2015) Robust motion control of a linear motor positioner using fast nonsingular terminal sliding mode. IEEE/ASME Transactions on Mechatronics 20: 1743–1752.