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::ostream &f)
static void	write_VERTEX_line (const TNodeID id, const mrpt::poses::CPose3D &p, std::ostream &f)
static void	write_EDGE_line (const TPairNodeIDs &edgeIDs, const CPosePDFGaussianInf &edge, std::ostream &f)
static void	write_EDGE_line (const TPairNodeIDs &edgeIDs, const CPose3DPDFGaussianInf &edge, std::ostream &f)
static void	write_EDGE_line (const TPairNodeIDs &edgeIDs, const CPosePDFGaussian &edge, std::ostream &f)
static void	write_EDGE_line (const TPairNodeIDs &edgeIDs, const CPose3DPDFGaussian &edge, std::ostream &f)
static void	write_EDGE_line (const TPairNodeIDs &edgeIDs, const mrpt::poses::CPose2D &edge, std::ostream &f)
static void	write_EDGE_line (const TPairNodeIDs &edgeIDs, const mrpt::poses::CPose3D &edge, std::ostream &f)
static void	save_graph_of_poses_to_ostream (const graph_t *g, std::ostream &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_stream (graph_t *g, std::istream &f, const std::string &fil=std::string("(none)"))
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 846 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().

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 852 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().

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 809 of file CNetworkOfPoses_impl.h.

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

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 813 of file CNetworkOfPoses_impl.h.

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

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 819 of file CNetworkOfPoses_impl.h.

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

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 825 of file CNetworkOfPoses_impl.h.

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

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 834 of file CNetworkOfPoses_impl.h.

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

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 838 of file CNetworkOfPoses_impl.h.

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

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 867 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().

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 672 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().

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 714 of file CNetworkOfPoses_impl.h.

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

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

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 655 of file CNetworkOfPoses_impl.h.

References THROW_EXCEPTION_FMT.

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

load_graph_of_poses_from_text_stream()

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::load_graph_of_poses_from_text_stream ( graph_t *  g, std::istream &  f, const std::string &  fil = std::string("(none)")  )

inlinestatic

Definition at line 204 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 >::readAsText().

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 178 of file CNetworkOfPoses_impl.h.

References ASSERT_EQUAL_, and MRPT_THROW_UNKNOWN_SERIALIZATION_VERSION.

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

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 163 of file CNetworkOfPoses_impl.h.

References version.

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

save_graph_of_poses_to_ostream()

template<class graph_t >

static void mrpt::graphs::detail::graph_ops< graph_t >::save_graph_of_poses_to_ostream ( const graph_t *  g, std::ostream &  f  )

inlinestatic

Definition at line 124 of file CNetworkOfPoses_impl.h.

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

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 149 of file CNetworkOfPoses_impl.h.

References THROW_EXCEPTION_FMT.

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

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::ostream &  f  )

inlinestatic

Definition at line 74 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().

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::ostream &  f  )

inlinestatic

Definition at line 82 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().

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::ostream &  f  )

inlinestatic

Definition at line 96 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::ostream &  f  )

inlinestatic

Definition at line 102 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::ostream &  f  )

inlinestatic

Definition at line 108 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::ostream &  f  )

inlinestatic

Definition at line 115 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::ostream &  f  )

inlinestatic

Definition at line 61 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::ostream &  f  )

inlinestatic

Definition at line 66 of file CNetworkOfPoses_impl.h.