Method and apparatus for estimating pose of mobile robot using particle filter
First Claim
Patent Images
1. An apparatus for estimating a pose of a mobile robot, comprising:
- an odometer which detects a variation in the pose of a mobile robot;
a feature-processing module to extracts at least one feature from an upward image captured by the mobile robot; and
a particle filter module to determines current poses and weights of a plurality of particles by applying the mobile robot pose variation detected by the odometer and the at least one feature extracted by the feature-processing module to previous poses and weights of the particles,wherein the at least one extracted feature is shared between each of the plurality of particles.
1 Assignment
0 Petitions
Accused Products
Abstract
A method and apparatus for estimating the pose of a mobile robot using a particle filter is provided. The apparatus includes an odometer which detects a variation in the pose of a mobile robot, a feature-processing module which extracts at least one feature from an upward image captured by the mobile robot, and a particle filter module which determines current poses and weights of a plurality of particles by applying the mobile robot pose variation detected by the odometer and the feature extracted by the feature-processing module to previous poses and weights of the particles.
36 Citations
20 Claims
-
1. An apparatus for estimating a pose of a mobile robot, comprising:
-
an odometer which detects a variation in the pose of a mobile robot; a feature-processing module to extracts at least one feature from an upward image captured by the mobile robot; and a particle filter module to determines current poses and weights of a plurality of particles by applying the mobile robot pose variation detected by the odometer and the at least one feature extracted by the feature-processing module to previous poses and weights of the particles, wherein the at least one extracted feature is shared between each of the plurality of particles. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 12)
-
-
10. An apparatus for estimating a pose of a mobile robot, comprising:
-
an odometer which detects a variation in the pose of a mobile robot; a feature-processing module which extracts at least one feature from an upward image captured by the mobile robot; and a particle filter module which determines current poses and weights of a plurality of particles by applying the mobile robot pose variation detected by the odometer and the feature extracted by the feature-processing module to previous poses and weights of the particles, wherein the particle filter module comprises; a pose-estimation unit which determines the current poses of the particles by applying the mobile robot pose variation detected by the odometer to the particles; and a weight-calculation unit which compares the current poses of the particles with a pose of the mobile robot estimated based on the feature extracted by the feature-processing module and allocates high weights to particles whose current poses are similar to the estimated mobile robot pose, wherein the particle filter module further comprises a sampling unit which resamples a number of particles according to the weights of the particles, wherein the pose-estimation unit increases covariance if a difference between the mobile robot pose variation detected by the odometer and a variation in the pose of the mobile robot estimated based on the feature extracted by the feature-processing module is greater than a predefined threshold.
-
-
11. An apparatus for estimating a pose of a mobile robot, comprising:
-
an odometer which detects a variation in the pose of a mobile robot; a feature-processing module which extracts at least one feature from an upward image captured by the mobile robot; and a particle filter module which determines current poses and weights of a plurality of particles by applying the mobile robot pose variation detected by the odometer and the feature extracted by the feature-processing module to previous poses and weights of the particles, wherein the particle filter module comprises; a pose-estimation unit which determines the current poses of the particles by applying the mobile robot pose variation detected by the odometer to the particles; and a weight-calculation unit which compares the current poses of the particles with a pose of the mobile robot estimated based on the feature extracted by the feature-processing module and allocates high weights to particles whose current poses are similar to the estimated mobile robot pose, wherein the particle filter module further comprises a sampling unit which resamples a number of particles according to the weights of the particles, wherein the pose-estimation unit increases straight advance noise covariance if it is determined that the mobile robot has slipped on a floor and a difference between a variation in the pose of the mobile robot detected by a gyroscope and a variation in the pose of the mobile robot detected by an encoder is less than a predefined threshold; and
increases rotation noise covariance if it is determined that the mobile robot has slipped on the floor and the difference between the mobile robot pose variation detected by the gyroscope and the mobile robot pose variation detected by the encoder is greater than the predefined threshold.
-
-
13. A method of estimating a pose of a mobile robot, comprising:
-
detecting a variation in the pose of a mobile robot; extracting at least one feature from an upward image captured by the mobile robot; and determining current poses and weights of particles by applying the detected mobile robot pose variation and the at least one extracted feature to previous poses and weights of the particles, wherein the at least one extracted feature is shared between each of the plurality of particles. - View Dependent Claims (14, 15, 16, 17, 18)
-
-
19. A method of estimating a pose of a mobile robot, comprising:
-
detecting a variation in the pose of a mobile robot; extracting at least one feature from an upward image captured by the mobile robot; and determining current poses and weights of particles by applying the detected mobile robot pose variation and the extracted feature to previous poses and weights of the particles, wherein the determining current poses and weights comprises determining the current poses of the particles by applying the detected mobile robot pose variation to the particles; and comparing the current poses of the particles with a pose of the mobile robot estimated based on the extracted feature, and allocating high weights to particles whose current poses are similar to the estimated mobile robot pose, wherein the determining the current poses of the particles comprises calculating a variation in the pose of a particle by adding up the detected mobile robot pose variation and random noise within a noise covariance range, wherein the determining the current poses of the particles further comprises increasing covariance if a difference between the detected mobile robot pose variation and the estimated mobile robot pose is greater than a predefined threshold.
-
-
20. A method of estimating a pose of a mobile robot, comprising:
-
detecting a variation in the pose of a mobile robot; extracting at least one feature from an upward image captured by the mobile robot; and determining current poses and weights of particles by applying the detected mobile robot pose variation and the extracted feature to previous poses and weights of the particles, wherein the determining current poses and weights comprises determining the current poses of the particles by applying the detected mobile robot pose variation to the particles; and comparing the current poses of the particles with a pose of the mobile robot estimated based on the extracted feature, and allocating high weights to particles whose current poses are similar to the estimated mobile robot pose, wherein the determining the current poses of the particles comprises calculating a variation in the pose of a particle by adding up the detected mobile robot pose variation and random noise within a noise covariance range, wherein the determining the current poses of the particles further comprises, if it is determined that the mobile robot has slipped on a floor; increasing straight advance noise covariance if a difference between a variation in the pose of the mobile robot detected by a gyroscope and a variation in the pose of the mobile robot detected by an encoder is less than a predefined threshold; and increasing rotation noise covariance if the difference between the mobile robot pose variation detected by the gyroscope and the mobile robot pose variation detected by the encoder is greater than the predefined threshold.
-
Specification