The hybrid Cramér-Rao lower bound for simultaneous self-localization and room geometry estimation

This paper addresses the problem of tracking a moving source, e.g., a robot, equipped with both receivers and a source, that is tracking its own location and simultaneously estimating the locations of multiple plane reflectors. We assume a noisy knowledge of the robot’s movement. We formulate this problem, which is also known as simultaneous localization and mapping (SLAM), as a hybrid estimation problem. We derive the extended Kalman filter (EKF) for both tracking the robot’s own location and estimating the room geometry. Since the EKF employs linearization at every step, we incorporate a regulated kinematic model, which facilitates a successful tracking. In addition, we consider the echo-labeling problem as solved and beyond the scope of this paper. We then develop the hybrid Cramér-Rao lower bound on the estimation accuracy of both the localization and mapping parameters. The algorithm is evaluated with respect to the bound via simulations, which shows that the EKF approaches the hybrid Cramér-Rao bound (CRB) (HCRB) as the number of observation increases. This result implies that for the examples tested in simulation, the HCRB is an asymptotically tight bound and that the EKF is an optimal estimator. Whether this property is true in general remains an open question.


Methods
In this paper, we address the problem of self-localizing a source and, simultaneously, inferring the room geometry using a single microphone and a single receiver that are mounted on a moving platform, e.g., a robot. The robot moves around the room according to given movement commands. The estimation is based on noisy distance measurements, corresponding to the first-order echoes, taken at finite set of points along the trajectory. While the movement commands are known, the overall robot trajectory is unknown. This follows from the fact that room geometry is unknown (and therefore, the robot position with respect to the room). In addition, we assume that the robot movement inaccurate w.r.t. the known movement commands. This can occur due to imperfect execution of the robot commands. In general, if nothing is known about the trajectory, this problem is not identifiable for some important classes of room geometries, i.e., parallelogram room-geometry cannot be uniquely determined from the distances between walls and trajectory points (cf. [21,22], and for a comprehensive analysis, see [23]). Nevertheless, the robot movement commands provide partial information about the robot trajectory. We use these movement commands, as well as the distance measurements from each wall, to simultaneously map the room and localize the robot with respect to it. In contrast to particle filtering, we adopt a more analytic, computationally efficient approach, the EKF, which simultaneously tracks the robot moment and estimates the room geometry. We formulate the problem as a hybrid estimation task that includes both random and deterministic unknown parameters. This combines both the classic and the Bayesian estimation philosophies, an approach that is very suitable for the problem at hand in which the room's features are considered static and deterministic, while the robot movement as a random state-space process. To apply the Bayesian EKF approach to our hybrid trackingmapping estimation problem, we carefully incorporate randomness into the deterministic room parameters (cf. Section 4).
Moreover, we derive the HCRB, which is an important tool in estimation theory [24][25][26][27][28][29], for the SLAM problem at hand. We provide a recursive expression for the HCRB (see [30] for an overview of recursive CRB-type bounds) which constitutes, at each time instance, a lower bound on the estimation error of the current location and of the room geometry. The advantage of the HCRB is that it is valid for both random and deterministic parameters. A related bound, the Bayesian CRB (BCRB), was derived for a different SLAM problem in [21]. While the BCRB is a valid bound on the random parameters 1 (e.g., receiver location), it is generally not useful with respect to the deterministic parameters in hybrid setups. To apply the BCRB, one must transform the hybrid estimation problem into a pure Bayesian one. This can be done by incorporating some prior distribution to the deterministic parameters, which makes the BCRB susceptible to mismodelling. It is also possible to treat the deterministic parameters as random with zero variance. However, this will violate the BCRB regularity conditions [30]. A different approach would be to discard the prior distribution on the random parameters, thus transforming the problem into a pure classic one, i.e., an estimation problem where all unknown parameters are deterministic unknown. The drawback is that by discarding the prior distribution, one loses the useful information that is embedded in the prior. Moreover, it may render the estimation problem ill-posed (see, e.g., [24]). In this paper, we consider the HCRB since it is more suitable for hybrid estimation problems (see the discussion about the HCRB and other CRB-type bounds in [25], Sect. I-A and Sect. III).
Finally, we evaluate the performance of the proposed algorithm by simulation results examination and by comparing them with the obtained HCRB. We demonstrate a very good match between the Monte-Carlo simulation and the analytical bound, i.e., we show in simulation that EKF approaches the HCRB.
Notation: Boldface lowercase letters denote vectors. We use boldface uppercase letters, e.g., F, C, J, to denote matrices. All vectors are column vectors and (·) denotes the transpose operation. Let g(x) be scalar function of a vector x, then, ∂g(x)/∂x denotes the gradient operation which is organized as a row vector. In the case where g(x) is a vector, ∂g(x)/∂x is the Jacobian matrix of g(x). Let A be a matrix, then, [ A] ij denotes its i, jth entry. The operator spectral norm operation is denoted by · . Let A, B ∈ R n×m , 1 The BCRB, unlike its classic counterpart the CRB, is in general, not an asymptotically tight bound.

