MSCEqF 1.0
Multi State Constraint Equivariant Filter for visual inertial navigation
Loading...
Searching...
No Matches
msceqf::ProjectionHelperZ1 Class Reference

ProjectionHelperZ1 class. This class provides an implementation of the projection on the unit plane as well as its differential. More...

#include <updater_helper.hpp>

Inheritance diagram for msceqf::ProjectionHelperZ1:
Collaboration diagram for msceqf::ProjectionHelperZ1:

Public Member Functions

 ProjectionHelperZ1 (const FeatureRepresentation &feature_representation)
 
Vector3 pi (const Vector3 &f) override
 Projection function. This function projects a 3D point on the unit plane.
 
MatrixX dpi (const Vector3 &f) override
 Projection differential function. This function computes the differential of the projection function.
 
void residualJacobianBlock (const MSCEqFState &X, const SystemState &xi0, const FeatHelper &feat, MatrixXBlockRowRef C_block_row, VectorXBlockRowRef delta_block_row, MatrixXBlockRowRef Cf_block_row, const ColsMap &cols_map) override
 Computes a block row of the C matrix and a block of the residual, corresponding to the given feature This method compute the Ct matrix, the Cf matrix and the residual for a given feature.
 
- Public Member Functions inherited from msceqf::ProjectionHelper
const size_t & block_rows () const
 Get the number of rows of a C matrix block and a residual block.
 
const size_t & dim_loss () const
 Get the dimension lost due to nullspace projection.
 

Additional Inherited Members

- Protected Member Functions inherited from msceqf::ProjectionHelper
 ProjectionHelper (const FeatureRepresentation &feature_representation)
 Rule of 5.
 
 ProjectionHelper (const ProjectionHelper &)=default
 
 ProjectionHelper (ProjectionHelper &&)=default
 
ProjectionHelperoperator= (const ProjectionHelper &)=default
 
ProjectionHelperoperator= (ProjectionHelper &&)=default
 
- Protected Attributes inherited from msceqf::ProjectionHelper
FeatureRepresentation feature_representation_
 Feature representation.
 
size_t block_rows_
 Number of rows of a C matrix block and a residual block.
 
size_t dim_loss_
 Dimension lost due to nullspace projection.
 

Detailed Description

ProjectionHelperZ1 class. This class provides an implementation of the projection on the unit plane as well as its differential.

Member Function Documentation

◆ dpi()

MatrixX msceqf::ProjectionHelperZ1::dpi ( const Vector3 & f)
nodiscardoverridevirtual

Projection differential function. This function computes the differential of the projection function.

Parameters
f
Returns
Differential of the Z1 projection function

Implements msceqf::ProjectionHelper.

◆ pi()

Vector3 msceqf::ProjectionHelperZ1::pi ( const Vector3 & f)
nodiscardoverridevirtual

Projection function. This function projects a 3D point on the unit plane.

Parameters
f
Returns
R2 vector representing a 3D point on the unit plane

Implements msceqf::ProjectionHelper.

◆ residualJacobianBlock()

void msceqf::ProjectionHelperZ1::residualJacobianBlock ( const MSCEqFState & X,
const SystemState & xi0,
const FeatHelper & feat,
MatrixXBlockRowRef C_block_row,
VectorXBlockRowRef delta_block_row,
MatrixXBlockRowRef Cf_block_row,
const ColsMap & cols_map )
overridevirtual

Computes a block row of the C matrix and a block of the residual, corresponding to the given feature This method compute the Ct matrix, the Cf matrix and the residual for a given feature.

Parameters
XMSCEqF state
featFeature helper
C_block_rowBlock row of the C matrix
delta_block_rowBlock of the residual delta
Cf_block_rowBlock of the Cf matrix
cols_mapMap of indices for the C matrix and the residual delta

Implements msceqf::ProjectionHelper.


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