Distributed Cooperative Backpressure-Based Traffic Light ...
Cooperative distributed estimation and control of multiple ...
Transcript of Cooperative distributed estimation and control of multiple ...
![Page 1: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/1.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinarEUMR webinar 1/ 28
Cooperative distributed estimation and control of multiple autonomous vehicles for range-based underwater target localization and pursuit
EUMarineRobots webinar
Speaker:Nguyen Tuan Hung
Contact: [email protected]
Joint work with: Francisco Rego, Naveen Crasta, David Salinas, Antonio Pascoal, Tor Johansen
![Page 2: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/2.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 2/ 28
Cooperative target localization and pursuit Introduction▷ Introduction
Target
Problems
● How to localize the targets cooperatively ?
►ensure that all vehicles have an agreement on the estimates of the targets’ states
● How to pursue the targets cooperatively ?
► keep the vehicles close to the targets
►Keep the vehicles in a desired geometrical formation w.r.t. the targets
![Page 3: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/3.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 3/ 28
Target localization and pursuit Introduction▷ Introduction
Target
Solutions
● Centralized approach with tools from
►Estimation theory (CRLB)
►Model predictive control
● Distributed approach with tools from
►Distributed estimation (distributed EKF)
►Distributed control
►Nonlinear control
![Page 4: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/4.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 4/ 28
Centralized approach with MPC and CRLB
Target
![Page 5: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/5.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 5/ 28
Target information measured by the Fisher Information Matrix (FIM)▷ Introduction
True target
Can not distinguish “True target” and Target’s image when using range measurements
(because the distances to the vehicle are equal)
Target’s image
Vehicle
![Page 6: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/6.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 6/ 28
Target information measured by the Fisher Information Matrix (FIM)▷ Introduction
True target
Vehicle How to quantify the range-related information available to estimate the target´s state ?
Fisher Information Matrix
![Page 7: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/7.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 7/ 28
Range-based SLAP using posterior CRLB Problem formulation▷ Introduction
Target
State
Input
Position
StatePosition noise
Prior information
![Page 8: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/8.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 8/ 28
Range-based SLAP using posterior CRLB Problem formulation▷ Introduction
State
Input
Position
StatePosition noise
Prior information
Problem 1 [Range-based SLAP]
![Page 9: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/9.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 9/ 28
Range-based SLAP using posterior CRLB ▷ Main idea
State
Input
Position
StatePosition noise
Prior information
Fisher Information Matrix (FIM)
Tychavsky et al., 1998
Objective
FIM depends on the vehicles’ positions driven by the vehicles’ inputs
![Page 10: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/10.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 10/ 28
Range-based SLAP using posterior CRLB ▷ MPC scheme
![Page 11: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/11.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 11/ 28
Range-based SLAP using posterior CRLB ▷ Example
![Page 12: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/12.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 12/ 28
Range-based SLAP using posterior CRLB ▷ Example
![Page 13: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/13.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 13/ 28
Summary
Reference: Nguyen T. Hung, N. Crasta, David Moreno-Salinas, António M. Pascoal, Tor A. Johansen, “Range-based target localization and pursuit with autonomous vehicles: An approach using posterior CRLB and model predictive control”, Robotics and Autonomous Systems, 2020.
● MPC + CRLB is a universal approach
● Results give useful guidelines for motion planning
● However, for the case of multiple trackers, the MPC scheme is implemented in a centralized manner
See an alternative (distributed) approach next
![Page 14: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/14.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 14/ 28
Distributed Approach
Target
![Page 15: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/15.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 15/ 28
DEC strategy for cooperative SLAP Problem formulation ▷ Introduction
Target noise
![Page 16: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/16.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 16/ 28
DEC strategy for cooperative SLAP Problem formulation ▷ Introduction
Problem 2 [Cooperative distributed SLAP]
![Page 17: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/17.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 17/ 28
DEC strategy for cooperative SLAP Problem formulation ▷ Introduction
“Optimal” vehicles-target relative geometry for target localization purposes [from the MPC approach]
![Page 18: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/18.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 18/ 28
DEC strategy for cooperative SLAP Trajectory planning ▷ Introduction
![Page 19: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/19.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 19/ 28
DEC strategy for cooperative SLAP Desired formation ▷ Introduction
Problem 2.1 [Cooperative control for target pursuit]
2 vehicles: 3 vehicles:
![Page 20: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/20.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 20/ 28
DEC strategy for cooperative SLAP Proposed DEC architecture ▷ Introduction
Tracking Controller
Cooperative Estimation
(DEKF)
Cooperative Control
Network
Cooperative-layer
Tracking-layer
PDF: Probability density function
![Page 21: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/21.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 21/ 28
DEC strategy for cooperative SLAP Cooperative estimation mechanism ▷ Introduction
Tracking Controller
Cooperative Estimation
(DEKF)
Cooperative Control
Network
Cooperative-layer
Tracking-layer
Cooperative Estimation
(DEKF)
Vehicle i
![Page 22: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/22.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 22/ 28
DEC strategy for cooperative SLAP Cooperative control▷ Introduction
Tracking Controller
Cooperative Estimation
(DEKF)
Cooperative Control
Network
Cooperative-layer
Tracking-layer
Cooperative Estimation
(DEKF)
Vehicle i
![Page 23: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/23.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 23/ 28
DEC strategy for cooperative SLAP Simulation with a single vehicle ▷ Introduction
Estimated target(star-red)
Target(blue)
Vehicle (solid red)
S-T curve (dash red)
![Page 24: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/24.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 24/ 28
DEC strategy for cooperative SLAP Simulation with 3 vehicles ▷ Introduction
12
3
![Page 25: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/25.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 25/ 28
DEC strategy for cooperative SLAP Simulation with a single vehicle ▷ Introduction
Vehicle (solid red)
Target (blue)
S-T curve(dash-red)
![Page 26: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/26.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 26/ 28
DEC strategy for cooperative SLAP Simulation with three vehicle ▷ Introduction
![Page 27: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/27.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 27/ 28
Summary
Future research directions and plans:
➢ Extend to the case of multiple targets
➢ Event driven sampling (measurement strategy)
➢ Conduct field trials at Expo, Lisbon
Materials about this work can be found at:
https://nt-hung.github.io/research/Range-based-target-localization/
Reference: Nguyen T. Hung, Francisco Rego, Antonio M. Pascoal, “Cooperative distributed estimation and control of multiple autonomous vehicles for range-based underwater target localization and pursuit”, IEEE Transactions on Control Systems and Technology, conditionally accepted with minor revision.
![Page 28: Cooperative distributed estimation and control of multiple ...](https://reader030.fdocuments.net/reader030/viewer/2022012714/61ad25551492a107c932ad50/html5/thumbnails/28.jpg)
April 2021April 2021Nguyen Tuan Hung (ISR/IST)Nguyen Tuan Hung (ISR/IST) EUMR webinar EUMR webinar 28/ 28
Thank you!
Discussion