Problem formulation
Consider a single omni-directional acoustic source and a microphone, both mounted on a robot at the same point on the x-y plane, but at different heights, i.e., with different zcoordinates. A fully-exciting signal that simplifies the subsequent correlation operation would be better than a speech signal for echo-labeling. The robot moves in a four-wall, closed-room according to a series of movement commands. In this work, we consider 2D environments. An extension to 3D environments is possible, and it involves a characterization of the third dimension. Such an extension can be made by adding characterization equations for additional walls.
Each command instructs the robot to take a single step of a given size and an orientation angle that indicate the direction and length of the movement as depicted in Fig. 1 and further discussed in the sequel. In each step, the robot takes a measurement (a full description is given in Section 3.2) and simultaneously estimates its location and the room geometry. The robot's location is denoted by where x k and y k denote the x-coordinate and the y-coordinate, respectively, at step k. The coordinate system is determined by the robot's first step, i.e., the positive direction of the x-axis coincides with the first step. In this paper, each time instant corresponds to a Fig. 1 Room geometry and robot location at time instant k = 1, 2, 3. Since the source and microphone are co-located in the x-y plane, it is impossible to discriminate between rotation and shifted versions of the room. To solve this, we set the initial robot location as the origin of the coordinate system (0, 0), while the first robot step defines the orientation of the coordinate system. The robot moves at a constant step size μ and an orientation angle φ k for each k step; thus, we use the terms time-instant k and step k, interchangeably. The room shape is determined by the parameter vector where (α i , b i ) represent the angle and offset of the ith wall, as depicted in Fig. 2.

The robot kinematic model
We assume that the robot travels according to the following linear model where k is a time index, F is the state-transition matrix, given by and The latter denotes the robot's movement command, where μ k is the step size and φ k is the orientation angle with respect to the positive edge of the horizontal axis, i.e., the angle of the robot first step is set as the zero-angle with respect to the x-axis of the coordinate system. The robot movement is depicted in Fig. 1. The noise w k is zero-mean Gaussian signal with covariance matrix C w = σ 2 w I 2×2 , which expresses inaccuracies in the execution of the robot's movement commands. As a result, the exact location of the robot is an unknown parameter, to be estimated as part of the estimation problem at hand.
Few comments are in place regarding the matrix F. If it had not been for mathematical regularity conditions, the robot location would have better been characterized by In words, the location at time k + 1 would have been determined by the previous location and by the step taken at time k. This, however, induces an unstable kinematic model, where the noise variance is accumulated and diverges to infinity as k increases. While such models are generally tractable using the Kalman filter [31,32], it may be problematic for the EKF [33] due to its embedded linearization. If the robot movement is not regulated, the linear approximation may be too crude and induce an unstable kinematic model that diverges the filter. Therefore, we incorporate the matrix F, whose sole purpose is to regulate the robot movement by enforcing stability on the model. It can be shown that the model is stable for ρ < 1. However, to make this model realistic, ρ should be close to "1" and accordingly, F to be close to the identity matrix. We conclude with defining the evolution of the unknown deterministic parameter θ . Since the room features (wall angles and offsets) are constant, we use the following static propagation model:

Measurement model
The observation at each time instant, k, is a vector z k = z 1,k · · · z 4,k T which measures the distance between the robot and each of the four walls, as shown in Fig. 2. It can be verified by straightforward geometrical considerations that the distance is related to the robot's location and to the room's features by the following nonlinear equation: Note that z i,k ∀i ∈ 1, . . . , 4 is an estimate of the distance between the robot and wall i at time k, as we explain in the sequel. Moreover, h (x k , θ ) is a nonlinear function that expresses the true distance of the robot from each wall in terms of the robot true coordinates. The vector v k is a white Gaussian noise with covariance matrix C v = σ 2 v I 4×4 , which depicts the measurement error induced by an imperfect distance estimation. The Gaussian assumption is reasonable in cases where the measurement error is small enough compared to the actual distance [10].

