Next Article in Journal
Reliability Evaluation of Multi-State Solar Energy Generating System with Inverters Considering Common Cause Failures
Previous Article in Journal
Kidney Tumor Segmentation Based on DWR-SegFormer
Previous Article in Special Issue
A Novel Paradigm for Controlling Navigation and Walking in Biped Robotics
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

A Dynamic Event-Based Recursive State Estimation for Mobile Robot Localization

1
School of Transportation and Civil Engineering, Nantong University, Nantong 226019, China
2
Hai’an Institute of High-Tech Research, Nanjing University, Hai’an 226600, China
*
Authors to whom correspondence should be addressed.
Electronics 2024, 13(16), 3227; https://doi.org/10.3390/electronics13163227
Submission received: 10 July 2024 / Revised: 12 August 2024 / Accepted: 12 August 2024 / Published: 14 August 2024
(This article belongs to the Special Issue Advances in Mobile Robots: Navigation, Motion Planning and Control)

Abstract

:
This paper deals with the recursive state estimation issue for mobile robot localization under a dynamic event-based mechanism. To enhance the utilization of communication resources, a dynamic event-based transmission protocol is utilized to reduce unnecessary measurement transmissions by introducing an auxiliary dynamical variable to adjust threshold parameters. The primary objective of this paper is to develop a dynamic event-based recursive state estimation scheme for the mobile robot localization problem in the presence of the impact of the dynamic event-based mechanism such that an upper bound on the estimation error covariance is firstly guaranteed by using mathematical induction and then is locally minimized by virtue of appropriately choosing the gain parameters. Furthermore, the boundedness analysis of the estimation error is conducted by establishing an evaluation criteria in the mean-squared sense. Finally, an experimental example is conducted to verify the feasibility of the proposed mobile robot localization strategy.

1. Introduction

Over the past few years, mobile robots (MRs) have not only attracted wide research interest from the academic community but also sparked strong development enthusiasm in the industry due to their remarkable practical utility and extensive application prospects in the areas of intelligent inspection, warehouse management and healthcare, etc. [1,2,3]. The swift and efficient implementation of MR Localization (MRL) is a pivotal research issue in the field of MRs, as it serves as the cornerstone for enabling robots to autonomously and precisely complete their assigned tasks within diverse environments. Generally, the process of MRL is fundamentally bifurcated into two key stages: environmental data collection and transmission via sensors and implementing localization by utilizing positioning system, which are highly susceptible to various inherent factors such as inevitable external disturbances, limited communication resources, and instability of the system structure [4,5]. In such a context, it can significantly undermine the decision-making process and execution of an MR, thereby posing a high risk of malfunctioning, particularly in complex and dynamic settings such as crowded warehouses, intricate factory layouts, or busy healthcare facilities. Therefore, it is crucial to develop an efficient strategy that is capable of enhancing the accuracy and robustness of localization in various operating environments for MRs, which has given rise to some initial progress, see, e.g., [6,7,8]. In Ref. [6], a robust decentralized cooperative localization approach has been presented by leveraging a multi-centralized framework and M-estimation technique, effectively addressing communication failures and biased measurements to enhance localization accuracy. A novel distributed finite memory estimation method has been introduced in Ref. [7] for robust multiple-robot localization in wireless sensor networks subject to missing data and errors.
On the other research front, with the rapid development of sensor technology, a series of state estimation strategies have been developed and applied in various applications, especially in signal processing, the internet of things, and industrial automation. Regarding different performance requirements, state estimation algorithms can be categorized into several types, including a conventional Kalman filtering scheme and its variants [9,10], an H filtering scheme [11,12], set-membership filtering [13,14], etc. As a matter of fact, due to many unforeseen disturbances in industrial scenarios, accurately completing the state estimation with the above methods is quite challenging [15,16]. To tackle such a problem, recursive state estimation schemes have been proposed where the estimation error covariance (EEC) is minimized in a certain sense, and accordingly, some elegant work is available [17,18,19]. For example, in Ref. [17], the study focused on the challenging task of designing a distributed recursive state estimation scheme for a class of multi-rate nonlinear systems within the context of sensor networks. In Ref. [19], in the delayed state-saturated system under the effect of the energy harvesting sensors, the joint state and fault estimation problem has been addressed. Unfortunately, when it comes to the issue of MRL, a recursive state estimation scheme tailored to MRL has not been considered yet, mainly due to the complex structure and nonlinear characteristics of MRs, making it difficult to derive the upper bound of the EEC and minimize it in a recursive process. As such, there is a practical demand to establish a recursive state estimation scheme to deal with the MRL problem, which constitutes one of the main motivations behind this paper.
It is notable that in most state estimation/filtering issues, one underlying assumption is made that the communication resources are often unlimited and available. In engineering practice, the energy storage of sensors and the capacity of channels are constrained [20], whereas the continuously transmitting data to the remote estimator may lead to resource wastage and risks of measurement transmission failures. Therefore, a huge amount of communication protocols have been proposed to address the challenge of limited communication resources, where the most prominent one is the event-triggered mechanism (ETM), which transmits measurements only when a predefined triggering condition is satisfied [21,22]. In view of the disparity in the triggering threshold, ETMs can be categorized into static ETMs and dynamic ETMs (DETMs) [23]. Different from the static ETMs with fixed threshold parameters, the DETMs have the ability of dynamically adjusting the threshold parameters via an auxiliary dynamical variable, thereby reducing more unnecessary triggers and further enhancing resource utilization without significantly degrading the system’s performance. To date, some elegant results have been made available on the issue of the state estimation/filtering concerning DETMs [24,25,26]. For instance, the filtering problem based on a dynamic event-triggering mechanism has been tackled in Ref. [24] for the discrete time-varying systems confronted with complex environments. In Ref. [25], an efficient dynamic event-triggered communication protocol has been utilized to deal with the consensus issue for multi-agent systems.
On the basis of the above discussion, there is currently no research on the recursive state estimation scheme for the MRL problem that truly satisfies the practical application needs, not to mention considering a DETM in the localization process of MRs. Therefore, the ultimate goal of this paper is to narrow this gap by developing a dynamic event-based recursive state estimator for MRL. Specifically, this problem remains unexplored and poses additional challenges due to the following identified issues: (1) How to devise a reasonable model that seamlessly integrates DETM into the MRL process. (2) How to exploit an appropriate approach to tackle the impact of DETM on the estimation performance. (3) How to formulate a recursive estimator for the MRL problem based on a DETM. (4) How to conduct the analysis of the estimation performance for the developed dynamic event-based state estimation algorithm. Corresponding to the identified issues, the main contributions of this paper can be highlighted from the four aspects below: (1) a spatial state equation is modeled by capturing the dynamic characteristics of MRs, which is then used to design the integration of the DETM into the realm of MRL; (2) the DETM is employed, for the first time, for the MRL problem to further save communication resources by setting a dynamically adjusted threshold; (3) a dynamic event-based estimator is firstly constructed so that the bounded EEC is minimized by designing the estimator gain parameters; (4) the mean-square boundedness analysis of the estimation error is quantified by establishing an evaluation criteria; and (5) a dynamic event-based estimation algorithm is developed that is suitable for online computation and real-time usage. Finally, a simulation experiment is conducted to verify the validity of the developed estimation strategy.
Notation: The notations employed in this paper are fairly standard. χ 1 and χ T below mean the inverse and the transposition of χ , respectively. F > (respectively, F ) represents that F is a positive definite (positive semi-define) matrix, with F and being symmetric matrices. I n represents the n-dimensional identity matrix. tr { V } represents the trace of the matrix V . E { Q } stands for the mathematical expectation of the stochastic variable Q . W denotes the norm of a matrix W .

