Abstract
This paper addresses a leader–follower formation control problem for four-legged robots under discrete-valued input constraints. Four-legged robots are more suitable for rough terrain missions than wheeled robots because the tip positions of their legs can be changed depending on the terrain. However, it is difficult to control these robots through continuous-valued inputs because they are steered by switching between specific movements (i.e., discrete-valued signals). Motivated by this fact, we have proposed controllers that achieve fixed formations of four-legged robots using discrete-valued inputs, but moving formations, which are necessary for some applications, have not been considered yet. Herein, we present a solution to the above leader–follower formation control problem based on the combination of PD-like formation controllers and dynamic quantization. We further introduce a performance index to evaluate the difference between two systems whose inputs are quantized and unquantized and analyze the index for the feedback system with the presented controllers. As a result, an upper bound of the performance index is derived as a function of the system parameters. This is useful to evaluate the impact of the quantization on the behavior of the feedback system and to provide a theoretical guarantee of the stability of the system.
Similar content being viewed by others
Avoid common mistakes on your manuscript.
1 Introduction
A popular research topic in the area of systems and control is the formation control of multi-robot systems to allow multiple robots to achieve a prespecified configuration in a distributed manner. The popularity of this topic is attributed to its modern applications, including the formation flight of unmanned aerial vehicles and the exploration of hazardous environments through mobile robots.
Herein, we focus on four-legged robots (see, e.g., Fig. 1) as robots to be controlled. Four-legged robots are capable of performing straight, lateral, and rotational movements using their four legs. They can also cross obstacles if the tips of their legs can reach the top surfaces of the obstacles. Compared to wheeled robots, four-legged robots are suitable for rough terrain missions because the tip positions of their legs can be changed depending on the terrain. Moreover, using four legs improves the walking stability and reduces the production and operation costs. A lower number of legs reduce the walking stability of robots, whereas a higher number of legs increase the hardware cost and the energy consumption.
In our previous study [1], we addressed a formation control problem for four-legged robots subject to discrete-valued input constraints. The motivation was that the commands of specific movements are used to drive four-legged robots [2, 3] and switching between the commands (i.e., discrete-valued signals) enables the position control of the robots. We then proposed formation controllers as a solution to this problem. The proposed controllers were obtained based on the combination of conventional formation controllers for omnidirectional robots and dynamic quantization, i.e., transforming continuous-valued signals into discrete-valued ones through feedback mechanisms. However, [1] focused on achieving fixed formations and did not consider moving formations. Moving formations are necessary for many applications, including cooperative exploration and transportation through mobile robots.
Motivated by this, we aim to extend the theoretical framework developed in [1] to the case of leader–follower formations [4]. In the leader–follower formation, we regard one robot as the leader and the other robots as the followers, and the followers track the leader while preserving a prespecified formation. In this scenario, moving formations can be achieved simply by steering the leader. Although the leader–follower approach leads to an over-reliance on a single robot for achieving the group objective and is not robust against disturbances [5], its simplicity and scalability are major advantages [6]. In addition, there are some cases where the leader and the followers are preassigned in the target system and applying the leader–follower approach is natural, e.g., following and hunting a target with mobile robots [7], the formation flying of two spacecraft [8, 9], and adaptive cruise control systems [10].
The main contributions of this paper are summarized below.
-
1.
We present controllers that achieve leader–follower formations using discrete-valued inputs. Our controllers are based on the combination of PD-like formation controllers and dynamic quantization. These controllers are given as a simple extension of the controllers in [1] by focusing on their structures and extending the specific parts appropriately. Numerical examples demonstrate the performance of the presented controllers.
-
2.
We theoretically analyze the feedback system with the presented controllers. Specifically, we evaluate a performance index that quantifies the difference between the behavior of the feedback systems whose inputs are quantized and unquantized. We derive an upper bound of the performance index as a function of the system parameters. This result helps to evaluate the impact of the quantization on the system behavior and to provide a theoretical guarantee of the stability of the feedback system.
Finally, we discuss the related works. A number of results on leader–follower formation control have been reported. Consolini et al. [6] considered the formation control for unicycle-type robots with constraints on their input magnitudes. Mariottini et al. [5] and Han et al. [11] discussed the combination of localization and control to achieve leader–follower formations. Lin et al. [12] proposed an approach based on complex-valued graph Laplacians to study a leader–follower formation control problem. Dai et al. [13] developed adaptive formation controllers to achieve both prescribed transient and steady-state performance. Tang et al. [14] studied the formation control in three-dimensional space based on the persistence of excitation of the desired formation. Moreover, we can find results in the cases where quantized signals are included. Qiu et al. [15] addressed a leader-following consensus problem for high-order multi-agent systems with quantized outputs. Xiong et al. [16] studied the leader–follower formation control of linear heterogeneous multi-agent systems using a quantizer with a zoom variable. Huang and Dong [17] focused on the reliable formation control under quantized communication and cyber attacks. Hu et al. [18] and Wang et al. [19] developed adaptive formation controllers for unmanned aerial vehicles with uncertainties and quantized inputs. They [20] also considered the case where both inputs and outputs are quantized. However, the aforementioned studies primarily focused on omnidirectional robots, unicycle-type robots, and robots with general linear dynamics, and four-legged robots were not considered. In addition, the quantization of signals in the existing studies is due to the limitation of the capacity of the communication network between robots, whereas that in our study is due to the property of four-legged robots. As a result, our quantization method is distinguished from the existing ones; therefore, the existing results cannot be directly applied to this study.
Notation: We denote the real number field and the set of positive real numbers by \(\mathbb {R}\) and \(\mathbb {R}_+\), respectively. For the complex number z, \(\text {Re}(z)\), \(\text {Im}(z)\), and \(\vert z\vert \) represent its real part, imaginary part, and absolute value, respectively. For the vectors \(x_1,x_2,\ldots ,x_n\in \mathbb {R}^2\) and the set \(\mathbb {I}:=\{ i_{1},i_{2},\ldots ,i_{m}\}\subseteq \{ 1,2,\ldots ,n\}\), let \([x_i ]_{i\in \mathbb {I}}:=[x_{i_1}^\top ~x_{i_2}^\top ~\cdots ~x_{i_m}^\top ]^\top \in \mathbb {R}^{2m}\). The \(\infty \)-norms of vectors and matrices and the Euclidean norms of vectors are described using \(\Vert \cdot \Vert \) and \(\Vert \cdot \Vert _2\), respectively. Let \(0_{n\times m}\) be the \(n\times m\) zero matrix, and let \(I_n\) be the n-dimensional identity matrix. We denote the diagonal matrix with the diagonal elements \(x_1,x_2,\ldots ,x_n\in \mathbb {R}\) by \(\text {diag}(x_1,x_2,\ldots ,x_n)\). The Kronecker product of the matrices \(M_1\) and \(M_2\) is defined by \(M_1\otimes M_2\). The cardinality of the set \(\mathbb {S}\) is denoted by \(\vert \mathbb {S}\vert \). We use \(\mathbb {B}(c,r)\) to represent a closed disk in \(\mathbb {R}^2\) with the center c and the radius r, i.e., \(\mathbb {B}(c,r):=\{ x\in \mathbb {R}^2\, \vert \, \Vert x-c\Vert _2\le r\}\). For the positive number c and the vector v, let \(\text {sat}_c(v)\) denote the saturation function such that \(\vert v_i\vert \le c\) is guaranteed for each element \(v_i\) of v.
2 Problem formulation
Consider the multi-robot system \(\Sigma \) shown in Fig. 2, which comprises n four-legged robots in two-dimensional space and controllers embedded in them.
Robot i (\(i\in \{1,2,\ldots ,n\}\)) is given as the discrete-time system
where \(t\in \{0,1,\ldots \}\) denotes the discrete time and \([x_{i1}(t)\ x_{i2}(t)]^\top \in \mathbb {R}^2\) (defined as \(x_i(t)\)) and \(\theta _i(t)\in (-\pi ,\pi ]\) denote the position and orientation of robot i, respectively. The variables \(u_{i1}(t),u_{i2}(t)\) \(\in \mathbb {R}\) and \(u_{i3}(t)\in \{0,1\}\) stand for the control inputs determining the translational and rotational velocities and the movement type, respectively. The relation between the value of \(u_{i3}(t)\) and the movement type is shown in Fig. 3. If \(u_{i3}(t)=0\), robot i performs rotational and straight movements, whereas if \(u_{i3}(t)=1\), it performs rotational and lateral movements. The system (1) is derived by incorporating \(u_{i3}(t)\) into a discrete-time model of a unicycle-type robot in order to enable lateral movements.
The controller embedded in robot i is of the form
where \(\xi _i(t)\in \mathbb {R}^m\) is the state, \([x_j(t)-x_i(t)]_{j\in \mathbb {N}_i}\in \mathbb {R}^{2\vert \mathbb {N}_i\vert }\), \(\theta _i(t)\), and \([y_j(t)]_{j\in \mathbb {N}_i}\in \mathbb {R}^{\mu \vert \mathbb {N}_i\vert }\) are the inputs, \(u_i(t)=[u_{i1}(t)\ u_{i2}(t)\ u_{i3}(t)]^\top \) and \(y_{i}(t)\in \mathbb {R}^\mu \) are the outputs, and \(f_{i1}:\mathbb {R}^m\times \mathbb {R}^{2\vert \mathbb {N}_i\vert }\times (-\pi ,\pi ]\times \mathbb {R}^{\mu \vert \mathbb {N}_i\vert }\rightarrow \mathbb {R}^m\), \(f_{i2}:\mathbb {R}^m\times \mathbb {R}^{2\vert \mathbb {N}_i\vert }\times (-\pi ,\pi ]\times \mathbb {R}^{\mu \vert \mathbb {N}_i\vert }\rightarrow \mathbb {R}^3\), and \(f_{i3}:\mathbb {R}^m\times \mathbb {R}^{2\vert \mathbb {N}_i\vert }\times (-\pi ,\pi ]\times \mathbb {R}^{\mu \vert \mathbb {N}_i\vert }\rightarrow \mathbb {R}^\mu \) are functions characterizing the controller. The set \(\mathbb {N}_i\subset \{1,2,\ldots ,n\}\) consists of the indices of the neighboring robots from which robot i can obtain the information on the relative positions. To simplify the discussion, we assume the initial state to be zero. We further assume that for the output \(u_i(t)\), its elements \(u_{i1}(t)\) and \(u_{i2}(t)\) must take discrete values, that is, \(u_{i1}(t)\in \{0,\pm s,\pm 2s,\ldots \}\) and \(u_{i2}(t)\in \{0,\pm \pi /4,\pm \pi /2,\pm (3\pi )/4,\pi \}\), where \(s\in \mathbb {R}_+\) is the step size. This restricts the movement distance and direction of robot i at each time t to integer multiples of s and \(\pi /4\), respectively.
To represent the network structure of the system \(\Sigma \), we introduce the time-invariant directed graph \(G=(\mathbb {V},\mathbb {E})\), where \(\mathbb {V}:=\{1,2,\ldots ,n\}\) and \(\mathbb {E}\subset \mathbb {V}\times \mathbb {V}\) denote the vertex and edge sets that correspond to the indices of the robots and the connections among them, respectively. Then, we define \(\mathbb {N}_i:=\{ j\in \mathbb {V}\, \vert \, (j,i)\in \mathbb {E}\}\).
To consider the leader–follower formation control for the system \(\Sigma \), we suppose that robot 1 is the leader and robots 2 to n are the followers without loss of generality. Let \(d_1(t)\in \mathbb {R}^2\) and \(r_{ij}\in \mathbb {R}^2\) denote the desired velocity of the leader and the desired position of robot i relative to robot j, respectively. Under this setting, we address the following problem.
Problem 1
Consider the multi-robot system \(\Sigma \). Suppose that the step size s and the desired leader’s velocity \(d_1(t)\) and relative positions \(r_{ij}\) \((i,j=1,2,\ldots ,n)\) are given. Find controllers \(K_1,K_2,\ldots ,K_n\) (i.e., functions \(f_{11},f_{12},f_{13},f_{21},\ldots ,f_{n3}\)) that satisfy
for every initial state \((x_i(0),\theta _i(0))\in \mathbb {R}^2\times (-\pi ,\pi ]\) \((i=1,2,\ldots ,n)\).
For Problem 1, we note the following three points. First, we cannot exactly achieve (3) and (4) due to the constraint of discrete values for the control inputs \(u_{i1}(t)\) and \(u_{i2}(t)\). Hence, our goal is to achieve (3) and (4) approximately. Second, the leader is unaware of its own position in the world coordinate frame, and thus its desired velocity \(d_1(t)\) is given instead of the desired position. Further, we have to design the controller for the leader because achieving (3) is not trivial due to the discrete-valued input constraint. Finally, the followers do not possess any information regarding \(d_1(t)\), which implies that we cannot solve Problem 1 by driving the followers at \(d_1(t)\) while preserving the fixed formation.
3 Leader–follower formation control with discrete-valued inputs
In this section, a solution to Problem 1 is presented.
3.1 Existing controllers achieving fixed formations
Our approach toward Problem 1 involves extending the controllers proposed in [1] that achieve fixed formations to the case of the leader–follower formations. Therefore, we first introduce the existing controllers.
The existing controller \(K_i\) for robot i is shown in Fig. 4. This is composed of the four subcontrollers \(K_{i0}\)–\(K_{i3}\). The subcontroller \(K_{i0}\) is described by
where \(x_i(t)-x_j(t)\) for \(j\in \mathbb {N}_i\) (corresponding to \([x_j(t)-x_i(t)]_{j\in \mathbb {N}_i}\) in (2)) is the input, \(\tilde{u}_i(t)\in \mathbb {R}^2\) is the output, and \(k\in \mathbb {R}_+\) is the controller gain. The subcontroller \(K_{i1}\) is written as
where \(\xi _{i1}(t)\in \mathbb {R}^2\) is the state, \(\theta _i(t)\), \(u_i(t)\), and \(\tilde{u}_i(t)\) are the inputs, \(v_i(t)\in \mathbb {R}^2\) is the output, and \(\text {sat}_{{\bar{v}}}\) denotes the saturation function introduced in Sect. 1. The function \(g:(-\pi ,\pi ]\times \mathbb {R}^3\rightarrow \mathbb {R}^2\) provides the velocity vector in the \((x_{i1},x_{i2})\) plane when robot i is driven by \(u_i(t)\), that is, \(x_i(t+1)-x_i(t)\). The subcontroller \(K_{i2}\) is of the form
where \(v_i(t)=[v_{i1}(t)\ \, v_{i2}(t)]^\top \) and \(\theta _i(t)\) are the inputs, \(w_i(t)\in \mathbb {R}^2\) is the output, and \(\text {arctan}2\) denotes the four-quadrant version of the inverse tangent function. Finally, \(K_{i3}\) is given by
where \(w_i(t)=[w_{i1}(t)\ \, w_{i2}(t)]^\top \) and \(u_i(t)\) are the input and the output, respectively, and \(q:\mathbb {R}\rightarrow \{0,\pm s,\pm 2s,\ldots \}\) denotes the mid-tread uniform quantizer with the step size s. Notably, (8) assumes \(w_{i2}(t)\in (-\pi ,\pi ]\).
The working of the aforementioned controller \(K_i\) is as follows. The subcontroller \(K_{i0}\) is a conventional formation controller and outputs the desired velocities in the \(x_{i1}\) and \(x_{i2}\) directions as \(\tilde{u}_i(t)\). The subcontroller \(K_{i1}\) modifies \(\tilde{u}_i(t)\) into \(v_i(t)\) using \(\xi _{i1}(t)\). It follows from (6) that \(\xi _{i1}(t)=g(\theta _i(t-1),u_i(t-1))-v_i(t-1)\) holds. Moreover, \(g(\theta _i(t),u_i(t))-v_i(t)\) represents the quantization error, i.e., the difference between the resulting velocities of robot i taking discrete values and the original \(v_i(t)\) taking continuous values. Hence, the modification of \(\tilde{u}_i(t)\) based on \(\xi _{i1}(t)\) reflects the quantization error in the desired velocities, which suppresses the adverse impact of the discrete-valued input constraint on the resulting formation. Subsequently, to obtain the desired translational and rotational velocities, \(v_i(t)\) is transformed into \(w_i(t)\) by \(K_{i2}\). Based on \(w_i(t)\) and the discrete-valued input constraint, \(K_{i3}\) determines an appropriate \(u_i(t)\) that achieves the velocities close to those specified by \(w_i(t)\) under the input constraint.
3.2 Proposed controllers
The explanation in the previous section implies that the subcontroller \(K_{i0}\) determines the direction in which robot i should move, and \(K_{i1}\)–\(K_{i3}\) modify the output \(\tilde{u}_i(t)\) of \(K_{i0}\) by considering the dynamics (1) and the discrete-valued input constraint. Therefore, we modify \(K_{i0}\) to achieve the leader–follower formation.
Based on this concept, we update the subcontroller \(K_{i0}\) as
where \(y_i(t)\in \mathbb {R}^2\) (i.e., \(\mu :=2\)), \(\xi _{i0}(t)\in \mathbb {R}^2\) is the state, and \(\kappa \in \mathbb {R}_+\) is the controller gain. For the leader (\(i=1\)), its desired velocity \(d_1(t)\) is directly set as \(\tilde{u}_i(t)\). As a result, the leader moves according to \(d_1(t)\). For the followers (\(i=2,3,\ldots ,n\)), \(\tilde{u}_i(t)\) is given by a PD-like controller because \(y_j(t)=g(\theta _j(t-1),u_j(t-1))\) holds from (9) and \(g(\theta _j(t-1),u_j(t-1))\) is equal to \(x_j(t)-x_j(t-1)\). Unlike (5), the performance for the leader tracking would be improved by using the information on the velocities of the neighboring robots. This subcontroller \(K_{i0}'\) for each follower i is inspired by the controllers developed in [21]. We propose the controllers given by (6)–(9) as a solution to Problem 1.
The performance of the proposed controllers is demonstrated through numerical examples. Consider the multi-robot system \(\Sigma \) with \(n:=5\) and \(s:=0.05\). The desired velocity of the leader is chosen as \(d_1(t):=[0.02\ \ 0.03\sin (0.05t)]^\top \). The desired formation of the robots and the network structure G are shown in Fig. 5, where the robots, their indices, and the edges of the graph G are represented by the circles, the numbers \(1,2,\ldots ,5\), and the arrows, respectively. We employ the controllers \(K_i\) \((i=1,2,\ldots ,5)\) given by (6)–(9) with \({\bar{v}}:=0.15\) and \(\kappa :=0.05\).
For the initial formation in Fig. 6, the snapshots of the resulting formation are shown in Fig. 7, where the red thick line indicates the desired trajectory of the leader specified by \(d_1(t)\). Figure 8 depicts the evolution over time of the control input \(u_{2}(t)\) for robot 2 as an example. It can be observed that the followers track the leader while preserving the desired formation, although the control inputs are restricted to the discrete values. Similarly, the results for \(d_1(t):=[0.01\ \ 0.02]^\top \) and \(d_1(t):=[0.025\ \ -0.02\sin (0.04t)]^\top \) are shown in Figs. 9 and 10, respectively. We see that the leader–follower formations are achieved also for the different velocities of the leader. In addition, Fig. 11 depicts the snapshots of the formation when the existing controllers given by (5)–(8) are used for the followers, where \(d_1(t):=[0.02\ \ 0.03\sin (0.05t)]^\top \), \(k:=0.05\), and the other conditions remain unchanged. The comparison with Fig. 7 indicates that the proposed controllers achieve higher performance in terms of the accuracy of the resulting formation.
3.3 Introducing collision avoidance algorithm
Figure 12 shows the trajectory of each robot for the result in Fig. 7. This and Fig. 7(a) indicate that the collision between robots 4 and 5 occurs at around \(t=10\). The reason for the collision is that each robot observes only those specified by the network structure G. Such collisions pose a challenge when the proposed controllers are applied to real robots.
Thus, we introduce a collision avoidance algorithm based on the potential filed approach [22] to the proposed controllers. In the potential field approach, each robot is steered to a location with a lower value of a potential function using the information on the gradient of the function. By designing the potential function, we can control the behavior of each robot.
Let \(x\in \mathbb {R}^{2n}\) denote the positions of all the robots, i.e., \(x:=[x_1^\top ~x_2^\top ~\cdots ~x_n^\top ]^\top \). Then, based on [22], we consider the potential function
for each robot i, where \(\kappa _\phi \in \mathbb {R}_+\) is a constant and \(\mathbb {N}^r_{i}(x):=\{ j\in \mathbb {V}\setminus \{i\}\, \vert \, x_j\in \mathbb {B}(x_i,r)\}\) for \(r\in \mathbb {R}_+\). The potential function \(\phi \) is given as the sum of the inverse of the distances between robot i and others within the radius r. Hence, by decreasing \(\phi \), the collisions between the robots do not occur. Using \(\phi \), we modify a part of (9) as
where \(i=2,3,\ldots ,n\). By introducing the term on the gradient of \(\phi \), each follower can track the leader while avoiding the collisions with other robots.
Figures 13 and 14 show the results corresponding to Figs. 7 and 12 when using (11) with \(\kappa _\phi :=0.01\) and \(r:=0.3\), respectively. We see that the leader–follower formation is achieved without any collision unlike the case of Figs. 7 and 12.
4 Theoretical analysis
This section presents the theoretical analysis of the feedback system with the proposed controllers. The analysis method employed here is similar to that in our previous study [1]. Specifically, we first discuss if the leader–follower formation is achieved in the case without the quantization of the control inputs, and then examine the impact of the quantization on the resulting formation. In the following, similar to [1], we assume that the saturation of the signal by \(\text {sat}_{{\bar{v}}}\) in (6) does not occur; i.e., the magnitude of each element of the input vector to \(\text {sat}_{{\bar{v}}}\) does not exceed \({\bar{v}}\) for every \(t\in \{0,1,\ldots \}\). This assumption is intended to focus on the impact of the quantization on the resulting formation. To simplify the discussion, we further suppose that the feedback system to be analyzed does not contain the collision avoidance algorithm described in Sect. 3.3.
4.1 Analysis of feedback system without quantization
Let \(A_f\!\in \!\mathbb {R}^{(n-1)\times (n-1)}\) be the adjacency matrix of the graph describing the network structure of the followers, and let \(D_f:=\text {diag}(1/\vert \mathbb {N}_2\vert ,1/\vert \mathbb {N}_3\vert ,\ldots ,1/\vert \mathbb {N}_n\vert )\). Using these notations, we define
Then, the following result is obtained.
Lemma 1
For the feedback system constructed by (1) and (6)–(9), assume that \(d_1(t)\) and \(r_{ij}\) \((i,j=1,2,\ldots ,n)\) are given and there is no quantization of \(u_{i1}(t)\) and \(u_{i2}(t)\) in (8). Assume further that there exists a constant \({\bar{d}}_1\in \mathbb {R}_+\) such that \(\Vert d_1(t)\Vert \le {\bar{d}}_1\) for every \(t\in \{0,1,\ldots \}\). If the following two conditions hold, (3) and
hold for every \((x_i(0),\theta _i(0))\in \mathbb {R}^2\times (-\pi ,\pi ]\) \((i=1,2,\ldots ,n)\).
-
(C1)
On the graph G, there exists a directed path from the vertex corresponding to the leader to the other vertices.
-
(C2)
The gain \(\kappa \) satisfies
$$\begin{aligned} \kappa < \min \{1,\epsilon _1,\epsilon _2,\ldots ,\epsilon _{n-1}\}, \end{aligned}$$(14)where \(\epsilon _i\) \((i\in \mathbb {V}\setminus \{n\})\) is defined as
$$\begin{aligned} \epsilon _i:=\dfrac{2\vert 1-\lambda _i\vert ^2(2(1-\textrm{Re}(\lambda _i))-\vert 1-\lambda _i\vert ^2)}{\vert 1-\lambda _i\vert ^4+4(\textrm{Im}(\lambda _i))^2} \end{aligned}$$(15)and \(\lambda _i\) represents each eigenvalue of \(D_fA_f\).
Proof
Based on the assumption that there is no quantization of \(u_{i1}(t)\) and \(u_{i2}(t)\) in (8), we obtain \(\xi _{i1}(t)\equiv 0_{2\times 1}\) for every \(i\in \mathbb {V}\) because the initial states of the controllers are supposed to be zero and no quantization error occurs. From this fact, (6)–(9), and the assumption of no quantization, we can show that the velocities of robot i in the \(x_{i1}\) and \(x_{i2}\) directions are determined by \(\tilde{u}_i(t)\) in (9). Therefore, the dynamics of the leader is written as
and that of each follower i is written as
Because (16) is independent of \(\theta _i(0)\) \((i=1,2,\ldots ,n)\), (3) holds for every \((x_i(0),\theta _i(0))\in \mathbb {R}^2\times (-\pi ,\pi ]\) \((i=1,2,\ldots ,n)\). Meanwhile, applying \(z_i(t):=x_i(t)+r_{1i}\) to (17) and using \(r_{ij}=r_{1j}-r_{1i}\) yield
We can consider (18) as the consensus algorithm for tracking a time-varying reference state proposed in [21] by regarding \(z_1(t)\) as the reference state. According to [21], the magnitude of each element of the tracking error \(z_i(t)-z_1(t)=x_i(t)-x_1(t)-r_{i1}\) \((i\in \mathbb {V}\setminus \{1\})\) is bounded by the right-hand side of (13) as \(t\rightarrow \infty \) for every \(z_i(0)\in \mathbb {R}^2\) \((i=1,2,\ldots ,n)\) under conditions (C1) and (C2), where \(r_{11}=0_{2\times 1}\) and \(r_{1i}=-r_{i1}\) are used. Combining this result and the definition of the \(\infty \)-norm and using the fact that (18) is independent of \(\theta _i(0)\) \((i=1,2,\ldots ,n)\), we can prove that (13) holds for every \((x_i(0),\theta _i(0))\in \mathbb {R}^2\times (-\pi ,\pi ]\) \((i=1,2,\ldots ,n)\) under (C1) and (C2). This completes the proof. \(\square \)
Lemma 1 shows that under the boundedness of the desired velocity \(d_1(t)\) and conditions (C1) and (C2), the leader’s velocity becomes \(d_1(t)\) and the tracking error of each follower is ultimately bounded if there is no quantization of the control inputs. In this sense, the proposed controllers without the quantization achieve the leader–follower formation. Here, (C1) means that all the followers can share the information on the leader, and (C2) is satisfied by choosing an appropriate gain \(\kappa \).
4.2 Analysis of impact of quantization
Next, we analyze the impact of the quantization of the control inputs on the behavior of the feedback system.
4.2.1 Problem formulation
We use \(x^*(t)\in \mathbb {R}^{2n}\) to denote the group position x(t) for the proposed controllers where \(u_{i1}(t)\) and \(u_{i2}(t)\) in (8) are unquantized. Then, we consider the following problem described with reference to [23].
Problem 2
For the feedback system constructed by (1) and (6)–(9), suppose that the step size s, the desired leader’s velocity \(d_1(t)\) and relative positions \(r_{ij}\) \((i,j=1,2,\ldots ,n)\), and the parameter \({\bar{v}}\) of \(\text {sat}_{{\bar{v}}}\) in (6) are given. Evaluate the performance index
In Problem 2, E represents the difference between the behavior of the original (i.e., quantized) feedback system and that of the unquantized version. The magnitude of E corresponds to that of the quantization effects on the behavior of the feedback system.
4.2.2 Main result
We begin with the following result on the quantization error \(e_i(t):=g(\theta _i(t),u_i(t))-v_i(t)\) \((i\in \mathbb {V})\).
Lemma 2
For the feedback system constructed by (1) and (6)–(9), suppose that s and \({\bar{v}}\) are given. Then,
holds for every \(i\in \mathbb {V}\) and \(t\in \{0,1,\ldots \}\).
Proof
This lemma can be proven in a similar manner to that in [1] because \(\Vert e_i(t)\Vert \) depends only on (1) and (6)–(8) and is unrelated to (9) introduced in this study. \(\square \)
Lemma 2 presents an upper bound of \(\Vert e_i(t)\Vert \) as a function of the system parameters s and \({\bar{v}}\).
From Lemma 2, we obtain the following result.
Theorem 1
For the feedback system constructed by (1) and (6)–(9), suppose that s, \(d_1(t)\), \(r_{ij}\) \((i,j=1,2,\ldots ,n)\), and \({\bar{v}}\) are given. Then,
holds, where
for \(D:=\text {diag}(0,1/\vert \mathbb {N}_2\vert ,1/\vert \mathbb {N}_3\vert ,\ldots ,1/\vert \mathbb {N}_n\vert )\) and the adjacency matrix A and graph Laplacian L of the graph G.
Proof
By a discussion similar to that in the proof of Lemma 1, the dynamics of the feedback system without the quantization of the control inputs can be written using (16) and (17), that is,
where \(\zeta ^*(t):=x^*(t-1)\) and
for \(b:=[0_{1\times 2}\ \, \sum _{j\in \mathbb {N}_2}r_{2j}^\top \ \, \sum _{j\in \mathbb {N}_3}r_{3j}^\top \ \cdots \ \sum _{j\in \mathbb {N}_n}r_{nj}^\top ]^\top \) and \(d(t):=[d_1^\top (t)\ \ 0_{1\times 2(n-1)}]^\top \). Similarly, from (1) and (6)–(9), the dynamics of the original feedback system is described as
where \(\zeta (t)\!:=x(t-1)\), \(\xi (t)\!:=[\xi _{11}^\top (t)~\xi _{21}^\top (t)~\cdots ~\xi _{n1}^\top (t)]^\top \), and
for \(e(t):=[e_1^\top (t)~e_2^\top (t)~\cdots ~e_n^\top (t)]^\top \). Equations (23) and (25) yield
respectively. Using (24), (26), and (27), we can rewrite (29) as
where \(\xi (0)=0_{2n\times 1}\) is used to derive the second equality. From (28), (30), and Lemma 2, we obtain
The right-hand side of (31) is monotonically non-decreasing with respect to \(\tau \in \{0,1,\ldots \}\) and is independent of x(0). This, together with (19), proves the statement. \(\square \)
Theorem 1 presents an upper bound of the performance index E as a solution to Problem 2. If \({F^*}^\ell \) converges as \(\ell \rightarrow \infty \), the upper bound is finite because \(\Vert {F^*}^{\ell +1}-{F^*}^\ell \Vert \) in (21) goes to zero as \(\ell \rightarrow \infty \). Therefore, under the condition that \({F^*}^\ell \) converges, the impact of the quantization of the control inputs can be estimated. In addition, this result and Lemma 1 imply that under the above condition and those in Lemma 1, the behavior difference between the original feedback system and the unquantized version, where the leader–follower formation is achieved, is smaller than or equal to a certain level. In this sense, we can guarantee the stability of the feedback system.
Remark 1
We compare Theorem 1 with the corresponding result in [1] that considered fixed formations. Replacing \({F^*}\) in (21) with \((I_n-kL)\otimes I_2\) yields the result in [1]. This implies that the key matrix in the analysis result becomes more complicated by updating \(K_{i0}\) to \(K_{i0}'\). The difference between the matrices \({F^*}\) and \((I_n-kL)\otimes I_2\) causes the difference in the magnitudes of the quantization effects in the sense of their upper bounds.
4.2.3 Examples
We consider the example that provides the result in Fig. 7 again. In this example, \({\bar{d}}_1\) in Lemma 1 exists, and conditions (C1) and (C2) are satisfied. Moreover, for \({F^*}\) in (22), we can numerically confirm that \({F^*}^\ell \) converges as \(\ell \rightarrow \infty \). Thus, as mentioned previously, Lemma 1 and Theorem 1 guarantee the stability of the feedback system. Next, from (21) and the behavior of the robots shown in Fig. 7, we obtain \(E\le 1.266\) and \(\sup _{\tau \in \{0,1,\ldots ,120\}}\Vert x(\tau )-x^*(\tau )\Vert =0.04011\), respectively. This demonstrates the validity of Theorem 1.
Similar results are obtained in the cases of Figs. 9 and 10. The desired velocities \(d_1(t):=[0.01\ \ 0.02]^\top \) and \(d_1(t):=[0.025\ \ -0.02\sin (0.04t)]^\top \) of the leader satisfy the condition in Lemma 1, and (C1), (C2), and \({F^*}\) do not depend on \(d_1(t)\). Hence, by a discussion similar to the above, the stability of the feedback systems is guaranteed. In addition, the behavior of the robots shown in Figs. 9 and 10 yields \(\sup _{\tau \in \{0,1,\ldots ,70\}}\Vert x(\tau )-x^*(\tau )\Vert =0.04671\) and \(\sup _{\tau \in \{0,1,\ldots ,100\}}\Vert x(\tau )-x^*(\tau )\Vert =0.05229\), respectively. These results support Theorem 1 because (21) remains to be \(E\le 1.266\) due to its independence from \(d_1(t)\).
5 Conclusion
In this study, we discussed the leader–follower formation control of four-legged robots via discrete-valued inputs. By focusing on the structures of existing controllers and modifying the specific parts appropriately, we obtained leader–follower formation controllers using discrete-valued inputs. In addition, we analyzed the resulting feedback system based on a performance index that quantifies the impact of the discrete-valued input constraint on the behavior of the system. The results in this study contribute to achieving moving formations of four-legged robots.
A future direction of this research is to develop better controllers in terms of the performance index considered in this paper. Another direction is to extend our results to a more general setting, e.g., the case where the quantization interval in the rotational direction of the robots is generalized. In addition to these theoretical works, the experimental verification of the proposed controllers using real robots should be addressed in the future.
References
Izumi S, Shinagawa K, Xin X, Yamasaki T (2022) Formation control of four-legged robots using discrete-valued inputs. IEEE Control Syst Lett 6:1088–1093
Bit Trade One: Quad Crawler. [Online]. Available: https://bit-trade-one.co.jp/adcrbt/ Accessed 9 Sept 2022 (in Japanese)
Atique MMU, Sarker MRI, Ahad MAR (2018) Development of an 8DOF quadruped robot and implementation of inverse kinematics using Denavit–Hartenberg convention. Heliyon 4(12):01053
Ren W, Beard RW (2008) Distributed Consensus in Multivehicle Cooperative Control. Springer, London
Mariottini GL, Morbidi F, Prattichizzo D, Valk NV, Michael N, Pappas G, Daniilidis K (2009) Vision-based localization for leader–follower formation control. IEEE Trans Robot 25(6):1431–1438
Consolini L, Morbidi F, Prattichizzo D, Tosques M (2008) Leader–follower formation control of nonholonomic mobile robots with input constraints. Automatica 44(5):1343–1349
Sayyaadi H, Sabet MT (2014) Nonlinear dynamics and control of a set of robots for hunting and coverage missions. Int J Dyn Control 2(4):555–576
Nazari M, Butcher EA (2016) Fuel efficient periodic gain control strategies for spacecraft relative motion in elliptic chief orbits. Int J Dyn Control 4(1):104–122
Homayounzade M (2022) Adaptive robust nonlinear control of spacecraft formation flying: a novel disturbance observer-based control approach. Int J Dyn Control 10(5):1471–1484
Al-Gabalawy M, Hosny NS, Aborisha AS (2021) Model predictive control for a basic adaptive cruise control. Int J Dyn Control 9(3):1132–1143
Han Z, Guo K, Xie L, Lin Z (2019) Integrated relative localization and leader–follower formation control. IEEE Trans Autom Control 64(1):20–34
Lin Z, Ding W, Yan G, Yu C, Giua A (2013) Leader–follower formation via complex Laplacian. Automatica 49(6):1900–1906
Dai S-L, He S, Chen X, Jin X (2020) Adaptive leader–follower formation control of nonholonomic mobile robots with prescribed transient and steady-state performance. IEEE Trans Ind Inform 16(6):3662–3671
Tang Z, Cunha R, Hamel T, Silvestre C (2021) Formation control of a leader–follower structure in three dimensional space using bearing measurements. Automatica 128:109567
Qiu Z, Xie L, Hong Y (2016) Quantized leaderless and leader-following consensus of high-order multi-agent systems with limited data rate. IEEE Trans Autom Control 61(9):2432–2447
Xiong S, Wu Q, Wang Y (2020) Distributed coordination of heterogeneous multi-agent systems with dynamic quantization and \(L_2\)-\(L_\infty \) control. Int J Control Autom Syst 18(10):2468–2481
Huang X, Dong J (2020) Reliable leader-to-follower formation control of multiagent systems under communication quantization and attacks. IEEE Trans Syst Man Cybern Syst 50(1):89–99
Hu J, Sun X, Liu S, He L (2019) Adaptive finite-time formation tracking control for multiple nonholonomic UAV system with uncertainties and quantized input. Int J Adapt Control Signal Process 33(1):114–129
Wang Y, He L, Huang C (2019) Adaptive time-varying formation tracking control of unmanned aerial vehicles with quantized input. ISA Trans 85:76–83
Hu J, Sun X, He L (2020) Formation tracking for nonlinear multi-agent systems with input and output quantization via adaptive output feedback control. J Syst Sci Complex 33(2):401–425
Cao Y, Ren W, Li Y (2009) Distributed discrete-time coordinated tracking with a time-varying reference state and limited communication. Automatica 45(5):1299–1305
Howard A, Matarić MJ, Sukhatme GS (2002) Mobile sensor network deployment using potential fields: a distributed, scalable solution to the area coverage problem. In: Proceedings of the 6th International Symposium on Distributed Autonomous Robotic Systems, pp. 299–308
Minami Y, Azuma S, Sugie T (2007) An optimal dynamic quantizer for feedback control with discrete-valued signal constraints. In: Proceedings of the 46th IEEE Conference on Decision and Control, pp. 2259–2264
Acknowledgements
The first author would like to thank Dr. T. Yamasaki and Mr. T. Yamamoto for valuable discussions.
Funding
This work was supported in part by the Japan Society for the Promotion of Science, Grants-in-Aid for Scientific Research, Japan, under Grant 19K15016.
Author information
Authors and Affiliations
Contributions
Conceptualization was done by SI; methodology was done by SI; formal analysis was done by SI and XX; software was done by SI; writing—original draft was done by SI; writing—review and editing were done by SI and XX.
Corresponding author
Ethics declarations
Conflict of interest
The authors declare that they have no conflict of interest.
Rights and permissions
Open Access This article is licensed under a Creative Commons Attribution 4.0 International License, which permits use, sharing, adaptation, distribution and reproduction in any medium or format, as long as you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons licence, and indicate if changes were made. The images or other third party material in this article are included in the article’s Creative Commons licence, unless indicated otherwise in a credit line to the material. If material is not included in the article’s Creative Commons licence and your intended use is not permitted by statutory regulation or exceeds the permitted use, you will need to obtain permission directly from the copyright holder. To view a copy of this licence, visit http://creativecommons.org/licenses/by/4.0/.
About this article
Cite this article
Izumi, S., Xin, X. Leader–follower formation control of four-legged robots with discrete-valued inputs. Int. J. Dynam. Control 11, 2398–2409 (2023). https://doi.org/10.1007/s40435-023-01120-w
Received:
Revised:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s40435-023-01120-w