Definition 1
The SLAM problem, considered in this paper, is to jointly estimate θ and x k , for each k, based on the state-space models given in (3), (7) and the measurement model (8). From a practical point of view, the measurement model in (8) needs some prior processing. The TOA which corresponds to the distance between the robot and a wall [34,35] must be estimated.
Let τ ik be the signal propagation time from the robot to the wall and back to the robot. The latter is related to the distance by where c is the speed of sound (approximately 340 m/s in air), and d ik is the distance between the robot and wall i at time k. Furthermore, in addition to estimating τ i,k , it is necessary to identify which echo corresponds to each wall. This problem is known as echo labeling. The reader is referred to [14,20,36,37] for further insights. Because echo labeling is beyond the scope of this paper we assume, for simplicity, that the echoes are perfectly labeled 2 . Finally, we would like to stress that the loudspeaker and the microphone are co-located only in their 2D-projection into the x-y plain. In Section 6.2, we place them in different heights, i.e., the source-receiver location differs only in their z-coordinate, such that they remain co-located in the x-y plane.

Simultaneous localization and mapping: algorithm
This section presents a recursive algorithm based on the EKF [5] for the SLAM problem given in Definition 1. Note that this is not a Bayesian estimation problem, but rather a hybrid one. To estimate the deterministic parameter θ k in (7) using the EKF, which is Bayesian, we incorporate randomness into θ k . This, in addition, enables a more "lively" tracking results [38] that cannot be achieved by the algorithm initialization (see, e.g., [5]). Accordingly, we modify (7) as follows where m k is white Gaussian noise with covariance matrix R k . The introduction of m k in (10), as well as the initializationθ 0 , incorporate an inaccurate prior probabilistic knowledge about θ . To avoid mismodelling, and guarantee thatθ 0 is forgotten rapidly, the matrix R k must be "large" at k = 0 and R k should decreases to zero as k increases.
where σ 2 0 is large and is the following diagonal matrix The parameters λ 1 , λ 2 act as decay coefficients that correspond to , respectively, and determine the rate at which the corresponding driving noise decreases. After substituting θ with θ k in (7), we are left with the nonlinear state-space model given by (3), (8), and (10), where the nonlinearity is due to (8). Similar to [5], it is possible to develop the EKF, which linearizes the measurement model and transition matrices [31,39]. The algorithm consists of two steps for each iteration: prediction and update. In the prediction stage, the robot location is predicted according to (3) as followŝ and the room parameter-vector is predicted according to (10) as follows: The joint covariance matrix of the localization and mapping parameters is where As discussed above, C w is the covariance matrix w.r.t. the localization parameters and R k is the randomness inserted into the mapping parameters.
In the update stage, the algorithm estimates the location and the room parameters aŝ and K k is the Kalman gain, which is given by The matrix S k is calculated as where ∇h denotes the Jacobian of h atx k|k−1 andθ k|k−1 . In addition, the covariance matrix is updated considering the EKF extension [5] The complete EKF algorithm is summarized in Algorithm 1.

The hybrid Cramér-Rao lower bound
In this section, we derive the HCRB for the SLAM problem of Definition 1. The objective is to bound the estimation error of x k and θ from the measurements z k for each step k, while treating the previous locations as a nuisance parameter. We denote the overall unknown parameter vector at time k by ψ k = x 0 , ..., x k , θ and collect the set of all robot's locations up to time k into x k = x 0 , x 1 , ..., x k . Similarly, z k = z 0 , z 1 , ..., z k comprises all the measurements up to time k. Since x k is random (3) while θ is deterministic, the estimation of ψ k is a hybrid estimation problem, i.e., a combination of classic and