2. Problem Formulation

2.1. MR Model and Sensor Measurement Model

Consider an MR model as depicted in Figure 1, and then the continuous-time system describing the motion of MR is determined by [27]:
x ˙ = ν cos φ y ˙ = ν sin φ φ ˙ = ω
where ( x , y ) represents the position coordinates of MR, and φ represents its orientation angle. ν and ω represent the displacement velocity and the angular velocity, respectively.
During the sampling period t, the MR’s displacement and angular velocities that can be accurately measured by an odometer are assumed to be constant. Then, the discrete-time system for the MR can be constructed as
x k + 1 = x k + ν k t cos φ k y k + 1 = y k + ν k t sin φ k φ k + 1 = φ k + ω k t
where ( x k , y k , φ k ) is the position coordinates and orientation angle of MR. ν k and ω k represent the corresponding displacement and angular velocities, respectively.
By setting X k = [ x k y k φ k ] T , ξ k = [ ν k t ω k t ] T and considering the presence of disturbances, the dynamic system model is determined by
X k + 1 = g ( X k , ξ k ) + ϵ k ,
where g ( X k , ξ k ) = X k + [ ν k t cos φ k ν k t sin φ k ω k t ] T . ϵ k denotes Gaussian noise with E { ϵ k } = 0 and covariance R k > 0 .
In Figure 1, the landmark point M ( x M , y M ) is given, and d k represents the distance between MR ( x k , y k ) and the landmark M ( x M , y M ) . Specifically, the distance d k and the azimuth ψ k at k are determined by
d k = ( x M x k ) 2 + ( y M y k ) 2 , ψ k = φ k arctan ( y M y k x M x k ) .
By noting Equation (4), the sensor measurement model of the MR system with measurement noise can be induced as follows:
z k = μ k + ϖ k ,
where μ k = [ d k ψ k ] T denotes the ideal measurement, and ϖ k is Gaussian noise with E { ϖ k } = 0 and covariance Q k > 0 .

2.2. Dynamic Event-Triggering Strategy

In practical communication networks where resource constraint is a common phenomenon, the continuous transmitting of data to the remote estimator may lead to resource wastage. Therefore, a DETM is utilized to reduce such resource consumption. Denote the triggering sequences of the measurement transmission instants by 0 = s 0 s 1 s 2 s l , where the triggering sequences s l satisfy
s l + 1 = m i n { k [ 0 , N ] | k > s l , 1 ϑ η k + τ ϱ k 0 }
where ϱ k z k s l z k , z k s l stands for the transmission at the latest triggering squence. ϑ and τ are known positive scalars. η k represents the internal dynamic variable that is determined by
η k + 1 = γ η k + τ ϱ k
where γ denotes a given scalar, and the internal dynamical variable η k satisfies η 0 0 . It is worth mentioning that the parameters γ and ϑ in the DETM are usually assumed to satisfy γ ϑ > 1 , thereby ensuring η k 0 .
The estimator for MRL with the measurements z ¯ k received by the DETM is constructed as
X ^ k | k 1 = g ( X ^ k 1 | k 1 , ξ k 1 ) X ^ k | k = X ^ k | k 1 + K k ( z k + ϱ k μ ^ k | k 1 )
Here, X ^ k | k 1 and X ^ k | k , respectively, stand for the prediction and the estimate of the state, and K k denotes the estimator gain matrix.
Define the prediction error as e k | k 1 = X k X ^ k | k 1 , and the estimation error as e k | k = X k X ^ k | k . The prediction error covariance and the EEC are denoted by E { e k | k 1 e k | k 1 T } and E { e k | k e k | k T } , respectively. This paper aims to devise an estimator that ensures the upper bound Σ k | k on the EEC, and then the gain matrix K k is recursively parameterized to minimize such an upper bound.

3. Main Results

