Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Karol Hausman, Gregory Kahn, Sachin Patil, Joerg Mueller, Ken.

Slides:



Advertisements
Similar presentations
Bayesian Belief Propagation
Advertisements

Motivating Markov Chain Monte Carlo for Multiple Target Tracking
Jose-Luis Blanco, Javier González, Juan-Antonio Fernández-Madrigal University of Málaga (Spain) Dpt. of System Engineering and Automation May Pasadena,
State Estimation and Kalman Filtering CS B659 Spring 2013 Kris Hauser.
EKF, UKF TexPoint fonts used in EMF.
1 University of Southern California Keep the Adversary Guessing: Agent Security by Policy Randomization Praveen Paruchuri University of Southern California.
SA-1 Probabilistic Robotics Planning and Control: Partially Observable Markov Decision Processes.
Mobile Robotics Laboratory Institute of Systems and Robotics ISR – Coimbra Aim –Take advantage from intelligent cooperation between mobile robots, so as.
Learning Parameterized Maneuvers for Autonomous Helicopter Flight Jie Tang, Arjun Singh, Nimbus Goehausen, Pieter Abbeel UC Berkeley.
Robot Localization Using Bayesian Methods
IR Lab, 16th Oct 2007 Zeyn Saigol
Nonlinear Optimization for Optimal Control
Markov Localization & Bayes Filtering 1 with Kalman Filters Discrete Filters Particle Filters Slides adapted from Thrun et al., Probabilistic Robotics.
Chapter 15 Probabilistic Reasoning over Time. Chapter 15, Sections 1-5 Outline Time and uncertainty Inference: ltering, prediction, smoothing Hidden Markov.
1 Slides for the book: Probabilistic Robotics Authors: Sebastian Thrun Wolfram Burgard Dieter Fox Publisher: MIT Press, Web site for the book & more.
Bayes Filters Pieter Abbeel UC Berkeley EECS Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics TexPoint fonts used in EMF. Read the.
Introduction to Mobile Robotics Bayes Filter Implementations Gaussian filters.
Large Scale Navigation Based on Perception Maria Joao Rendas I3S, CNRS-UNSA.
Christian LAUGIER – e-Motion project-team Bayesian Sensor Fusion for “Dynamic Perception” “Bayesian Occupation Filter paradigm (BOF)” Prediction Estimation.
Probabilistic Robotics: Kalman Filters
CS 547: Sensing and Planning in Robotics Gaurav S. Sukhatme Computer Science Robotic Embedded Systems Laboratory University of Southern California
1.Examples of using probabilistic ideas in robotics 2.Reverend Bayes and review of probabilistic ideas 3.Introduction to Bayesian AI 4.Simple example.
Particle Filters Pieter Abbeel UC Berkeley EECS Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics TexPoint fonts used in EMF. Read.
CS 547: Sensing and Planning in Robotics Gaurav S. Sukhatme Computer Science Robotic Embedded Systems Laboratory University of Southern California
© sebastian thrun, CMU, CS226 Statistical Techniques In Robotics Monte Carlo Localization Sebastian Thrun (Instructor) and Josh Bao (TA)
CS 547: Sensing and Planning in Robotics Gaurav S. Sukhatme Computer Science Robotic Embedded Systems Laboratory University of Southern California
Particle filters (continued…). Recall Particle filters –Track state sequence x i given the measurements ( y 0, y 1, …., y i ) –Non-linear dynamics –Non-linear.
Particle Filters for Mobile Robot Localization 11/24/2006 Aliakbar Gorji Roborics Instructor: Dr. Shiri Amirkabir University of Technology.
Probabilistic Robotics Introduction Probabilities Bayes rule Bayes filters.
Probabilistic Robotics
An Iterative Optimization Approach for Unified Image Segmentation and Matting Hello everyone, my name is Jue Wang, I’m glad to be here to present our paper.
11/14  Continuation of Time & Change in Probabilistic Reasoning Project 4 progress? Grade Anxiety? Make-up Class  On Monday?  On Wednesday?
Stanford CS223B Computer Vision, Winter 2006 Lecture 11 Filters / Motion Tracking Professor Sebastian Thrun CAs: Dan Maynes-Aminzade, Mitul Saha, Greg.
Probabilistic Robotics Bayes Filter Implementations Gaussian filters.
Bayesian Filtering for Robot Localization
Muhammad Moeen YaqoobPage 1 Moment-Matching Trackers for Difficult Targets Muhammad Moeen Yaqoob Supervisor: Professor Richard Vinter.
Belief space planning assuming maximum likelihood observations Robert Platt Russ Tedrake, Leslie Kaelbling, Tomas Lozano-Perez Computer Science and Artificial.
Markov Localization & Bayes Filtering
ECES 741: Stochastic Decision & Control Processes – Chapter 1: The DP Algorithm 1 Chapter 1: The DP Algorithm To do:  sequential decision-making  state.
Consensus-based Distributed Estimation in Camera Networks - A. T. Kamal, J. A. Farrell, A. K. Roy-Chowdhury University of California, Riverside
From Bayesian Filtering to Particle Filters Dieter Fox University of Washington Joint work with W. Burgard, F. Dellaert, C. Kwok, S. Thrun.
Computer Vision Group Prof. Daniel Cremers Autonomous Navigation for Flying Robots Lecture 6.2: Kalman Filter Jürgen Sturm Technische Universität München.
Probabilistic Robotics Robot Localization. 2 Localization Given Map of the environment. Sequence of sensor measurements. Wanted Estimate of the robot’s.
Jamal Saboune - CRV10 Tutorial Day 1 Bayesian state estimation and application to tracking Jamal Saboune VIVA Lab - SITE - University.
Complete Pose Determination for Low Altitude Unmanned Aerial Vehicle Using Stereo Vision Luke K. Wang, Shan-Chih Hsieh, Eden C.-W. Hsueh 1 Fei-Bin Hsaio.
Probabilistic Robotics Bayes Filter Implementations Gaussian filters.
1 Robot Environment Interaction Environment perception provides information about the environment’s state, and it tends to increase the robot’s knowledge.
Probabilistic Robotics Bayes Filter Implementations.
Automated Intruder Tracking using Particle Filtering and a Network of Binary Motion Sensors Jeremy Schiff EECS Department University of California, Berkeley.
Mobile Robot Localization (ch. 7)
State Estimation and Kalman Filtering
Sequential Monte-Carlo Method -Introduction, implementation and application Fan, Xin
CSE-473 Project 2 Monte Carlo Localization. Localization as state estimation.
1 Chapter 15 Probabilistic Reasoning over Time. 2 Outline Time and UncertaintyTime and Uncertainty Inference: Filtering, Prediction, SmoothingInference:
Markov Random Fields & Conditional Random Fields
CS 547: Sensing and Planning in Robotics Gaurav S. Sukhatme Computer Science Robotic Embedded Systems Laboratory University of Southern California
The Unscented Particle Filter 2000/09/29 이 시은. Introduction Filtering –estimate the states(parameters or hidden variable) as a set of observations becomes.
Planning in Information Space for a Quad-rotor Helicopter Ruijie He Thesis Advisor: Prof. Nicholas Roy.
Planning Under Uncertainty. Sensing error Partial observability Unpredictable dynamics Other agents.
Generalized Point Based Value Iteration for Interactive POMDPs Prashant Doshi Dept. of Computer Science and AI Institute University of Georgia
Probabilistic Robotics Probability Theory Basics Error Propagation Slides from Autonomous Robots (Siegwart and Nourbaksh), Chapter 5 Probabilistic Robotics.
Keep the Adversary Guessing: Agent Security by Policy Randomization
Partially Observable Markov Decision Process and RL
CS b659: Intelligent Robotics
Ch3: Model Building through Regression
Probabilistic Robotics
Markov ó Kalman Filter Localization
Robust Belief-based Execution of Manipulation Programs
A Short Introduction to the Bayes Filter and Related Models
Reinforcement Learning Dealing with Partial Observability
Presentation transcript:

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Karol Hausman, Gregory Kahn, Sachin Patil, Joerg Mueller, Ken Goldberg, Pieter Abbeel, Gaurav Sukhatme University of Southern California, University of California Berkeley

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions

Belief Space Planning Perception Action Belief Space Planning State space plan start goal Problem settingBelief space plan [Example from Platt et al., 2010] This is a Partially Observable Markov Decision Process (POMDP) – in general intractable

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Belief Space Planning State space plan start goal Problem settingBelief space plan [Example from Platt et al., 2010]

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Belief Space Planning Nonlinear stochastic motion and observation models Belief space: Convert underlying dynamics to belief space dynamics Bayesian filter (e.g., Extended Kalman Filter (EKF)) (state space) x (belief space)

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Belief Space Planning Minimize Constraints: = goal Measurements?

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Belief Space Planning Minimize Constraints: = goal Maximum likelihood measurements

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Level -1 Level 0 Level 1 Level 2 [Hausman et al., ISER 2014, IJRR 2015] Occlusions

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Occlusions Field of view (FOV) discontinuity Occlusion discontinuity

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Occlusions : Binary variable {0,1} 0 -> No measurement 1 -> Measurement Modified Kalman Gain in EKF: [Patil et al. ICRA 2014] Binary non-convex optimization problem – difficult to solve!

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Occlusions ≈

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Occlusions Increasing difficulty [Patil et al. ICRA 2014]

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Occlusions Outside camera FOV Occlusions due to other quadrotors [Hausman et al., ICRA 2016]

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Consider nonlinear stochastic dynamics and measurement models Dynamics: Measurement: Problem formulation

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Problem formulation Cost terms:

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Results

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Results Thank you How does the optimization time horizon affect tracking performance? 2 time steps5 time steps10 time steps Avg. over 10 runs

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Results Thank you How does number of quadrotors affect tracking performance? 1 quadrotor3 quadrotors5 quadrotors

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Results Thank you How does optimization compare to random sampling or lattice based sampling in terms of tracking performance? Random samplingLattice samplingOptimization 3 Quadrotors

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Results How does explicit consideration of occlusions affect tracking performance? Does not consider occlusions during planning Consider occlusions during planning

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Results Multi-level topology approach (Hausman et al, 2014) Optimization Comparison of topology approach vs. optimization

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Insights

Optimization-Based Cooperative Multi-Robot Target Tracking with Reasoning about Occlusions Summary 3D Tracking Approach: considers onboard sensing and does not need to explicitly reason about sensing topologies is probabilistic and takes into account motion and sensing uncertainties provides locally optimal control in 3D

Questions?