Algorithm 1 EKF estimation
Initialization: Predict: Bayesian estimation philosophies [26,30,40]. The HCRB lower bound [24] asserts that for every unbiased estimatorψ k (z k ), i.e., the estimation error is lower bounded as follows: where the expectation E is taken w.r.t. the joint probability density function (p.d.f.) of z k , x k , i.e. p z k , x k ; θ , where we used semicolon to distinguish between the deterministic vector θ, and the random vectors z k and x k . Note thatψ k (z k ) is a function of the measurements z k . We omit the explicit dependency for brevity. The matrix is known as the hybrid Fisher information matrix (HFIM). In our case, the dimension of the full HFIM, J k , is R k+8×k+8 . Since we focus on performance evaluation of online algo- The following comment about assumption (22) is in place. Consider first the deterministic parameters; we note that in the finite sample regime, there are useful estimators that do not satisfy (22), e.g., the maximum likelihood (ML) in the pure classic case and the joint ML/MAP in the hybrid case (see [25]). Nevertheless, in the large-sample regime, an estimator that does not satisfy (22) concerning the deterministic static parameters is not consistent. Since inconsistent estimators are useless in the large-sample regime for these parameters, the assumption in (22) is not restricting. 3 Now to the random parameters. If there is a bias, it must be a known-function of the deterministic parameters. Thus, if the estimate of the deterministic parameters is consistent, the bias becomes known in the large-sample regime, and therefore, could and should be subtracted from the estimator. This operation yields an asymptotically unbiased estimate.
Before presenting the bound, the following definitions are required. Let J −1 k x k ,θ be the lower-right 10 × 10 block of J −1 k defined in (24) and let To calculate the HCRB, we will use the following recursive formula forJ x k ,θ k , that was derived [41] for a general state-space model with additive Gaussian noisẽ 3 For further reading on different types of unbiased conditions, the reader is referred to [25]. are defined by

Veisman et al. EURASIP Journal on Advances in Signal Processing
Before calculating the HCRB, we note thatJ k defined in (25), henceforth dubbed the sub-hybrid Fisher information matrix (SHFIM), is not the actual HFIM. The full HFIM is a matrix which inverse is the complete HCRB on the entire parameter vector, while the inverse ofJ k in (25) is the sub-block of the HCRB that corresponds to x k , θ . Also note that the expression in (26) is recursive, whereJ k is expressed in terms ofJ k−1 . Thus, giveñ , according to (27) in order to obtain the updated value ofJ k . A road map and the proof summary is given in Table 1.

Proposition 1 The components ofJ k (cf. (25)-(26b)), are given by
where the matrix F is defined in (4) and D 11 k−1 , D 12 k−1 ∈ R 2×2 . Furthermore, where The matrix D 23 k−1 ∈ R 8×2 is given as follows: its first column is obtained by stacking with where Finally, D 33 k−1 is the following block diagonal matrix i = 1, 2, 3, 4, and with Proof We would like to show that for the problem at hand (cf. Definition 1), (27a)-(27f) lead to D ij k , i, j ∈ {1, 2, 3} given in Proposition 1. We begin by noting that our problem fits the general structure of the filtering problem [29] in the sense that both are hybrid with a linear state-space kinematic model and a nonlinear measurement model with additive Gaussian noise. This establishes (28c) and, in addition, it implies Next, from (40a)-(40b), it follows that to derive D ij k−1 for i, j ∈ {2, 3}, it is necessary to derive the Jacobian of h (x k , θ ). For our kinematic and measurement model (3), (8), the Jacobian component with respect to x k is given by where G(α) is defined in (30). Thus, by substituting (41) and (30) into (40a), we establish (29). To show (31) and (32), we note that and From (30) and (41), D 23 k−1 can be written as Then, a brute-force derivation of (45) establishes (31) and (32).
To complete the proof, it remains to show (34). It can be shown that for i = 1, 2, 3, 4 where γ i is defined in (44). Taking the expectation while noting that x k and y k are statistically independent, it follows that where ζ i and χ i are defined in (36) and (37), respectively. It follows that (46), (47), and (48) establish (35) thus establishing (34).

Simulation results and discussion
In this section, we present numerical results of two simulation setups. In the first setup (Section 6.1), the signal is generated via pseudo-random sequences according to (3),(4), and (8), and the proposed EKF algorithm is compared to the HCRB. It will be shown that the proposed algorithm approaches the bound. Therefore, it is not compared to any additional estimation method. In the second setup (Section 6.2), the EKF algorithm is evaluated using audio chirp signals that were convoluted with a simulated room impulse response (RIR) using [42]. The result obtained in the second setup is not compared to the HCRB since the measurements do not suit the model under which the HCRB was developed. Explicitly, the HCRB was derived for noisy observation of the distances between the robot and the walls, whereas the observation in the second setup is the raw acoustic signal. To extract the distance from that measurement, it is necessary to preprocess it by an additional estimation pipeline. The reason we include the second setup is to show that the proposed algorithm is potentially applicable to actual problems. Nevertheless, we note that in real-life scenarios, this requires additional components, e.g., echo labeling block.