In this section, based on the measurement transmitted through the DETM, we are going to find a solution for MRL. An upper bound on the EEC is obtained mathematically, and then is minimized through two Riccati-like difference equations. In addition, the lemmas below are introduced to promote the derivation.
Lemma 1.
For two real vectors H and S , we can obtain the following relationship
H S T + S H T o H H T + o 1 S S T ,
where o > 0 is an arbitrary scalar.
Lemma 2
([28]). Given the matrices M , N , H , and S with known appropriate dimensions and S S T I , for a positive symmetric matrix Γ and a given positive scalar α satisfying α 1 I H Γ H T > 0 , we can have the inequality below
( M + N S H ) Γ ( M + N S H ) T M ( Γ 1 α H T H ) 1 M T + α 1 N N T .
Lemma 3
([29]). Define M k ( · ) : R n R n and N k ( · ) : R n R n for any k 0 . Assume that A = A T > 0 , M k ( A ) = M k T ( A ) and N k ( A ) = N k T ( A ) . If the following differences equations
M k ( A ) M k ( B ) , A = A T B = B T , M k ( B ) N k ( B )
and
S k + 1 = M k ( S k ) , H k + 1 = N k ( H k ) , S 0 = H 0 > 0
hold, one has S k H k .
Lemma 4.
For the known positive scalars β i , k ( i = 1 , 2 , 3 ) , if there exists a matrix, Z ¯ k holds
Z ¯ k + 1 Ψ k ( Z ¯ k ) = ( ( 1 + β 1 , k ) ( 1 + β 2 , k ) γ 2 + ( 1 + β 3 , k ) ( 1 + β 1 , k 1 ) ϑ 2 ) Z ¯ k + ( ( 1 + β 1 , k ) ( 1 + β 2 , k 1 ) + ( 1 + β 1 , k 1 ) ( 1 + β 3 , k 1 ) ) τ 2 ,
with the initial value Z ¯ 0 = η 0 2 ; then we can obtain that Z ¯ k is the upper bound of Z k , where Z k E { η k 2 } .
Proof. 
Combining Equation (7) and Lemma 1, one has
ϱ k T ϱ k ( 1 ϑ η k + τ ) 2 1 + β 3 , k ϑ 2 η k 2 + ( 1 + β 3 , k 1 ) ) τ 2 .
As such, it is not difficult to give rise to
Z k + 1 = E { η k + 1 2 } = E { ( γ η k + τ ϱ k ) 2 } ( 1 + β 1 , k ) ( 1 + β 2 , k ) γ 2 E { η k 2 } + ( 1 + β 1 , k ) ( 1 + β 2 , k 1 ) τ 2 + ( 1 + β 1 , k 1 ) E { ϱ k T ϱ k } ( ( 1 + β 1 , k ) ( 1 + β 2 , k ) γ 2 + ( 1 + β 3 , k ) ( 1 + β 1 , k 1 ) ϑ 2 ) Z k + ( ( 1 + β 1 , k ) ( 1 + β 2 , k 1 ) + ( 1 + β 1 , k 1 ) ( 1 + β 3 , k 1 ) ) τ 2 = Ψ k ( Z k ) .
By noting Lemma 3, one has Z k Z ¯ k , which ends the proof of this lemma.    □
In what follows, we need to linearize the nonlinear system Equation (3) by approximating the nonlinear function g ( X k , ξ k ) around X ^ k | k . It is obtained that the linearized form of Equation (3) is as follows:
X k + 1 = g ( X ^ k | k , ξ k ) + Π k ( X k X ^ k | k ) + L k G k H k ( X k X ^ k | k ) + ϵ k ,
where
Π k = g X k | X k = X ^ k | k = g x x k g x y k g x φ k g y x k g y y k g y φ k g φ x k g φ y k g φ φ k | X k = X ^ k | k = 1 0 ν k t sin φ ^ k | k 0 1 ν k t cos φ ^ k | k 0 0 1 ,
and L k denotes a scaling matrix tailored to the considered problem, H k is a matrix with known dimensions, and G k is an unknown matrix with G k G k T I .
Similarly, the measurement Equation (5) can be denoted as
z k = μ ^ k | k 1 + Λ k ( X k X ^ k | k 1 ) + G k Δ k F k ( X k X ^ k | k 1 ) + ϖ k ,
where
Λ k = μ X k | X k = X ^ k | k 1 = μ d x k μ d y k μ d φ k μ ψ x k μ ψ y k μ ψ φ k | X k = X ^ k | k 1 = ( x M x ^ k | k 1 ) d ^ k | k 1 ( y M y ^ k | k 1 ) d ^ k | k 1 0 ( y M y ^ k | k 1 ) d ^ k | k 1 x M x ^ k | k 1 d ^ k | k 1 1
with d ^ k | k 1 = ( x M x ^ k | k 1 ) 2 + ( y M y ^ k | k 1 ) 2 , G k denotes a scaling matrix tailored to the considered problem, F k is a matrix with known dimensions, and Δ k is an unknown matrix with Δ k Δ k T I .
Thus, by noting Equations (8), (11), and (12), the prediction error and the estimation error are determined by
e k | k 1 = X k X ^ k | k 1 = ( Π k 1 + L k 1 G k 1 H k 1 ) e k 1 | k 1 + ϵ k 1
and
e k | k = X k X ^ k | k = X k [ X ^ k | k 1 + K k ( z k + ϱ k μ ^ k | k 1 ) ] = [ I K k ( Λ k + G k Δ k F k ) ] e k | k 1 K k ϖ k K k ϱ k .

3.1. Design of DETM-Based Recursive Estimator

