mrpt::graphs::detail::graph_ops< graph_t > Struct Template Reference

Detailed Description

template<class graph_t>
struct mrpt::graphs::detail::graph_ops< graph_t >

a helper struct with static template functions

See also

CNetworkOfPoses

Definition at line 49 of file CNetworkOfPoses.h.

#include <mrpt/graphs/CNetworkOfPoses.h>

Static Public Member Functions
static void	write_VERTEX_line (const TNodeID id, const mrpt::poses::CPose2D &p, std::ofstream &f)
static void	write_VERTEX_line (const TNodeID id, const mrpt::poses::CPose3D &p, std::ofstream &f)
static void	write_EDGE_line (const TPairNodeIDs &edgeIDs, const CPosePDFGaussianInf &edge, std::ofstream &f)
static void	write_EDGE_line (const TPairNodeIDs &edgeIDs, const CPose3DPDFGaussianInf &edge, std::ofstream &f)
static void	write_EDGE_line (const TPairNodeIDs &edgeIDs, const CPosePDFGaussian &edge, std::ofstream &f)
static void	write_EDGE_line (const TPairNodeIDs &edgeIDs, const CPose3DPDFGaussian &edge, std::ofstream &f)
static void	write_EDGE_line (const TPairNodeIDs &edgeIDs, const mrpt::poses::CPose2D &edge, std::ofstream &f)
static void	write_EDGE_line (const TPairNodeIDs &edgeIDs, const mrpt::poses::CPose3D &edge, std::ofstream &f)
static void	save_graph_of_poses_to_text_file (const graph_t *g, const std::string &fil)
static void	save_graph_of_poses_to_binary_file (const graph_t *g, mrpt::utils::CStream &out)
static void	read_graph_of_poses_from_binary_file (graph_t *g, mrpt::utils::CStream &in)
static void	load_graph_of_poses_from_text_file (graph_t *g, const std::string &fil)
static size_t	graph_of_poses_collapse_dup_edges (graph_t *g)
static void	graph_of_poses_dijkstra_init (graph_t *g)
template<class VEC >
static double	auxMaha2Dist (VEC &err, const CPosePDFGaussianInf &p)
template<class VEC >
static double	auxMaha2Dist (VEC &err, const CPose3DPDFGaussianInf &p)
template<class VEC >
static double	auxMaha2Dist (VEC &err, const CPosePDFGaussian &p)
template<class VEC >
static double	auxMaha2Dist (VEC &err, const CPose3DPDFGaussian &p)
template<class VEC >
static double	auxMaha2Dist (VEC &err, const mrpt::poses::CPose2D &p)
template<class VEC >
static double	auxMaha2Dist (VEC &err, const mrpt::poses::CPose3D &p)
static double	auxEuclid2Dist (const mrpt::poses::CPose2D &p1, const mrpt::poses::CPose2D &p2)
static double	auxEuclid2Dist (const mrpt::poses::CPose3D &p1, const mrpt::poses::CPose3D &p2)
static double	graph_edge_sqerror (const graph_t *g, const typename mrpt::graphs::CDirectedGraph< typename graph_t::constraint_t >::edges_map_t::const_iterator &itEdge, bool ignoreCovariances)

Member Function Documentation

auxEuclid2Dist() [1/2]

template<class graph_t >

static double mrpt::graphs::detail::graph_ops< graph_t >::auxEuclid2Dist ( const mrpt::poses::CPose2D &  p1, const mrpt::poses::CPose2D &  p2  )

inlinestatic

Definition at line 944 of file CNetworkOfPoses_impl.h.

References mrpt::poses::CPose2D::phi(), mrpt::math::square(), mrpt::math::wrapToPi(), mrpt::poses::CPoseOrPoint< DERIVEDCLASS >::x(), and mrpt::poses::CPoseOrPoint< DERIVEDCLASS >::y().

Here is the call graph for this function:

auxEuclid2Dist() [2/2]

template<class graph_t >

