The Hardware Design of the Humanoid Robot RO-PE and the Self-localization Algorithm in RoboCup Tian Bo Control and Mechatronics Lab Mechanical Engineering.

Slides:



Advertisements
Similar presentations
Mobile Robot Localization and Mapping using the Kalman Filter
Advertisements

Jose-Luis Blanco, Javier González, Juan-Antonio Fernández-Madrigal University of Málaga (Spain) Dpt. of System Engineering and Automation May Pasadena,
(Includes references to Brian Clipp
Monte Carlo Localization for Mobile Robots Karan M. Gupta 03/10/2004
Kiyoshi Irie, Tomoaki Yoshida, and Masahiro Tomono 2011 IEEE International Conference on Robotics and Automation Shanghai International Conference Center.
Robot Localization Using Bayesian Methods
Lab 2 Lab 3 Homework Labs 4-6 Final Project Late No Videos Write up
Bologna 6-8 September Genetic Approach for a Localisation Problem based upon Particle Filters A. Gasparri, S. Panzieri, F. Pascucci, G. Ulivi Dipartimento.
Markov Localization & Bayes Filtering 1 with Kalman Filters Discrete Filters Particle Filters Slides adapted from Thrun et al., Probabilistic Robotics.
Advanced Artificial Intelligence
Probabilistic Robotics Bayes Filter Implementations Particle filters.
Probabilistic Robotics: Kalman Filters
TOWARD DYNAMIC GRASP ACQUISITION: THE G-SLAM PROBLEM Li (Emma) Zhang and Jeff Trinkle Department of Computer Science, Rensselaer Polytechnic Institute.
Autonomous Robot Navigation Panos Trahanias ΗΥ475 Fall 2007.
Particle Filters Pieter Abbeel UC Berkeley EECS Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics TexPoint fonts used in EMF. Read.
SLAM: Simultaneous Localization and Mapping: Part I Chang Young Kim These slides are based on: Probabilistic Robotics, S. Thrun, W. Burgard, D. Fox, MIT.
Probabilistic Robotics
Particle Filter/Monte Carlo Localization
Part 2 of 3: Bayesian Network and Dynamic Bayesian Network.
Robust Monte Carlo Localization for Mobile Robots
Monte Carlo Localization
Particle Filters for Mobile Robot Localization 11/24/2006 Aliakbar Gorji Roborics Instructor: Dr. Shiri Amirkabir University of Technology.
A Probabilistic Approach to Collaborative Multi-robot Localization Dieter Fox, Wolfram Burgard, Hannes Kruppa, Sebastin Thrun Presented by Rajkumar Parthasarathy.
1 Integration of Background Modeling and Object Tracking Yu-Ting Chen, Chu-Song Chen, Yi-Ping Hung IEEE ICME, 2006.
Probabilistic Robotics
Probabilistic Robotics Bayes Filter Implementations Particle filters.
Particle Filtering for Non- Linear/Non-Gaussian System Bohyung Han
Probabilistic Robotics Bayes Filter Implementations Gaussian filters.
Particle Filtering. Sensors and Uncertainty Real world sensors are noisy and suffer from missing data (e.g., occlusions, GPS blackouts) Use sensor models.
Particle Filters++ TexPoint fonts used in EMF.
HCI / CprE / ComS 575: Computational Perception
Bayesian Filtering for Robot Localization
Kalman filter and SLAM problem
Mobile Robot controlled by Kalman Filter
Markov Localization & Bayes Filtering
From Bayesian Filtering to Particle Filters Dieter Fox University of Washington Joint work with W. Burgard, F. Dellaert, C. Kwok, S. Thrun.
Simultaneous Localization and Mapping Presented by Lihan He Apr. 21, 2006.
Probabilistic Robotics: Monte Carlo Localization
Mapping and Localization with RFID Technology Matthai Philipose, Kenneth P Fishkin, Dieter Fox, Dirk Hahnel, Wolfram Burgard Presenter: Aniket Shah.
Jamal Saboune - CRV10 Tutorial Day 1 Bayesian state estimation and application to tracking Jamal Saboune VIVA Lab - SITE - University.
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.
Particle Filters for Shape Correspondence Presenter: Jingting Zeng.
Young Ki Baik, Computer Vision Lab.
Computer Science, Software Engineering & Robotics Workshop, FGCU, April 27-28, 2012 Fault Prediction with Particle Filters by David Hatfield mentors: Dr.
Particle Filters.
Forward-Scan Sonar Tomographic Reconstruction PHD Filter Multiple Target Tracking Bayesian Multiple Target Tracking in Forward Scan Sonar.
Mobile Robot Localization (ch. 7)
Real-Time Simultaneous Localization and Mapping with a Single Camera (Mono SLAM) Young Ki Baik Computer Vision Lab. Seoul National University.
Sequential Monte-Carlo Method -Introduction, implementation and application Fan, Xin
OBJECT TRACKING USING PARTICLE FILTERS. Table of Contents Tracking Tracking Tracking as a probabilistic inference problem Tracking as a probabilistic.
State Estimation and Kalman Filtering Zeeshan Ali Sayyed.
Tracking with dynamics
Particle Filtering. Sensors and Uncertainty Real world sensors are noisy and suffer from missing data (e.g., occlusions, GPS blackouts) Use sensor models.
Particle Filter for Robot Localization Vuk Malbasa.
Particle filters for Robot Localization An implementation of Bayes Filtering Markov Localization.
Autonomous Mobile Robots Autonomous Systems Lab Zürich Probabilistic Map Based Localization "Position" Global Map PerceptionMotion Control Cognition Real.
General approach: A: action S: pose O: observation Position at time t depends on position previous position and action, and current observation.
Probabilistic Robotics Bayes Filter Implementations Gaussian filters.
Mobile Robotics. Fundamental Idea: Robot Pose 2D world (floor plan) 3 DOF Very simple model—the difficulty is in autonomy.
Using Sensor Data Effectively
Probabilistic Robotics
Introduction to particle filter
Particle Filter/Monte Carlo Localization
Particle filters for Robot Localization
Introduction to particle filter
A Short Introduction to the Bayes Filter and Related Models
Probabilistic Map Based Localization
Probabilistic Robotics Bayes Filter Implementations FastSLAM
Presentation transcript:

The Hardware Design of the Humanoid Robot RO-PE and the Self-localization Algorithm in RoboCup Tian Bo Control and Mechatronics Lab Mechanical Engineering 20 Feb 2009 SMC

RoboCup and Team RO-PE RoboCup TM is an international joint project to promote artificial intelligence and robotics. Team RO-PE RO-PE (RObot for Personal Entertainment) is a series of small size humanoid robots developed by the Legged Locomotion Group

Highlight

Design of the Robot

Hierarchy of the System

Self-localization in RoboCup Global localization problem -The robot is not told its initial pose, but has to determine it from the very beginning

Self-localization in RoboCup Global localization problem Kidnapped robot problem - a well-localized robot is teleported to some other position without being told - The kidnapped robot problem is often used to test a robot’s ability to recover autonomously form catastrophic localization failures

Self-localization in RoboCup Global localization problem Kidnapped robot problem Other difficulties in the humanoid soccer scenario - The field of view is limited, due to the human-like sensor. - Noisy perceptions and noisy odometry. - Computational resources are limited. But data needs to be processed in real-time.

What is Particle Filter Belongs to the family of Bayesian Filters (Bayes Filter,Kalman Filter…) Bayesian filter techniques provide a powerful statistical tool to help manage measurement uncertainty Based on the knowledge of previous state, Bayesian filter probabilistically estimates a dynamic system’s state from noisy environment.

What is Particle Filter Particle filters represent beliefs by a sets of samples, or particles It is a probabilistic approach, in which the current location of the modeled as a density of the particles. Each particle can be seen as the hypotheses of the robot being located at this posture.

What is Particle Filter The main objective of particle filtering is to “track” a variable of interest as it evolves over time, typically with a non- Gaussian and potentially multi-modal pdf The particle filter algorithm is recursive in nature and operates in two phases: prediction and update

Particle Filter Localization Determine the probabilities qi based on observation model Resampling Move all the particles according to the motion model of the previous action of the robot More practical part (real “trick”)

Particle Filter Algorithm (Probabilistic Robotics, C4 P98) 1. Algorithm particle_filter( S t-1, u t-1 z t ): For Generate new samples 4. Sample index j(i) from the discrete distribution given by w t-1 5. Sample from using and 6. Compute importance weight 7. Update normalization factor 8. Insert 9. For 10. Normalize weights

Particle Filter for Self-Localization Loop initializeParticles(); //p[i] (x, y, theta, w) While(sensor reset != 1){ motionModel(); sensorModel();{ updateWeight(); } updateWeight(); } resampling(); output(); } output();

Initialization

Motion Model This is the prediction part The particle filter for self-localization estimates the robot ’ s pose Odometry-based Method Take x for example: p[m].x = p[m].x + deltaX *(1+gaussian)

Motion Model Simplified Leg Model Step 1 hip_yaw = 0

Motion Model Simplified Leg Model Step 2 hip_yaw = θ

Motion Model We do localization when the left leg just touch the ground This odometry gets the data from the motion commend sent to servo, it will not be affected by the control signal. It can be more accurate if the servo can feedback its position.

Error for the Motion Model(1) with the steps increased, the error increase. The largest error is 25%, happens at the 14th step.

Error for the Motion Model(2) Like walking motion, the real distance has a linear relationship with the number of steps, so we can achieve better results through improve our model or make correction. Back to Particle Filter

Sensor Model This is the update part In the whole field, we only use the two goals and two poles for self-localization. The world model is known. We only take the angle from the landmark to the front of robot into consideration

Sensor Model We are only using the wide angle camera for landmark recognition, the information we can abstract from the camera is limited.

Sensor Model Once a landmark is observed by the robot, the function sensorModel() will be executed. The weight for every particle will be updated accordingly. If several landmarks are observed at once, the weight will be

Sensor Model We can get the expectedTheta through the position and orientation of the particle and the world model if(blue_goal_found){ /*we can get the percievedTheta from camera, the coordination of the landmark on the image, and the position of the panning servo of the head */ updateWeight(blue_goal)}

Sensor Model Update Weight deltaTheta = fabs ( expectedTheta – perceivedTheta) ; belief = distribution ( deltaTheta ); p[i].weight = p[i].weight * belief Normalize(p[i].weight); Distribution Policy Now we are using Gaussian distribution.

Resampling The simplest method of resampling is to select each particle with a probability equal to its weight. Select with Replacement Linear time Resampling Resampling by Liu et al.

Resampling (A Particle Filter Tutorial for Mobile Robot Localization TR-CIM-04-02)

Final Estimation Finding the Largest Cluster Give the best result but computational expensive Calculating the Average May affect by the far away particles Best Weight Fastest way to give the result, suitable for the real-time system

Future work Find out the condition to make sensor resetting, or else sometimes the particle will converge to a false point and cannot recover. Including the distance information in sensor model. Try new resampling and weightUpdate algorithm.

Thank you