In the following theorem, we have completed the calculation of the prediction error covariance P k | k 1 and EEC P k | k . Meanwhile, the upper bound of the EEC is also derived.
Theorem 1.
Define a k and b k , and α i , k ( i = 1 , 2 ) are given positive scalars. If the symmetric matrices satisfy the following equations
Σ k | k 1 Π k 1 ( Σ k 1 | k 1 1 α 1 , k 1 H k 1 T H k 1 ) 1 Π k 1 T + α 1 , k 1 1 L k 1 L k 1 T + R k 1
and
Σ k | k ( 1 + a k ) ( I K k Λ k ) ( Σ k | k 1 1 α 2 , k F k T F k ) 1 ( I K k Λ k ) T + ( 1 + a k ) α 2 , k 1 K k G k G k T K k T + ( 1 + a k 1 + b k ) K k Ψ ¯ k ( Z ¯ k ) K k T + ( 1 + b k 1 ) K k Q k K k T
with P 0 | 0 Σ 0 | 0 , where
Ψ ¯ k ( Z ¯ k ) = [ ( 1 + β 3 , k ) ϑ 2 Z ¯ k + ( 1 + β 3 , k 1 ) τ 2 ] I ,
and the symmetric positive matrices Σ k | k 1 and Σ k | k satisfy that
α 1 , k 1 1 I H k 1 Σ k 1 | k 1 H k 1 T > 0 , α 2 , k 1 I F k Σ k | k 1 F k T > 0 ,
then we arrive at Σ k | k being an upper bound on P k | k , i.e., P k | k Σ k | k .
Proof. The initial condition is given that P 0 | 0 Σ 0 | 0 , and we assume that P k 1 | k 1 Σ k 1 | k 1 . Based on the above conditions, we seek to establish that P k | k Σ k | k .
By noting Lemma 2, it is derived from Equation (13) that
P k | k 1 = E { e k | k 1 e k | k 1 T } = E ( Π k 1 + L k 1 G k 1 H k 1 ) e k 1 | k 1 e k 1 | k 1 T × ( Π k 1 + L k 1 G k 1 H k 1 ) T + ϵ k 1 ϵ k 1 T = ( Π k 1 + L k 1 G k 1 H k 1 ) P k 1 | k 1 ( Π k 1 + L k 1 G k 1 H k 1 ) T + R k 1 Π k 1 ( P k 1 | k 1 1 α 1 , k 1 H k 1 T H k 1 ) 1 Π k 1 T + α 1 , k 1 1 L k 1 L k 1 T + R k 1 .
Next, based on Lemma 3 and Equation (17), we can obtain that P k | k 1 Σ k | k 1 .
Subsequently, we are prepared to demonstrate that P k | k Σ k | k . Similarly, it can be derived from Equation (15) that
P k | k = E { e k | k e k | k T } = E U 1 U 1 T U 1 U 3 T + U 2 U 2 T + U 2 U 3 T U 3 U 1 T + U 3 U 2 T + U 3 U 3 T ,
where
U 1 = [ I K k ( Λ k + G k Δ k F k ) ] e k | k 1 , U 2 = K k ϖ k , U 3 = K k ϱ k .
In the light of Equation (18), and Lemmas 1 and 2, the EEC can be further calculated so that
P k | k ( 1 + a k ) [ I K k ( Λ k + G k Δ k F k ) ] P k | k 1 [ I K k ( Λ k + G k Δ k F k ) ] T + ( 1 + a k 1 + b k ) K k E { ϱ k ϱ k T } K k T + ( 1 + b k 1 ) K k Q k K k T ( 1 + a k ) ( I K k Λ k ) ( P k | k 1 1 α 2 , k F k T F k ) 1 ( I K k Λ k ) T + ( 1 + a k ) α 2 , k 1 K k G k G k T K k T + ( 1 + a k 1 + b k ) K k E { ϱ k ϱ k T } K k T + ( 1 + b k 1 ) K k Q k K k T .
Then, according to the dynamic triggering condition Equation (6), one has
ϱ k ϱ k T ϱ k T ϱ k I ( 1 ϑ η k + τ ) 2 I ( ( 1 + β 3 , k ) ϑ 2 η k 2 + ( 1 + β 3 , k 1 ) τ 2 ) I = Ψ ¯ k ( Z k ) .
By virtue of Lemma 4, we can arrive at E { ϱ k ϱ k T } Ψ ¯ k ( Z ¯ k ) . Thus, it is easy to derive from Equation (19) that
P k | k ( 1 + a k ) ( I K k Λ k ) ( P k | k 1 1 α 2 , k F k T F k ) 1 ( I K k Λ k ) T + ( 1 + a k ) α 2 , k 1 K k G k G k T K k T + ( 1 + a k 1 + b k ) K k Ψ ¯ k ( Z ¯ k ) K k T + ( 1 + b k 1 ) K k Q k K k T .
Due to P k | k 1 Σ k | k 1 , it yields that
P k | k Σ k | k .
Now, we have completed this proof.    □
In Theorem 1, we have derived the upper bound Σ k | k for the EEC. Subsequently, such an upper bound will be minimized by selecting the desired estimator parameter K k at each iteration.
Theorem 2.
The minimal upper bound of the EEC can be derived by choosing the following estimator parameter K k + 1 below
K k = Ω k k 1 ,
where
Ω k ( 1 + a k ) ( Σ k | k 1 1 α 2 , k F k T F k ) 1 Λ k T , k ( 1 + a k ) Λ k ( Σ k | k 1 1 α 2 , k F k T F k ) 1 Λ k T + ( 1 + a k ) α 2 , k 1 G k G k T + ( 1 + a k 1 + b k ) Ψ ¯ k ( Z ¯ k ) + ( 1 + b k 1 ) Q k .
Furthermore, the minimal upper bound Σ k | k is determined by
Σ k | k = Ω k k 1 Ω k T + ( 1 + a k ) ( Σ k | k 1 1 α 2 , k F k T F k ) 1 .
Proof. It is not difficult to rewrite the upper bound in Equation (16) through the completing-square technique as follows:
Σ k | k = ( 1 + a k ) ( Σ k | k 1 1 α 2 , k F k T F k ) 1 ( 1 + a k ) K k Λ k ( Σ k | k 1 1 α 2 , k F k T F k ) 1 ( 1 + a k ) ( Σ k | k 1 1 α 2 , k F k T F k ) 1 Λ k T K k T + ( 1 + a k ) K k Λ k ( Σ k | k 1 1 α 2 , k F k T F k ) 1 Λ k T K k T + ( 1 + a k ) α 2 , k 1 K k G k G k T K k T + ( 1 + a k 1 + b k ) K k Ψ ¯ k ( Z ¯ k ) K k T + ( 1 + b k 1 ) K k Q k K k T = K k k K k T Ω k K k T K k T Ω k + ( 1 + a k ) ( Σ k | k 1 1 α 2 , k F k T F k ) 1 = ( K k Ω k k 1 ) k ( K k Ω k k 1 ) T Ω k × k 1 Ω k T + ( 1 + a k ) ( Σ k | k 1 1 α 2 , k F k T F k ) 1 .
Accordingly, the minimal upper bound Σ k | k in Equation (25) can be obtained directly by letting the gain K k = Ω k k 1 . The proof is now complete.    □

3.2. Performance Analysis