static double mrpt::graphs::detail::graph_ops< graph_t >::auxEuclid2Dist ( const mrpt::poses::CPose3D &  p1, const mrpt::poses::CPose3D &  p2  )

inlinestatic

Definition at line 950 of file CNetworkOfPoses_impl.h.

References mrpt::poses::CPose3D::pitch(), mrpt::poses::CPose3D::roll(), mrpt::math::square(), mrpt::math::wrapToPi(), mrpt::poses::CPoseOrPoint< DERIVEDCLASS >::x(), mrpt::poses::CPoseOrPoint< DERIVEDCLASS >::y(), and mrpt::poses::CPose3D::yaw().

Here is the call graph for this function:

auxMaha2Dist() [1/6]

template<class graph_t >

template<class VEC >

static double mrpt::graphs::detail::graph_ops< graph_t >::auxMaha2Dist ( VEC &  err, const CPosePDFGaussianInf &  p  )

inlinestatic

Definition at line 891 of file CNetworkOfPoses_impl.h.

References mrpt::math::multiply_HCHt_scalar(), and mrpt::math::wrapToPiInPlace().

Here is the call graph for this function:

auxMaha2Dist() [2/6]

template<class graph_t >

template<class VEC >

static double mrpt::graphs::detail::graph_ops< graph_t >::auxMaha2Dist ( VEC &  err, const CPose3DPDFGaussianInf &  p  )

inlinestatic

Definition at line 898 of file CNetworkOfPoses_impl.h.

References mrpt::math::multiply_HCHt_scalar(), and mrpt::math::wrapToPiInPlace().

Here is the call graph for this function:

auxMaha2Dist() [3/6]

template<class graph_t >

template<class VEC >

static double mrpt::graphs::detail::graph_ops< graph_t >::auxMaha2Dist ( VEC &  err, const CPosePDFGaussian &  p  )

inlinestatic

Definition at line 907 of file CNetworkOfPoses_impl.h.

References mrpt::math::multiply_HCHt_scalar(), mrpt::math::UNINITIALIZED_MATRIX, and mrpt::math::wrapToPiInPlace().

Here is the call graph for this function:

auxMaha2Dist() [4/6]

template<class graph_t >

template<class VEC >

static double mrpt::graphs::detail::graph_ops< graph_t >::auxMaha2Dist ( VEC &  err, const CPose3DPDFGaussian &  p  )

inlinestatic

Definition at line 916 of file CNetworkOfPoses_impl.h.

References mrpt::math::multiply_HCHt_scalar(), mrpt::math::UNINITIALIZED_MATRIX, and mrpt::math::wrapToPiInPlace().

Here is the call graph for this function:

auxMaha2Dist() [5/6]

template<class graph_t >

template<class VEC >

static double mrpt::graphs::detail::graph_ops< graph_t >::auxMaha2Dist ( VEC &  err, const mrpt::poses::CPose2D &  p  )

inlinestatic

Definition at line 929 of file CNetworkOfPoses_impl.h.

References mrpt::math::square(), and mrpt::math::wrapToPiInPlace().

Here is the call graph for this function:

auxMaha2Dist() [6/6]

template<class graph_t >

template<class VEC >

static double mrpt::graphs::detail::graph_ops< graph_t >::auxMaha2Dist ( VEC &  err, const mrpt::poses::CPose3D &  p  )

inlinestatic

Definition at line 935 of file CNetworkOfPoses_impl.h.

References mrpt::math::square(), and mrpt::math::wrapToPiInPlace().

Here is the call graph for this function:

graph_edge_sqerror()

template<class graph_t >

static double mrpt::graphs::detail::graph_ops< graph_t >::graph_edge_sqerror ( const graph_t *  g, const typename mrpt::graphs::CDirectedGraph< typename graph_t::constraint_t >::edges_map_t::const_iterator &  itEdge, bool  ignoreCovariances  )

inlinestatic

Definition at line 966 of file CNetworkOfPoses_impl.h.