Evaluation of the EKF algorithm with respect to the HCRB
We consider a scenario in which the robot travels in an enclosed four-wall room, where each wall is characterized by an offset and angle as depicted in Fig 2. For each Monte-Carlo trial, the robot movement path was generated according to (3). For each k, the movement command u k was defined by a constant step size μ = 0.5 m and a uniformly distributed angle φ k . In determining the robot step-size, we had the following consideration. Recall that for each k, the EKF uses a first-order series approximation of the distance function h around k|k−1 , and note that a large step-size leads to a large variation in . Thus, the linear approximation becomes crude if the step size is too large, causing the EKF to diverge. On the other hand, if the step-size is too small, the robot will not travel enough distance required for mapping. In addition, the parameter ρ in (4) was set to ρ = 0.97. The variance of the robot step-error,w k (cf. (3), and the subsequent paragraph), was taken as σ w = 0.02 m, which is 4% of the robot step-size. The measurements z k were generated as follows. For each x k , we calculated h (x k , θ) using (8), and then, to reflect the inaccuracy in measuring the distance, we added the Gaussian noise v k with σ v = 0.02 m, which is also 4% of the step size. Note that these values, i.e., σ w , and σ v being 4%, are significant since it is accumulated as the algorithm progresses. The experiment was repeated and averaged over 40 different rooms. All rooms are 4wall rooms that differ in the angle between each adjacent wall. The angle was randomized from a uniform distribution in the range [ − 5, 5] degrees. Figures 3 and 4  square error (MSE) of the estimation of the room geometry parameters, {α i , b i } 4 i=1 , using the proposed EKF algorithm. The MSE is defined as

depict the mean
and calculated via Monte-Carlo. The figures also depict the corresponding HCRBs Figure 5 depicts the estimation error of the robot's location and compares it to the HCRB Examining the result in Fig. 5, the estimation error of the EKF algorithm during the first steps, i.e., approximately until k = 50, is lower than the HCRB. This low estimation error in the robot location follows from the fact that the initial robot location determines the origin of the coordinate system. Thus, with respect to this coordinate system, the robot location is known. As a result, we see a discrepancy between the localization results and the bound in the first 50 steps. Accordingly, this part of the graph should be ignored. The results show that the HCRB is large for small values of k, which is expected in the case of a few observations. Moreover, the bound drops significantly as k increases up to k = 20. This can be attributed to the significant contribution of each new measurement when the overall number of measurements is small. We note that at approximately k = 80, the slope becomes very moderate. We also note that the estimation error approaches the bound as k is increased as depicted in Figs. 3, 4, and 5, and the estimation error approaches the HCRB, implying that the EKF is an asymptotically optimal estimator and that the HCRB is asymptotically tight. Figure 6 depicts the estimated line-equation of one of the room's walls, i.e., the line in the plane which is determined by the estimated angle and offset. Each line corresponds to a different value of k. The results show that the estimated line coincides with the true line as k increases.