In this section, we will analyze the boundedness of the estimation error for the designed recursive estimator by giving a sufficient condition in mean-squared sense. To begin with, let us make the following definition.
Definition 1
([30]). For real numbers ς ¯ > 0 , ς ̲ > 0 , υ > 0 and 0 < ι < 1 , the stochastic process ζ k is considered to satisfy
E ζ k 2 ς ¯ ς ̲ E ζ 0 2 ι k + υ ς ¯ 1 ι
for any k 0 .
Theorem 3.
Assume that λ ¯ , λ ̲ , f ¯ , g ¯ 1 , g ¯ 2 , h ¯ , l ¯ , δ ¯ , π ¯ , q ¯ 1 , q ̲ 1 , q ¯ 2 , q ̲ 2 , and ϱ ¯ are positive scalars, if the following inequalities
λ ̲ Λ k λ ¯ , F k f ¯ , G k g ¯ 1 , G k g ¯ 2 , H k h ¯ , L k l ¯ , Δ k δ ¯ , Π k π ¯ , q ̲ 1 R k q ¯ 1 , Q k q ¯ 2 , tr { E { ϱ k T ϱ k } } ϱ ¯ , ρ = ( π ¯ + l ¯ g ¯ 2 h ¯ ) 2 ( 1 + λ ¯ ( λ ¯ + g ¯ 1 δ ¯ f ¯ ) λ ̲ 2 ) 2 < 1 ,
hold, we can obtain that the estimation error is exponentially mean-square bounded.
Proof. Substituting Equation (13) into Equation (14), one has
e k | k = B k C k 1 e k 1 | k 1 + r k
where
A k = Λ k + G k Δ k F k , C k 1 = Π k 1 + L k 1 G k 1 H k 1 , B k = I K k A k , r k = B k ϵ k 1 K k ϖ k K k ϱ k
According to Equations (23) and (24), we have
K k = ( 1 + a k ) ( Σ k | k 1 1 α 2 , k F k T F k ) 1 Λ k T k 1 < ( 1 + a k ) ( Σ k | k 1 1 α 2 , k F k T F k ) 1 Λ k T [ ( 1 + a k ) Λ k ( Σ k | k 1 1 α 2 , k F k T F k ) 1 Λ k T ] 1 λ ¯ λ ̲ 2 k ¯ .
Along the similar line, we can also confirm that
A k = Λ k + G k Δ k F k λ ¯ + g ¯ 1 δ ¯ f ¯ a ¯ , B k = I K k A k 1 + λ ¯ a ¯ λ ̲ 2 b ¯ , C k 1 = Π k 1 + L k 1 G k 1 H k 1 π ¯ + l ¯ g ¯ 2 h ¯ c ¯ .
Then, based on Lemma 1 and Equation (29), one has
E { r k T r k } ( 1 + σ 1 ) E { ϵ k 1 T B k T B k ϵ k 1 } + ( 1 + σ 2 ) E { ϖ k T K k T K k ϖ k } + ( 1 + σ 1 1 + σ 2 1 ) E { ϱ k 1 T K k T K k ϱ k 1 } ( 1 + σ 1 ) q ¯ 1 b ¯ 2 + ( 1 + σ 2 ) q ¯ 2 k ¯ 2 + ( 1 + σ 1 1 + σ 2 1 ) ϱ ¯ k ¯ 2 r ¯ ,
where σ i ( i = 1 , 2 ) are positive scalars.
Subsequently, the iterative matrix equation with respect to Φ k is determined by
Φ k = B k C k 1 Φ k 1 C k 1 T B k T + R k 1 + ε I ,
where Φ 0 = R 0 + ε I with a scalar ε. Then, by noting Equation (29), it is sufficient to observe that
Φ k = B k 2 C k 1 2 Φ k 1 + R k 1 + π I ρ Φ k 1 + q ¯ 1 + ε
where ρ has been defined in Equation (28). Furthermore, the inequality can be obtained directly as follows:
Φ k ρ k Φ 0 + ( q ¯ 1 + ε ) i = 0 k 1 ρ i < Φ 0 + ( q ¯ 1 + ε ) i = 0 ρ i = Φ 0 + q ¯ 1 + ε 1 ρ .
On the other hand, it can be easily observed that
Φ k ε I .
Combining Equation (35) and Equation (36), we can obtain that ϕ ̲ I Φ k ϕ ¯ I for any k 0 where ϕ ¯ and ϕ ̲ are positive scalars.
Define V k ( e k | k ) = e k | k T Φ k 1 e k | k . With Lemma 1 and Equation (29) we have
E { V k ( e k | k ) | e k 1 | k 1 } ( 1 + κ ) V k 1 ( e k 1 | k 1 ) = E [ B k C k 1 e k 1 | k 1 + r k ] T Φ k 1 [ B k C k 1 e k 1 | k 1 + r k ] ( 1 + κ ) e k 1 | k 1 T Φ k 1 1 e k 1 | k 1 ( 1 + κ ) E { e k 1 | k 1 T [ C k 1 T B k T Φ k 1 B k C k 1 Φ k 1 1 ] e k 1 | k 1 } + ( 1 + κ 1 ) E { r k T Φ k 1 1 r k }
where κ is a positive scalar.
Recalling the definition of matrix Λ k + 1 , one has
C k 1 T B k T Φ k 1 B k C k 1 Φ k 1 1 = C k 1 T B k T ( B k C k 1 Φ k 1 C k 1 T B k T + R k 1 + ε I ) 1 B k C k 1 Φ k 1 1 = [ Φ k 1 + Φ k 1 C k 1 T B k T ( R k 1 + ε I ) 1 B k C k 1 Φ k 1 ] 1 = [ I + C k 1 T B k T ( R k 1 + ε I ) 1 B k C k 1 Φ k 1 ] 1 Φ k 1 1 ( 1 + c ¯ 2 b ¯ 2 ϕ ¯ q ̲ 1 + ε ) 1 Φ k 1 .
Let θ = ( 1 + κ 1 ) r ¯ 2 ϕ ̲ . By substituting Equation (38) into Equation (37), it yields that
E { V k ( e k | k ) | e k 1 | k 1 } ( 1 + φ ) V k 1 ( e k 1 | k 1 ) ( 1 + κ ) ( 1 + c ¯ 2 b ¯ 2 ϕ ¯ q ̲ 1 + ε ) 1 V k ( e k | k ) + θ .
Furthermore, based on Equation (39), we can obtain that
E { V k ( e k | k ) | e k 1 | k 1 } ζ V k 1 ( e k 1 | k 1 ) + θ ,
where ζ = ( 1 + κ ) [ 1 ( 1 + c ¯ 2 b ¯ 2 ϕ ¯ q ̲ 1 + ε ) 1 ] . It is obvious that ζ ( 0 , 1 ) for some κ > 0 , and one has
E { e k | k 2 } ϕ ¯ ϕ ̲ E { e 0 | 0 2 } ζ k + κ ϕ ¯ i = 0 k 1 ζ i ϕ ¯ ϕ ̲ E { e 0 | 0 2 } ζ k + κ ϕ ¯ i = 0 ζ i ϕ ¯ ϕ ̲ E { e 0 | 0 2 } ζ k + κ ϕ ¯ 1 ζ .
It is direct that the estimation error e k | k is exponentially bounded in a mean-squared sense, which ends this proof.    □
Remark 1.
Until now, the problem of the dynamic event-based recursive state estimation has been addressed in MRL in the presence of a DETM. According to the received measurements under a DETM, a dynamic event-based estimator has been designed, where an upper bound on the EEC is guaranteed and, subsequently, such an upper bound is minimized in light of the appropriate choice of the estimator gain parameter. It is noteworthy that the innovative dynamic event-triggered estimation methodology demonstrates commendable performance, even under extreme conditions that encompass a DETM and multiple noise, showcasing its robustness and adaptability. It is evident that the performance of the designed dynamic event-based recursive state estimation scheme is influenced by a diverse range of three pivotal factors: (1) the complex structure and nonlinear characteristics of an MRL system; (2) the presence of process and measurement noises; and (3) the impact of a DETM. In the pursuit of realizing the dynamic event-based recursive state estimation scheme, all three of these fundamental factors have been meticulously considered and comprehensively integrated, thereby guaranteeing a robust and reliable estimation performance.
Remark 2.
Due to the influence of the complex structure and nonlinear characteristics of an MRL system, coupled with the process and measurement noises, as well as the impact of a DETM, it is very difficult to compute the actual EECs for the MR state. Fortunately, there exists an alternative way to solve such a problem by deriving the upper bound on EECs, which is a viable solution to design the desire estimator. In comparison with the results of the existing literature, the main merits of the designed dynamic event-based recursive state estimation scheme are highlighted as: (1) a spatial state equation is formulated by abstracting the dynamic behaviors of MRs, serving as the foundation for integrating a DETM into the framework of MRL; (2) for the first time, a DETM is introduced to the MRL problem, leveraging a dynamically adjustable threshold to further optimize communication resource utilization; (3) a pioneering dynamic event-triggered estimator is devised, where the bounded EEC is minimized through strategic design of the estimator gain parameters; (4) an evaluation criterion is established to quantify the mean-square boundedness of the estimation error, providing a rigorous analysis of the estimator’s performance; and (5) a dynamic event-based estimation algorithm is developed, tailored for online computations and real-time applications, ensuring efficient and timely estimation. Based on the above discussion, the developed dynamic event-based recursive state estimation scheme is outlined in Algorithm 1.
Algorithm 1 Dynamic Event-Based Recursive State Estimation for MRL
1:
Set relevant parameters of MRL system. Set the positive scalar a k , b k , α 1 , k , α 2 , k and initial values X ^ 0 = X 0 , Σ 0 | 0 = P 0 | 0 , k = 0 , T = 100 ;
2:
Calculate the predicted state X ^ k | k 1 according to (8);
3:
Obtain the prediction error e k | k 1 based on (13);
4:
Calculate the upper bound of the prediction error covariance Σ k | k 1 via (15);
5:
Compute the desire estimator gain K s via (23);
6:
Calculate the estimated state X ^ k | k according to (8);
7:
Obtain the estimation error e k | k based on (14);
8:
Calculate the upper bound of the estimation error covariance Σ k | k via (16);
9:
If k T , set k = k + 1 and return to step 2, otherwise, continue to step 10;
10:
Stop.