References ASSERTMSG_, mrpt::format(), MRPT_END, MRPT_START, static_size, and mrpt::poses::UNINITIALIZED_POSE.

Referenced by mrpt::graphs::CNetworkOfPoses< CPOSE, MAPS_IMPLEMENTATION, NODE_ANNOTATIONS, EDGE_ANNOTATIONS >::getEdgeSquareError().

Here is the call graph for this function:

Here is the caller graph for this function:

graph_of_poses_collapse_dup_edges()

template<class graph_t >

static size_t mrpt::graphs::detail::graph_ops< graph_t >::graph_of_poses_collapse_dup_edges ( graph_t *  g )

inlinestatic

Definition at line 730 of file CNetworkOfPoses_impl.h.

References min, MRPT_END, and MRPT_START.

Referenced by mrpt::graphs::CNetworkOfPoses< CPOSE, MAPS_IMPLEMENTATION, NODE_ANNOTATIONS, EDGE_ANNOTATIONS >::collapseDuplicatedEdges().

Here is the caller graph for this function:

graph_of_poses_dijkstra_init()

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::graph_of_poses_dijkstra_init ( graph_t *  g )

inlinestatic

Definition at line 781 of file CNetworkOfPoses_impl.h.

References ASSERTMSG_, mrpt::mrpt::format(), MRPT_END, MRPT_START, and MRPT_UNUSED_PARAM.

Referenced by mrpt::graphs::CNetworkOfPoses< CPOSE, MAPS_IMPLEMENTATION, NODE_ANNOTATIONS, EDGE_ANNOTATIONS >::dijkstra_nodes_estimate().

Here is the call graph for this function:

Here is the caller graph for this function:

load_graph_of_poses_from_text_file()

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::load_graph_of_poses_from_text_file ( graph_t *  g, const std::string &  fil  )

inlinestatic

Definition at line 252 of file CNetworkOfPoses_impl.h.

References mrpt::graphs::detail::TPosePDFHelper< POSE_PDF >::copyFrom2D(), mrpt::graphs::detail::TPosePDFHelper< POSE_PDF >::copyFrom3D(), mrpt::format(), mrpt::utils::CTextFileLinesParser::getCurrentLineNumber(), mrpt::utils::CTextFileLinesParser::getNextLine(), min, mrpt::graphs::CNetworkOfPoses< CPOSE, MAPS_IMPLEMENTATION, NODE_ANNOTATIONS, EDGE_ANNOTATIONS >::nodes, mrpt::math::TPose2D::phi, mrpt::math::TPose3D::pitch, mrpt::math::TPose3DQuat::qr, mrpt::math::TPose3DQuat::qx, mrpt::math::TPose3DQuat::qy, mrpt::math::TPose3DQuat::qz, mrpt::utils::CTextFileLinesParser::rewind(), mrpt::math::TPose3D::roll, mrpt::system::strCmpI(), THROW_EXCEPTION, mrpt::math::TPose2D::x, mrpt::math::TPose3D::x, mrpt::math::TPose3DQuat::x, mrpt::math::TPose2D::y, mrpt::math::TPose3D::y, mrpt::math::TPose3DQuat::y, mrpt::math::TPose3D::yaw, mrpt::math::TPose3D::z, and mrpt::math::TPose3DQuat::z.

Referenced by mrpt::graphs::CNetworkOfPoses< CPOSE, MAPS_IMPLEMENTATION, NODE_ANNOTATIONS, EDGE_ANNOTATIONS >::loadFromTextFile().

Here is the call graph for this function:

Here is the caller graph for this function:

read_graph_of_poses_from_binary_file()

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::read_graph_of_poses_from_binary_file ( graph_t *  g, mrpt::utils::CStream &  in  )

inlinestatic

Definition at line 225 of file CNetworkOfPoses_impl.h.

References ASSERT_EQUAL_, and MRPT_THROW_UNKNOWN_SERIALIZATION_VERSION.

