lejos.robotics.localization
Class MCLParticle

java.lang.Object
  lejos.robotics.localization.MCLParticle

public class MCLParticle
extends java.lang.Object

Represents a particle for the particle filtering algorithm. The state of the particle is the pose, which represents a possible pose of the robot. The weight for a particle is set by taking a set of theoretical range readings using a map of the environment, and comparing these ranges with those taken by the robot. The weight represents the relative probability that the robot has this pose. Weights are from 0 to 1.

Author:

Lawrie Griffiths

Constructor Summary

MCLParticle(Pose pose)
Create a particle with a specific pose

Method Summary

void	applyMove(Movement move, float distanceNoiseFactor, float angleNoiseFactor) Apply the robot's move to the particle with a bit of random noise.
void	calculateWeight(RangeReadings rr, RangeMap map, float divisor) Calculate the weight for this particle by comparing its readings with the robot's readings
Pose	getPose() Return the pose of this particle
float	getReading(int i, RangeReadings rr, RangeMap map) Get a specific reading
float	getWeight() Return the weight of this particle
void	setWeight(float weight) Set the weight for this particle

Methods inherited from class java.lang.Object

clone, equals, finalize, getClass, hashCode, notify, notifyAll, toString, wait, wait, wait

Constructor Detail

MCLParticle

public MCLParticle(Pose pose)

Create a particle with a specific pose

Parameters:

pose - the pose

Method Detail

setWeight

public void setWeight(float weight)

Set the weight for this particle

Parameters:

weight - the weight of this particle

getWeight

public float getWeight()

Return the weight of this particle

Returns:

the weight

getPose

public Pose getPose()

Return the pose of this particle

Returns:

the pose

calculateWeight

public void calculateWeight(RangeReadings rr,
                            RangeMap map,
                            float divisor)

Calculate the weight for this particle by comparing its readings with the robot's readings

Parameters:

rr - Robot readings

getReading

public float getReading(int i,
                        RangeReadings rr,
                        RangeMap map)

Get a specific reading

Parameters:

i - the index of the reading

Returns:

the reading

applyMove

public void applyMove(Movement move,
                      float distanceNoiseFactor,
                      float angleNoiseFactor)

Apply the robot's move to the particle with a bit of random noise. Only works for rotate or travel movements.

Parameters:

move - the robot's move