jafar::slam::RhoThetaImagePluckerFeatureObserveModel Class Reference

Observation Model using Rho Theta parametrisation. More...

---

Detailed Description

Observation Model using Rho Theta parametrisation.

Definition at line 583 of file segmentFeature.hpp.

#include <segmentFeature.hpp>

Inheritance diagram for jafar::slam::RhoThetaImagePluckerFeatureObserveModel:

List of all members.

Public Member Functions
	RhoThetaImagePluckerFeatureObserveModel (SegmentFeatureModel &featureModel_, jafar::camera::CameraPinhole const &camera_)
virtual jblas::vec const &	computeInnovation (jblas::vec const &z_, jblas::vec const &zPred_)
	Innovation.
virtual void	computeSensorR (Observation const &obs)
	Build covariances matrix of observation.
Static Public Member Functions
static jblas::vec2	extToImageModel (jblas::vec const &ext1, jblas::vec const &ext2)
	Compute two lines from the optical center through both segment extremities.
static void	extToImageModelJac (jblas::vec const &ext1, jblas::vec const &ext2, jblas::mat &J)
	The Jacobians of extToLine() wrt the extremes.
Protected Member Functions
jblas::vec const &	predictObservationInSensorFrame (jblas::vec const &feature_)
	Project line into camera and convert to 2D representation.
void	predictObservationInSensorFrameJac (jblas::vec const &feature_)
	Project line into camera and convert to 2D representation -- Jacobians.
virtual jblas::vec const &	homogeneousToImageModel (jblas::vec3 const &l_)
	homogeneous to rho-theta conversion
virtual void	homogeneousToImageModelJac (jblas::vec3 const &l_, jblas::mat &Jl) const
	homogeneous to rho-theta conversion -- Jacobians
virtual jblas::vec3	imageModelToHomogeneous (jblas::vec const &rt_)
	Rho-theta to homogeneous transform.
virtual void	imageModelToHomogeneousJac (jblas::vec const &rt_, jblas::vec3 &l, jblas::mat &HMrt)
	Rho-theta to homogeneous transform -- Jacobian.
virtual void	imageModelToHomogeneousJac (jblas::vec const &rt_, jblas::mat &HMrt)
	Rho-theta to homogeneous transform -- Jacobian.
virtual jblas::vec	inverseObservationInSensorFrame (Observation const &obs_)
	Retro-project Plucker line.
virtual void	inverseObservationInSensorFrameJac (Observation const &obs_)
	Retro-project Plucker line -- output and Jacobian.

---

Member Function Documentation

virtual void jafar::slam::RhoThetaImagePluckerFeatureObserveModel::computeSensorR

(

Observation const &

obs

)

[virtual]

Build covariances matrix of observation.

Parameters:

obs	observation as a couple of endpoints

Reimplemented from jafar::slam::BaseFeatureObserveModel.

static jblas::vec2 jafar::slam::RhoThetaImagePluckerFeatureObserveModel::extToImageModel	(	jblas::vec const &	ext1,
		jblas::vec const &	ext2
	)		[static]

Compute two lines from the optical center through both segment extremities.

Parameters:

ext1	the first extreme of the detected segment
ext2	the second extreme

static void jafar::slam::RhoThetaImagePluckerFeatureObserveModel::extToImageModelJac	(	jblas::vec const &	ext1,
		jblas::vec const &	ext2,
		jblas::mat &	J
	)		[static]

The Jacobians of extToLine() wrt the extremes.

Parameters:

ext1	the first extreme of the detected segment
ext2	the second extreme
J	The returned Jacobian

virtual jblas::vec3 jafar::slam::RhoThetaImagePluckerFeatureObserveModel::imageModelToHomogeneous

(

jblas::vec const &

rt_

)

[protected, virtual]

Rho-theta to homogeneous transform.

Parameters:

rt_	input rho-theta 2D line representation -- rt = (rho,theta)'

Returns:

The homogeneous line in P3 -- l = (a,b,c)'

Implements jafar::slam::ImagePluckerFeatureObserveModel.

virtual void jafar::slam::RhoThetaImagePluckerFeatureObserveModel::imageModelToHomogeneousJac	(	jblas::vec const &	rt_,
		jblas::vec3 &	l,
		jblas::mat &	HMrt
	)		[protected, virtual]

Rho-theta to homogeneous transform -- Jacobian.

Parameters:

rt_	input rho-theta 2D line representation
HMrt	output transformation Jacobian

Implements jafar::slam::ImagePluckerFeatureObserveModel.

virtual void jafar::slam::RhoThetaImagePluckerFeatureObserveModel::imageModelToHomogeneousJac	(	jblas::vec const &	rt_,
		jblas::mat &	HMrt
	)		[protected, virtual]

Rho-theta to homogeneous transform -- Jacobian.

Parameters:

rt_	input rho-theta 2D line representation
l	output homogeneous line representation
HMrt	output transformation Jacobian

Implements jafar::slam::ImagePluckerFeatureObserveModel.

virtual jblas::vec jafar::slam::RhoThetaImagePluckerFeatureObserveModel::inverseObservationInSensorFrame

(

Observation const &

obs_

)

[protected, virtual]

Retro-project Plucker line.

Retro-project Plucker line -- output and Jacobian Retro-project Plucker line

Implements jafar::slam::FeatureObserveModel.

---

The documentation for this class was generated from the following file:

• modules/slam/include/slam/segmentFeature.hpp