4. Experimental Example

In this section, we endeavor to demonstrate the feasibility of the developed estimation scheme by conducting an experimental example. The parameters for the MRL problem with the impact of a DETM are listed as follows:
L k = 0.01 0.01 0.01 T ,   G k = 0.01 0.01 T H k = 1 1 1 ,   F k = 1 1 1 R k = 0.02 I ,   Q k = 0.01 I .
Consider the MR system. We set the odometer time interval to t = 0.8 s, the linear velocity to ν k = 0.8 , and the angular velocity to ω k = π 40 . The landmark M is positioned at M ( x M = 0 m , y M = 0 m). We chose the dynamic triggering thresholds and conditions as τ = 0.1 , γ = 0.4 , and ϑ = 5 . The initial state of the MR is selected as X 0 = 0.1 0.3 0.2 T . In addition, the positive scalars are set as a k = 0.2 , b k = 0.3 , α 1 , k = 50 , α 2 , k = 330 , and β i , k = 1 ( i = 1 , 2 , 3 ) .
According to the above parameters, the simulation results are presented in Figure 2, Figure 3, Figure 4 and Figure 5. In Figure 2, the solid blue line stands for the actual trajectory of the MR and the red dashed line stands for its estimate. The actual orientation angle of the MR and its estimate are plotted in Figure 3, where the solid blue line stands for the actual orientation angle and the red dashed line stands for its estimate. It is obvious that our developed algorithm can accurately estimate the trajectory and orientation angle of the MR, thereby achieving the efficient localization of the MR. Figure 4 presents the logarithm of the upper bound Σ k | k and the logarithm of the mean square error (MSE) for the estimated state of the MR defined by
M S E k 1 300 m = 1 300 ( X k X ^ k | k ) ( X k X ^ k | k ) T
It is notable that the logarithm of the MSE is consistently below the logarithm of the upper bound, validating our theoretical findings. Additionally, the dynamic event-based release instants and release interval are shown in Figure 5, where we can easily observe that the triggers are reduced to avoid unnecessary transmission, and the estimation performance is not significantly affected. By noting the above simulation results, we can confirm that the proposed estimation strategy is an effective solution to address the MRL problem under a DETM.