Referenced by mrpt::graphs::operator>>().

Here is the caller graph for this function:

save_graph_of_poses_to_binary_file()

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::save_graph_of_poses_to_binary_file ( const graph_t *  g, mrpt::utils::CStream &  out  )

inlinestatic

Definition at line 209 of file CNetworkOfPoses_impl.h.

Referenced by mrpt::graphs::operator<<().

Here is the caller graph for this function:

save_graph_of_poses_to_text_file()

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::save_graph_of_poses_to_text_file ( const graph_t *  g, const std::string &  fil  )

inlinestatic

Definition at line 175 of file CNetworkOfPoses_impl.h.

References THROW_EXCEPTION_FMT.

Referenced by mrpt::graphs::CNetworkOfPoses< CPOSE, MAPS_IMPLEMENTATION, NODE_ANNOTATIONS, EDGE_ANNOTATIONS >::saveToTextFile().

Here is the caller graph for this function:

write_EDGE_line() [1/6]

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::write_EDGE_line ( const TPairNodeIDs &  edgeIDs, const CPosePDFGaussianInf &  edge, std::ofstream &  f  )

inlinestatic

Definition at line 98 of file CNetworkOfPoses_impl.h.

References mrpt::poses::CPosePDFGaussianInf::cov_inv, mrpt::poses::CPosePDFGaussianInf::mean, mrpt::poses::CPose2D::phi(), mrpt::poses::CPoseOrPoint< DERIVEDCLASS >::x(), and mrpt::poses::CPoseOrPoint< DERIVEDCLASS >::y().

Here is the call graph for this function:

write_EDGE_line() [2/6]

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::write_EDGE_line ( const TPairNodeIDs &  edgeIDs, const CPose3DPDFGaussianInf &  edge, std::ofstream &  f  )

inlinestatic

Definition at line 112 of file CNetworkOfPoses_impl.h.

References mrpt::poses::CPose3DPDFGaussianInf::cov_inv, mrpt::poses::CPose3DPDFGaussianInf::mean, mrpt::poses::CPose3D::pitch(), mrpt::poses::CPose3D::roll(), mrpt::poses::CPoseOrPoint< DERIVEDCLASS >::x(), mrpt::poses::CPoseOrPoint< DERIVEDCLASS >::y(), and mrpt::poses::CPose3D::yaw().

Here is the call graph for this function:

write_EDGE_line() [3/6]

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::write_EDGE_line ( const TPairNodeIDs &  edgeIDs, const CPosePDFGaussian &  edge, std::ofstream &  f  )

inlinestatic

Definition at line 137 of file CNetworkOfPoses_impl.h.

write_EDGE_line() [4/6]

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::write_EDGE_line ( const TPairNodeIDs &  edgeIDs, const CPose3DPDFGaussian &  edge, std::ofstream &  f  )

inlinestatic

Definition at line 145 of file CNetworkOfPoses_impl.h.

write_EDGE_line() [5/6]

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::write_EDGE_line ( const TPairNodeIDs &  edgeIDs, const mrpt::poses::CPose2D &  edge, std::ofstream &  f  )

inlinestatic

Definition at line 153 of file CNetworkOfPoses_impl.h.

write_EDGE_line() [6/6]

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::write_EDGE_line ( const TPairNodeIDs &  edgeIDs, const mrpt::poses::CPose3D &  edge, std::ofstream &  f  )

inlinestatic

Definition at line 162 of file CNetworkOfPoses_impl.h.

write_VERTEX_line() [1/2]

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::write_VERTEX_line ( const TNodeID  id, const mrpt::poses::CPose2D &  p, std::ofstream &  f  )

inlinestatic

Definition at line 82 of file CNetworkOfPoses_impl.h.

write_VERTEX_line() [2/2]

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::write_VERTEX_line ( const TNodeID  id, const mrpt::poses::CPose3D &  p, std::ofstream &  f  )

inlinestatic

Definition at line 88 of file CNetworkOfPoses_impl.h.