A example code just to show all the onboar reference systems in the atlascar. More...
#include <boost/algorithm/string.hpp>#include <boost/config.hpp>#include <string>#include <boost/mpl/bool.hpp>#include <boost/algorithm/string/yes_no_type.hpp>#include <list>#include <boost/algorithm/string/sequence_traits.hpp>#include <boost/detail/workaround.hpp>#include <boost/range/begin.hpp>#include <boost/range/end.hpp>#include <boost/range/const_iterator.hpp>#include <boost/range/iterator_range.hpp>#include <boost/range/size_type.hpp>#include <boost/range/iterator.hpp>#include <cstring>#include <cwchar>#include <boost/algorithm/string/config.hpp>#include <boost/detail/iterator.hpp>#include <algorithm>#include <locale>#include <boost/range/value_type.hpp>#include <boost/range/as_literal.hpp>#include <functional>#include <boost/type_traits/remove_const.hpp>#include <boost/algorithm/string/predicate_facade.hpp>#include <boost/function.hpp>#include <boost/iterator.hpp>#include <boost/iterator/detail/enable_if.hpp>#include <boost/iterator/iterator_adaptor.hpp>#include <boost/iterator/iterator_categories.hpp>#include <boost/mpl/not.hpp>#include <boost/type_traits/function_traits.hpp>#include <boost/type_traits/is_const.hpp>#include <boost/type_traits/is_class.hpp>#include <boost/type_traits/is_function.hpp>#include <boost/type_traits/is_reference.hpp>#include <boost/type_traits/remove_reference.hpp>#include <boost/iterator/detail/config_def.hpp>#include <boost/iterator/detail/config_undef.hpp>#include <boost/algorithm/string/constants.hpp>#include <boost/range/empty.hpp>#include <boost/algorithm/string/compare.hpp>#include <iterator>#include <boost/algorithm/string/find.hpp>#include <boost/iterator/transform_iterator.hpp>#include <boost/preprocessor/cat.hpp>#include <boost/mpl/if.hpp>#include <boost/type_traits/conversion_traits.hpp>#include <utility>#include <boost/type_traits/is_same.hpp>#include <boost/type_traits/is_void.hpp>#include <boost/mpl/assert.hpp>#include <boost/concept/assert.hpp>#include <boost/preprocessor/seq/for_each_i.hpp>#include <boost/preprocessor/seq/enum.hpp>#include <boost/preprocessor/comma_if.hpp>#include <boost/iterator/iterator_facade.hpp>#include <boost/algorithm/string/finder.hpp>#include <boost/mpl/logical.hpp>#include <deque>#include <boost/algorithm/string/concept.hpp>#include <boost/algorithm/string/detail/sequence.hpp>#include <boost/algorithm/string/detail/find_format_store.hpp>#include <boost/algorithm/string/detail/replace_storage.hpp>#include <boost/algorithm/string/detail/util.hpp>#include <boost/algorithm/string/find_format.hpp>#include <boost/algorithm/string/formatter.hpp>#include <boost/algorithm/string/classification.hpp>#include <boost/algorithm/string/find_iterator.hpp>#include <ros/ros.h>#include <sensor_msgs/JointState.h>#include <tf/transform_broadcaster.h>#include <vector>#include <map>#include <ostream>#include "ros/serialization.h"#include "ros/builtin_message_traits.h"#include "ros/message_operations.h"#include "ros/time.h"#include "ros/macros.h"#include "ros/assert.h"#include "std_msgs/Header.h"#include "geometry_msgs/Pose.h"#include "geometry_msgs/Vector3.h"#include "geometry_msgs/Point.h"#include "std_msgs/ColorRGBA.h"#include "visualization_msgs/Marker.h"#include "tf/tfMessage.h"#include "tf/tf.h"#include <boost/shared_ptr.hpp>#include "common.h"#include "ros/types.h"#include <boost/thread/mutex.hpp>#include <boost/thread/shared_mutex.hpp>#include <boost/thread/condition_variable.hpp>#include <boost/thread/tss.hpp>#include "ros/service_traits.h"#include "boost/thread.hpp"#include <cstddef>#include <iostream>#include <stdarg.h>#include <stdio.h>#include "Core"#include "src/StlSupport/StdVector.h"#include "src/Core/util/DisableStupidWarnings.h"#include "SVD"#include "LU"#include <limits>#include "src/Geometry/OrthoMethods.h"#include "src/Geometry/EulerAngles.h"#include "src/Core/util/ReenableStupidWarnings.h"#include <stdexcept>#include <pcl/pcl_macros.h>#include "src/Core/util/Macros.h"#include <cerrno>#include <cstdlib>#include <cmath>#include <complex>#include <cassert>#include <iosfwd>#include <climits>#include "src/Core/util/Constants.h"#include "src/Core/util/ForwardDeclarations.h"#include "src/Core/util/Meta.h"#include "src/Core/util/XprHelper.h"#include "src/Core/util/StaticAssert.h"#include "src/Core/util/Memory.h"#include "src/Core/NumTraits.h"#include "src/Core/MathFunctions.h"#include "src/Core/GenericPacketMath.h"#include "src/Core/arch/Default/Settings.h"#include "src/Core/Functors.h"#include "src/Core/DenseCoeffsBase.h"#include "src/Core/DenseBase.h"#include "src/Core/MatrixBase.h"#include "src/Core/EigenBase.h"#include "src/Core/Assign.h"#include "src/Core/util/BlasUtil.h"#include "src/Core/DenseStorage.h"#include "src/Core/NestByValue.h"#include "src/Core/ForceAlignedAccess.h"#include "src/Core/ReturnByValue.h"#include "src/Core/NoAlias.h"#include "src/Core/PlainObjectBase.h"#include "src/Core/Matrix.h"#include "src/Core/Array.h"#include "src/Core/CwiseBinaryOp.h"#include "src/Core/CwiseUnaryOp.h"#include "src/Core/CwiseNullaryOp.h"#include "src/Core/CwiseUnaryView.h"#include "src/Core/SelfCwiseBinaryOp.h"#include "src/Core/Dot.h"#include "src/Core/StableNorm.h"#include "src/Core/MapBase.h"#include "src/Core/Stride.h"#include "src/Core/Map.h"#include "src/Core/Block.h"#include "src/Core/VectorBlock.h"#include "src/Core/Transpose.h"#include "src/Core/DiagonalMatrix.h"#include "src/Core/Diagonal.h"#include "src/Core/DiagonalProduct.h"#include "src/Core/PermutationMatrix.h"#include "src/Core/Transpositions.h"#include "src/Core/Redux.h"#include "src/Core/Visitor.h"#include "src/Core/Fuzzy.h"#include "src/Core/IO.h"#include "src/Core/Swap.h"#include "src/Core/CommaInitializer.h"#include "src/Core/Flagged.h"#include "src/Core/ProductBase.h"#include "src/Core/Product.h"#include "src/Core/TriangularMatrix.h"#include "src/Core/SelfAdjointView.h"#include "src/Core/SolveTriangular.h"#include "src/Core/products/Parallelizer.h"#include "src/Core/products/CoeffBasedProduct.h"#include "src/Core/products/GeneralBlockPanelKernel.h"#include "src/Core/products/GeneralMatrixVector.h"#include "src/Core/products/GeneralMatrixMatrix.h"#include "src/Core/products/GeneralMatrixMatrixTriangular.h"#include "src/Core/products/SelfadjointMatrixVector.h"#include "src/Core/products/SelfadjointMatrixMatrix.h"#include "src/Core/products/SelfadjointProduct.h"#include "src/Core/products/SelfadjointRank2Update.h"#include "src/Core/products/TriangularMatrixVector.h"#include "src/Core/products/TriangularMatrixMatrix.h"#include "src/Core/products/TriangularSolverMatrix.h"#include "src/Core/products/TriangularSolverVector.h"#include "src/Core/BandMatrix.h"#include "src/Core/BooleanRedux.h"#include "src/Core/Select.h"#include "src/Core/VectorwiseOp.h"#include "src/Core/Random.h"#include "src/Core/Replicate.h"#include "src/Core/Reverse.h"#include "src/Core/ArrayBase.h"#include "src/Core/ArrayWrapper.h"#include "src/Core/GlobalFunctions.h"#include <bitset>#include <sensor_msgs/PointField.h>#include <boost/type_traits/remove_all_extents.hpp>#include <boost/mpl/vector.hpp>#include <boost/mpl/is_sequence.hpp>#include <boost/mpl/begin_end.hpp>#include <boost/mpl/apply.hpp>#include <boost/mpl/next_prior.hpp>#include <boost/mpl/deref.hpp>#include <boost/mpl/identity.hpp>#include <boost/ref.hpp>#include <boost/aligned_storage.hpp>#include <boost/static_assert.hpp>#include <boost/type_traits/add_const.hpp>#include <boost/type_traits/add_volatile.hpp>#include <boost/type_traits/add_cv.hpp>#include <boost/type_traits/is_volatile.hpp>#include <boost/type_traits/remove_volatile.hpp>#include <boost/type_traits/remove_cv.hpp>#include <boost/type_traits/alignment_of.hpp>#include <boost/swap.hpp>#include <new>#include <boost/preprocessor/seq/for_each.hpp>#include <boost/preprocessor/seq/transform.hpp>#include <boost/preprocessor/repetition/repeat_from_to.hpp>#include <boost/type_traits/is_pod.hpp>#include <stddef.h>#include <boost/cstdint.hpp>#include <math.h>#include <pcl/point_cloud.h>#include <pcl/ros/point_traits.h>#include <sensor_msgs/PointCloud2.h>#include <boost/mpl/remove_if.hpp>#include <boost/mpl/contains.hpp>#include <boost/mpl/aux_/unwrap.hpp>#include "pcl/exceptions.h"#include <boost/foreach.hpp>#include <boost/mpl/size.hpp>#include <Eigen/Core>#include <Eigen/Geometry>#include <tf/transform_datatypes.h>#include <tf/transform_listener.h>#include <pcl/ros/conversions.h>#include <pcl/point_types.h>#include "geometry_msgs/Quaternion.h"#include <boost/scoped_ptr.hpp>#include <boost/thread/thread.hpp>#include <boost/thread/recursive_mutex.hpp>#include <ros/callback_queue.h>#include <boost/unordered_map.hpp>#include <visualization_msgs/MenuEntry.h>#include <interactive_markers/interactive_marker_server.h>#include <ros/package.h>#include <features.h>#include <libxml/xmlversion.h>#include <libxml/tree.h>#include <libxml/dict.h>#include <libxml/parser.h>#include <libxml/xmlregexp.h>#include <libxml/xmlerror.h>#include <libxml/xmlstring.h>#include <libxml/encoding.h>#include <libxml/globals.h>#include <stdlib.h>#include <libxml/xlink.h>#include <libxml/xmlmemory.h>#include <libxml/threads.h>#include <libxml/xmlIO.h>#include <libxml/list.h>#include <libxml/hash.h>#include <libxml/xpath.h>
Go to the source code of this file.
Classes | |
| struct | t_reference_frame |
Defines | |
| #define | PFLN {printf("FILE %s LINE %d\n",__FILE__, __LINE__);} |
Functions | |
| int | add_to_viz_markers_vec (std::vector< visualization_msgs::Marker > *marker_vec) |
| int | get_i_from_name (std::vector< boost::shared_ptr< t_reference_frame > > *v_rf, std::string name) |
| void | GetAttribute (xmlTextReaderPtr reader, const xmlChar *name, string &str) |
| Get the value of an attribute in a xml element. | |
| void | GetName (xmlTextReaderPtr reader, string &str) |
| Get the name of a xml element. | |
| void | GetValue (xmlTextReaderPtr reader, string &str) |
| Get the value of a xml element. | |
| int | main (int argc, char **argv) |
| void | make6DofMarker (bool fixed, std::string name, double x, double y, double z) |
| Marker | makeBox (InteractiveMarker &msg) |
| InteractiveMarkerControl & | makeBoxControl (InteractiveMarker &msg) |
| void | NodeHandler (xmlTextReaderPtr reader) |
| void | processFeedback (const visualization_msgs::InteractiveMarkerFeedbackConstPtr &feedback) |
| void | set_label_pos (double x, double y, double z, visualization_msgs::Marker *msg, std::vector< visualization_msgs::Marker > *marker_vec) |
Variables | |
| float | marker_pos = 0 |
| tf::TransformListener * | p_listener |
| boost::shared_ptr < interactive_markers::InteractiveMarkerServer > | server |
| std::vector< boost::shared_ptr < t_reference_frame > > | v_rf |
A example code just to show all the onboar reference systems in the atlascar.
Definition in file show_axes.cpp.
| #define PFLN {printf("FILE %s LINE %d\n",__FILE__, __LINE__);} |
Definition at line 62 of file show_axes.cpp.
| int add_to_viz_markers_vec | ( | std::vector< visualization_msgs::Marker > * | marker_vec | ) |
Definition at line 191 of file show_axes.cpp.
| int get_i_from_name | ( | std::vector< boost::shared_ptr< t_reference_frame > > * | v_rf, | |
| std::string | name | |||
| ) |
Definition at line 81 of file show_axes.cpp.
| void GetAttribute | ( | xmlTextReaderPtr | reader, | |
| const xmlChar * | name, | |||
| string & | str | |||
| ) |
Get the value of an attribute in a xml element.
This function reads the value of an attribute in the current xml element in the reader.
| reader | xmlTextReaderPtr pointing to the xml object | |
| name | name of the attribute to read | |
| str | variable that will store the value |
Definition at line 301 of file show_axes.cpp.
| void GetName | ( | xmlTextReaderPtr | reader, | |
| string & | str | |||
| ) |
Get the name of a xml element.
This function reads the name of the current xml element in the reader.
| reader | xmlTextReaderPtr pointing to the xml object | |
| str | variable that will store the name |
Definition at line 270 of file show_axes.cpp.
| void GetValue | ( | xmlTextReaderPtr | reader, | |
| string & | str | |||
| ) |
Get the value of a xml element.
This function reads the value of the current xml element in the reader.
| reader | xmlTextReaderPtr pointing to the xml object | |
| str | variable that will store the value |
Definition at line 285 of file show_axes.cpp.
| int main | ( | int | argc, | |
| char ** | argv | |||
| ) |
Definition at line 328 of file show_axes.cpp.
| void make6DofMarker | ( | bool | fixed, | |
| std::string | name, | |||
| double | x, | |||
| double | y, | |||
| double | z | |||
| ) |
Definition at line 219 of file show_axes.cpp.
| Marker makeBox | ( | InteractiveMarker & | msg | ) |
Definition at line 96 of file show_axes.cpp.
| InteractiveMarkerControl& makeBoxControl | ( | InteractiveMarker & | msg | ) |
Definition at line 132 of file show_axes.cpp.
| void NodeHandler | ( | xmlTextReaderPtr | reader | ) |
Definition at line 309 of file show_axes.cpp.
| void processFeedback | ( | const visualization_msgs::InteractiveMarkerFeedbackConstPtr & | feedback | ) |
Definition at line 111 of file show_axes.cpp.
| void set_label_pos | ( | double | x, | |
| double | y, | |||
| double | z, | |||
| visualization_msgs::Marker * | msg, | |||
| std::vector< visualization_msgs::Marker > * | marker_vec | |||
| ) |
Definition at line 141 of file show_axes.cpp.
| float marker_pos = 0 |
Definition at line 71 of file show_axes.cpp.
| tf::TransformListener* p_listener |
Definition at line 69 of file show_axes.cpp.
| boost::shared_ptr<interactive_markers::InteractiveMarkerServer> server |
Definition at line 70 of file show_axes.cpp.
| std::vector<boost::shared_ptr <t_reference_frame> > v_rf |
Definition at line 79 of file show_axes.cpp.