5. Conclusions

In this paper, we have discussed the dynamic event-based recursive state estimation issue for MRL subject to a DETM. A dynamic event-triggered transmission strategy is introduced to improve the utilization of communication resources, thereby addressing the adverse effects of insufficient sensor energy storage and bandwidth limitations. With the aid of the mathematical induction method and stochastic analysis techniques, we have developed a desired estimator framework for solving the MRL problem in the presence of the influence of a DETM. The upper bound of the EEC has been derived, and then such an upper bound is minimized by parameterizing the estimator gain at each iteration. Moreover, the mean-square boundedness analysis of the estimation error is given with an evaluation criteria. Finally, we have conducted an experimental example to test the feasibility of our proposed state estimation strategy. In future research endeavors, we will delve deeper into the expansive applications of estimation algorithms under various complex scenarios, such as sensor saturation, cyber-attacks, and channel fading, etc. Furthermore, we will be committed to extending the 2D robot model-based estimation algorithm presented herein, seamlessly transitioning it into complex 3D environments, thereby catering to the pressing demands of practical applications. This extension will not only enrich our theoretical understanding but also enhance the practicality and applicability of the algorithms in real-world settings.

Author Contributions

Conceptualization, L.Z., C.H. and Z.S.; methodology, L.Z., R.G. and C.H.; software, L.Z. and C.H.; validation, L.Z., R.G., C.H., Q.S. and Z.S.; formal analysis, L.Z. and C.H.; investigation, L.Z. and C.H.; writing—original draft preparation, L.Z. and C.H.; writing—review and editing, L.Z., R.G., C.H., Q.S. and Z.S. All authors have read and agreed to the published version of the manuscript.

Funding

This work was supported in part by the National Natural Science Foundation of China under Grants 62176131 and 62001254, the 333 Talent Technology Research Project of Jiangsu under Grant 2022021, the Natural Science Foundation of the Higher Education Institutions of Jiangsu Province under Grant 22KJB510040, the Natural Science Foundation of Nantong under Grant JC2023074, and the Basic Science Research Program of Nantong City under Grant JC12022028.

Data Availability Statement

No new data were created or analyzed in this study. Data sharing is not applicable to this article.

Conflicts of Interest

The authors declare no conflicts of interest.

