an uwb time-difference-of-arrival model - · pdf filemics workshop, september 6, 2011 an uwb...
TRANSCRIPT
![Page 1: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/1.jpg)
MICS Workshop, September 6, 2011
An UWB Time-Difference-of-Arrival Model
For Mobile Robot Localization
Amanda Prorok*, Phillip Tomé**, Alcherio Martinoli*
*Distributed Intelligent Systems and Algorithms Lab, EPFL
**Electronics and Signal Processing Lab, EPFL
NCCR-MICS
![Page 2: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/2.jpg)
Outdoor Indoor
? Global Navigation Satellite Systems
![Page 3: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/3.jpg)
UWB Positioning
Graph: courtesy Chung et al., Int. Conf. on Ultra Wideband Systems and Technologies, 2003
Theoretical UWB ranging performance
![Page 4: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/4.jpg)
UWB for Mobile Robots
&
Mobile Robots for UWB
![Page 5: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/5.jpg)
UWB for mobile robots
• Beats current localization technologies
– Low power
– High accuracy & update rate
– Line-of-sight (LOS) insensitivity
– Scalability
• Applications
– Embedded systems / robots
• Wireless sensor networks
• Multi-robot systems
![Page 6: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/6.jpg)
UWB error source: TOA multipath
True TOA
Attenuation by antenna pattern
Attenuation by obstruction (NLOS)
Attenuation & delay by obstr. (NLOS)
TX RX
t
r
t
t t
→ positive bias
![Page 7: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/7.jpg)
Mobile robots for UWB
• Systematic assessment tool
– Controlled trajectories
– Real-time localization performance evaluation
• Understanding & alleviating UWB shortcomings
– Algorithm development (sensor fusion, machine learning)
– Distributed intelligence (multi-robot systems)
• Test portability onto embedded systems
![Page 8: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/8.jpg)
State-of-Art
• UWB on robots
– Little work done
• UWB for on-board localization
– Roy et al. (2005); Gonzalez et al. (2009)
– Augmented state particle filters (no explicit error models)
• UWB sensor fusion
– With dead-reckoning sensors
– Not done yet with exteroceptive sensors
![Page 9: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/9.jpg)
How?
![Page 10: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/10.jpg)
Single robot setup
On-board sensor information: odometry
UWB TDOA
motion model
TDOA measurement model
![Page 11: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/11.jpg)
Multi-robot setup
On-board sensor information: odometry
UWB TDOA
Relative positions
motion model
TDOA measurement model
R&B model
![Page 12: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/12.jpg)
The KIII mobile robot
• Embedded Linux, 400MHz CPU
• 802.11b WiFi
• High resolution odometry
• Ubisense 7000 Series Compact Tag
• Relative range & bearing (R&B) board
~10cm
![Page 13: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/13.jpg)
Experimental arena
Robots exploit space through
random movement
Data:
• UWB TDOA measurements
• Ground truth (overhead camera)
• Robot data (odometry, relative pos.)
![Page 14: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/14.jpg)
The UWB Measurement Model
![Page 15: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/15.jpg)
UWB range error model
)1(
),(
),0(
,,
2
unL
ulnNulnNun
N
PBernoulliY
lnNb
N
~
~
~
bias noise
unununun Ybrr ˆ
r̂
)ˆ(rp
r[Alsindi and Alavi, IEEE VTC, 2009]
![Page 16: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/16.jpg)
)r)(Δp(p)L|r(Δp
)r(Δp)|Lr(Δp
rrrΔ
unNN,uununun
unNununun
ununun
ˆˆ
ˆˆ
ˆˆ
ln
TOA error model
TOA (range) error:
PDF of LOS error:
PDF of NLOS error:
PDF of TOA error:
)L|r(Δp)P()|Lr(ΔpP)r(Δp unununLunununLunun ununˆ1ˆˆ
![Page 17: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/17.jpg)
vnunuv,n
vnunnuv
rΔrΔτΔ
rrτ
ˆˆˆ
ˆˆˆ,
TDOA error model
)τ)(Δp(p)τ(Δp uv,nvnunuv,nuv,nˆˆ
PDF of TDOA error:
TDOA error:
TDOA:
)ˆ( τΔp
τΔˆ0
![Page 18: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/18.jpg)
Illustration: TOA error model
LOS NLOS
![Page 19: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/19.jpg)
Illustration: TDOA error model
LOS - LOS NLOS - LOS NLOS - NLOS
![Page 20: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/20.jpg)
Employing the UWB TDOA Model
![Page 21: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/21.jpg)
Parameter estimation
~
~
bias noise
~
unununun Ybrr ˆ
)1(
),(
),0(
,,
2
unL
ulnNulnNun
N
PBernoulliY
lnNb
N
![Page 22: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/22.jpg)
TDOA error models
BS2 – BS1 BS3 – BS1 BS4 – BS1
• 4000 data points per base-station pair
• Curve fitting: minimization of Kolmogorov-Smirnov distance between CDFs
• Final KS-distance of 0.036
![Page 23: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/23.jpg)
TOA error models
BS1 0.49
BS2 0.32
BS3 0.28
BS4 0.09
PL
![Page 24: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/24.jpg)
Estimation of spatial LOS/NLOS
vnunnuvnuv bb ,,ˆ
1, tLunP
If ground truth available
Solve:
Tbxn and if:
else
0, tLunP
![Page 25: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/25.jpg)
Robot Detection Model
![Page 26: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/26.jpg)
Multi-robot localization
• Distributed intelligence
– Shared knowledge on positioning
– Shared knowledge on environment
– Robustness
• Potential performance improvement
• Heterogeneous multi-robot team
![Page 27: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/27.jpg)
• Multivariate, multimodal Gaussian
• PDF is created according to R&B noise model
nR
Range & bearing detection model
)|(P ,tnnmn Dx
![Page 28: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/28.jpg)
Experimental Results
![Page 29: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/29.jpg)
Experimental scenarios
1. Collaboration scheme
a) Collaborative
b) Non-collaborative
2. NLOS/LOS path conditions
a) Naïve no NLOS assumed
b) Average estimated constant LOS proportion
c) Spatial quasi-optimal spatial LOS/NLOS
![Page 30: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/30.jpg)
Experimental results
Empirical Cumulative Density over all positioning errors
Non-collaborative Collaborative
![Page 31: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/31.jpg)
Conclusions
Summary
• Explicit, probabilistic UWB TDOA measurement model
• Model validated on real data
• Collaboration compensated for LOS/NLOS knowledge
Further work
• Online Estimation
• Spatial error models
![Page 32: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/32.jpg)
Thank you for your attention.
Amanda Prorok*, Phillip Tomé**, Alcherio Martinoli*
*Distributed Intelligent Systems and Algorithms Lab, EPFL
**Electronics and Signal Processing Lab, EPFL
NCCR-MICS
![Page 33: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/33.jpg)
![Page 34: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/34.jpg)
![Page 35: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/35.jpg)
Experimental results
RMSE over all particle positions
Collaborative Non-collaborative
![Page 36: An UWB Time-Difference-of-Arrival Model - · PDF fileMICS Workshop, September 6, 2011 An UWB Time-Difference-of-Arrival Model For Mobile Robot Localization Amanda Prorok*, Phillip](https://reader033.vdocuments.mx/reader033/viewer/2022052708/5a7142cf7f8b9ab1538cab7c/html5/thumbnails/36.jpg)
Context: the localization algorithm
Algorithm: Multi-robot Monte-Carlo Localization 1: for all particles do 2: apply_motion_model(odometry, particles) 3: apply_measurement_model(TDOA, particles) 4: apply_detection_model(R&B, particles) 5: end for 6: for all particles do 7: if (rand < (1-α)) 8: resample(particles) 9: else 10: reciprocal_sample(R&B) 11: end if 12: end