Evaluation based on simulated room impulse response
In this simulation, the robot moves a small number of steps chosen randomly (up to 15 steps for each run) and estimates the mapping parameters of rectangular rooms. In Figs. 7 and 8, we present two examples of robot trajectories and the evolution of the room shape estimates, as the robot moves in the room, in comparison to the true room geometry. There is, however, a technical difficulty in carrying out the simulation using the RIR generator [42]. In the latter, it is impossible to place the emitting source and the microphone at the same point, an assumption that underlies our 2D model (c.f. Section 3). To overcome that, we fed the simulator with a three-dimensional room with dimensions 4 × 5 × 7 m. The idea is to only have horizontal reflections, as in a 2D room. To achieve that, a low reflection coefficient, of value 0.1, was set to the ceiling and floor, while the other four walls were attributed with a high reflection coefficient of 0.95, as mentioned. We used a feature of the RIR generator [42] that allows us to construct an RIR comprising only the direct-path and the first-order reflections (with pre-defined reflection coefficients). The reverberation-time, which indicates the decay of the reverberation tail is therefore meaningless. In addition, the robot walked horizontally, where the emitting source and the microphone were placed on the robot such that their heights (with respect to the room's floor) were 3 m and 5 m, respectively, as depicted in Fig. 9. This way, the source and microphone were not at the same point, but their projections, as well as the projection of the distances to the walls, induced a 2D room in which the source and microphone were collocated. To project these distances, one has to discard the first peak, which corresponds to the direct-path between the microphone and source, and to take into account the incidence angle to each wall at every step. Explicitly, taking the midpoint between the microphone and the source as the robot position, we calculate the distance to each wall by compensating and incident angle, as depicted in Fig. 9. The microphone-source-wall configuration used in the RIR simulator, for one of the walls. The distance between the robot to the wall is d while the overall propagation distance of the wave is 2d . The angle of incidence is denoted by ξ In more explicit terms, let d i,k , 1 ≤ i ≤ 4 be the distance between wall-i and the robot after step k andd i,k be its corresponding estimate, extracted from the TOA. Then, z k is set as z ik =d ik , whered ik is the two dimensional distance, given byd ik =d ik cos (ξ ik ) , and ξ ik is the incidence-angle 4 . The result demonstrates that the estimates improve as the number of steps increases. Additional scenarios were simulated for several trajectories demonstrating similar results. Note that the orientation of the coordinate system is determined by the first robot step and is different in each scenario. The run time of each EKF estimation step on i7 Intel processor, implemented using Matlab©, took 260 mSec. Convergence time depends on the model and measurement errors described in (3), (10), and (8), as well as the decay coefficients in (12). As mentioned before, this simulation is not compared to the HCRB since it involves a prior stage that is not taken into consideration while calculating the bound. This simulation study is merely added to demonstrate that the proposed algorithm may be applied to real-life scenarios, provided that additional algorithmic blocks are implemented.
Since a small number of steps are taken, we set ρ = 1, where ρ is given in (4), and σ w = 0.05 m (c.f. Section 3.1). The measurements z k were generated as follows. At each step, k, we extracted the corresponding RIR using [42], with only the first-order reflections simulated (although unrealistic, it still provides an interesting scenario for the current study. Full reverberation regime is left for future research.). The RIR was convoluted with a linear chirp signal of 128 mSec long, with start and stop frequencies 0.5 KHz and 5 KHz, respectively. Sampling rate was set to 16 KHz. The output was then contaminated with a white, additive Gaussian noise. The signal-to-noise ratio (SNR) at the microphone is set to 5.6 dB. The received signal was correlated with the known chirp signal, and from the result, we picked the TOA of all peaks that were higher than one ninth of the strongest peak. In the rare cases where less than four peaks satisfied this condition, we took the four strongest. The simulation reflection coefficient was set to 0.95, which is relatively high. This was done to ensure that all echoes corresponding to the walls' direct paths would be discovered. If no matching echo is found for a specific wall, the mapping parameters (of that wall) cannot be estimated at the current robot step. We then solved the echo labeling 5 problem and setτ ik , the estimate of the TOA between the robot and wall-i (cf. Section 3.2), as half the TOA of the corresponding echo. Finally, we calculated the distanced ik according to (9) and concatenated all distances in the measurement vector z k , i.e., z ik =d ik , i = 1, . . . , 4.

Conclusions
In this paper, we considered the self-localization of a source that travels in an unknown environment, while simultaneously estimating its geometry from noisy time-of-arrival observations. We derived a recursive algorithm, based on the EKF, for this problem as well as the corresponding HCRB. Simulation results showed that the algorithm achieves the HCRB as the number of observations increases. Although this is not a formal proof, it implies that asymptotically, the EKF is an optimal estimator and that the HCRB a tight bound.
As a concrete application, we considered the case where the time-of-arrival is extracted from acoustic echoes and demonstrated the applicability of the proposed EKF algorithm.
An important direction for future research is to test theoretically if the tightness of the HCRB, as well as the optimally of the EKF that were observed in the simulation, is valid in general. The main challenge here is to extend the results about the tightness of HCRB [25] to cases where it is calculated recursively. Another important extension is to incorporate model order selection techniques to determine the number of walls, prior to applying the proposed EKF algorithm. In addition, other type of mismodelling could be considered [43], e.g., if the assumed kinematic model is not accurate.