References

  1. Adriaensen, A.; Pintelon, L.; Costantino, F.; Gravio, G.D.; Patriarca, R. Systems-theoretic interdependence analysis in robot-assisted warehouse management. Saf. Sci. 2023, 168, 106294. [Google Scholar] [CrossRef]
  2. Li, J.; Sun, J.; Chen, G. A multi-switching tracking control scheme for autonomous mobile robot in unknown obstacle environments. Electronics 2020, 9, 42. [Google Scholar] [CrossRef]
  3. Mac, T.T.; Pham, A.Q.; Nguyen, X.T. The development of fleet management system for mobile robots delivering medicine in healthcare environments. ACTA Polytech. Hung. 2024, 21, 57–72. [Google Scholar] [CrossRef]
  4. Li, H.; Savkin, A.V. An algorithm for safe navigation of mobile robots by a sensor network in dynamic cluttered industrial environments. Robot. Comput. Integr. Manuf. 2018, 54, 65–82. [Google Scholar] [CrossRef]
  5. Lu, Y.; Shen, B.; Shen, Y.; Suo, J. Measurement outlier-resistant mobile robot localization. Int. J. Control. Autom. Syst. 2023, 21, 271–280. [Google Scholar] [CrossRef]
  6. He, R.; Shan, Y.; Huang, K. Robust cooperative localization with failed communication and biased measurements. IEEE Robot. Autom. Lett. 2024, 9, 2997–3004. [Google Scholar] [CrossRef]
  7. Kim, Y.J.; Kang, H.H.; Lee, S.S.; Pak, J.M.; Ahn, C.K. Distributed finite memory estimation from relative measurements for multiple-robot localization in wireless sensor networks. IEEE Access 2022, 10, 5980–5989. [Google Scholar] [CrossRef]
  8. Lu, Y.; Shen, B.; Shen, Y. Recursive filtering for mobile robot localization under an energy harvesting sensor. Asian J. Control 2022, 24, 2035–2048. [Google Scholar] [CrossRef]
  9. Liu, H.; Hu, F.; Su, J.; Wei, X.; Qin, R. Comparisons on kalman-filter-based dynamic state estimation algorithms of power Systems. IEEE Access 2020, 8, 51035–51043. [Google Scholar] [CrossRef]
  10. Musunuri, Y.R.; Kwon, O.-S. State estimation using a randomized unscented kalman filter for 3D skeleton posture. Electronics 2021, 10, 971. [Google Scholar] [CrossRef]
  11. Ju, Y.; Liu, Y.; He, X.; Zhang, B. Finite-horizon H filtering and fault isolation for a class of time-varying systems with sensor saturation. Int. J. Syst. Sci. 2021, 52, 321–333. [Google Scholar] [CrossRef]
  12. Shen, B.; Ding, S.X.; Wang, Z. Finite-horizon H fault estimation for uncertain linear discrete time-varying systems with known inputs. IEEE Trans. Circuits Syst. II Express Briefs 2013, 60, 902–906. [Google Scholar] [CrossRef]
  13. Ding, D.; Wang, Z.; Han, Q.-L. A set-membership approach to event-triggered filtering for general nonlinear systems over sensor networks. IEEE Trans. Autom. Control 2020, 65, 1792–1799. [Google Scholar] [CrossRef]
  14. Li, G.; Wang, Z.; Bai, X.; Zhao, Z.; Dong, H. Event-triggered set-membership filtering for active power distribution systems under fading channels: A zonotope-based approach. IEEE Trans. Autom. Sci. Eng. 2024, 211, 1–13. [Google Scholar] [CrossRef]
  15. Liu, Y.; Wang, Z.; Lin, H.; Ma, L.; Lu, G. Encoding-decoding-based fusion estimation with filter-and-forward relays and stochastic measurement delays. Inf. Fusion 2023, 100, 101963. [Google Scholar] [CrossRef]
  16. Liu, Y.; Wang, Z.; Zou, L.; Zhou, D.; Chen, W.H. Joint state and fault estimation of complex networks under measurement saturations and stochastic nonlinearities. IEEE Trans. Signal Inf. Process. Over Netw. 2022, 8, 173–186. [Google Scholar] [CrossRef]
  17. Shen, Y.; Wang, Z.; Dong, H.; Lu, G.; Alsaadi, F.E. Distributed recursive state estimation for a class of multi-rate nonlinear systems over wireless sensor networks under flexray protocols. IEEE Trans. Netw. Sci. Eng. 2023, 10, 1551–1563. [Google Scholar] [CrossRef]
  18. Wang, F.; Wang, Z.; Liang, J.; Ge, Q.; Ding, S.X. Recursive filtering for two-dimensional systems with amplify-and-forward relays: Handling degraded measurements and dynamic biases. Inf. Fusion 2024, 108, 102368. [Google Scholar] [CrossRef]
  19. Zhu, L.; Huang, C.; Shi, Q.; Gao, R.; Ping, P. A joint state and fault estimation scheme for state-saturated system with energy harvesting sensors. Sensors 2024, 24, 1967. [Google Scholar] [CrossRef]
  20. Wu, P.; Jiang, L.; Wang, L.; Xu, J.; Wang, X. Event-triggered state estimation for wireless sensor network systems with packet losses and correlated noises. IEEE Access 2020, 8, 216762–216771. [Google Scholar] [CrossRef]
  21. Huang, C.; Coskun, S.; Zhang, X.; Mei, P. State and fault estimation for nonlinear systems subject to censored measurements: A dynamic event-triggered case. Int. J. Robust Nonlinear Control 2022, 32, 4946–4965. [Google Scholar] [CrossRef]
  22. Yin, X.; Liu, J. Event-triggered state estimation of linear systems using moving horizon estimation. IEEE Trans. Control Syst. Technol. 2021, 29, 901–909. [Google Scholar] [CrossRef]
  23. Shen, Y.; Wang, Z.; Dong, H.; Alsaadi, F.E.; Liu, H. Dynamic event-based recursive filtering for multiratesystems with integral measurements over sensor networks. Int. J. Robust Nonlinear Control 2021, 32, 1374–1392. [Google Scholar] [CrossRef]
  24. Huang, C.; Shen, B.; Chen, H.; Shu, H. A dynamically event-triggered approach to recursive filtering with censored measurements and parameter uncertainties. J. Frankl. Inst. 2019, 356, 8870–8889. [Google Scholar] [CrossRef]
  25. Hu, W.; Yang, C.; Huang, T.; Gui, W. A distributed dynamic event-triggered control approach to consensus of linear multiagent systems with directed networks. IEEE Trans. Cybern. 2020, 50, 869–874. [Google Scholar] [CrossRef]
  26. Liu, Y.; Shen, B.; Shu, H. Finite-time resilient H state estimation for discrete-time delayed neural networks under dynamic event-triggered mechanism. Neural Netw. 2020, 121, 356–365. [Google Scholar] [CrossRef] [PubMed]
  27. Yang, F.; Wang, Z.; Hung, Y. Robust kalman filtering for discrete time-varying uncertain systems with multiplicative noises. IEEE Trans. Autom. Control 2002, 47, 1179–1183. [Google Scholar] [CrossRef]
  28. Hu, J.; Wang, Z.; Gao, H. Stergioulas, Extended kalman filtering with stochastic nonlinearities and multiple missing measurements. Automatica 2012, 48, 2007–2015. [Google Scholar] [CrossRef]
  29. Mao, J.; Ding, D.; Song, Y.; Liu, Y.; Alsaadi, F.E. Event-based recursive filtering for time-delayed stochastic nonlinear systems with missing measurements. Signal Process. 2017, 134, 158–165. [Google Scholar] [CrossRef]
  30. Reif, K.; Gunther, S.; Yaz, E.; Unbehauen, R. Stochastic stability of the discrete-time extended Kalman filter. IEEE Trans. Autom. Control 1999, 44, 714–728. [Google Scholar] [CrossRef]
Figure 1. The MR system and its absolute measurement model.
Figure 1. The MR system and its absolute measurement model.
Electronics 13 03227 g001
Figure 2. The actual trajectory of MR and its estimate.
Figure 2. The actual trajectory of MR and its estimate.
Electronics 13 03227 g002
Figure 3. The actual orientation angle of MR and its estimate.
Figure 3. The actual orientation angle of MR and its estimate.
Electronics 13 03227 g003
Figure 4. The M S E k and its corresponding upper bound.
Figure 4. The M S E k and its corresponding upper bound.
Electronics 13 03227 g004
Figure 5. The dynamic event-based release instants and release interval.
Figure 5. The dynamic event-based release instants and release interval.
Electronics 13 03227 g005
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Zhu, L.; Gao, R.; Huang, C.; Shi, Q.; Shi, Z. A Dynamic Event-Based Recursive State Estimation for Mobile Robot Localization. Electronics 2024, 13, 3227. https://doi.org/10.3390/electronics13163227

AMA Style

Zhu L, Gao R, Huang C, Shi Q, Shi Z. A Dynamic Event-Based Recursive State Estimation for Mobile Robot Localization. Electronics. 2024; 13(16):3227. https://doi.org/10.3390/electronics13163227

Chicago/Turabian Style

Zhu, Li, Ruifeng Gao, Cong Huang, Quan Shi, and Zhenquan Shi. 2024. "A Dynamic Event-Based Recursive State Estimation for Mobile Robot Localization" Electronics 13, no. 16: 3227. https://doi.org/10.3390/electronics13163227

APA Style

Zhu, L., Gao, R., Huang, C., Shi, Q., & Shi, Z. (2024). A Dynamic Event-Based Recursive State Estimation for Mobile Robot Localization. Electronics, 13(16), 3227. https://doi.org/10.3390/electronics13163227

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop