diff --git a/src/parsers/srdf.hpp b/src/parsers/srdf.hpp index f83d69bd7e342cc84da9cbf394a8ee75e003b5ce..67e6200067e7a9af626af197e6ec6b6f02667430 100644 --- a/src/parsers/srdf.hpp +++ b/src/parsers/srdf.hpp @@ -13,8 +13,6 @@ namespace pinocchio namespace srdf { -#ifdef PINOCCHIO_WITH_HPP_FCL - /// /// \brief Deactive all possible collision pairs mentioned in the SRDF file. /// It throws if the SRDF file is incorrect. @@ -44,8 +42,6 @@ namespace pinocchio const std::string & xmlString, const bool verbose = false); -#endif // ifdef PINOCCHIO_WITH_HPP_FCL - /// /// \brief Get the reference configurations of a given model associated to a SRDF file. /// It throws if the SRDF file is incorrect. The reference configurations are @@ -76,7 +72,6 @@ namespace pinocchio std::istream & xmlStream, const bool verbose = false); - /// /// \brief Load the rotor params of a given model associated to a SRDF file. /// It throws if the SRDF file is incorrect. diff --git a/src/parsers/srdf.hxx b/src/parsers/srdf.hxx index 552cbf9757fd3b67d8449ac656b00a6aeef6205d..4b6210dbbd28222a56eac8908905342bf98c25f2 100644 --- a/src/parsers/srdf.hxx +++ b/src/parsers/srdf.hxx @@ -23,8 +23,6 @@ namespace pinocchio { namespace srdf { - -#ifdef PINOCCHIO_WITH_HPP_FCL namespace details { template<typename Scalar, int Options, template<typename,int> class JointCollectionTpl> @@ -129,8 +127,6 @@ namespace pinocchio details::removeCollisionPairs(model, geom_model, srdf_stream, verbose); } -#endif // ifdef PINOCCHIO_WITH_HPP_FCL - template<typename Scalar, int Options, template<typename,int> class JointCollectionTpl> bool loadRotorParameters(ModelTpl<Scalar,Options,JointCollectionTpl> & model, const std::string & filename, @@ -210,8 +206,8 @@ namespace pinocchio typedef typename Model::ConfigVectorType ConfigVectorType; typedef boost::fusion::vector<const std::string&, - const ConfigVectorType&, - ConfigVectorType&> ArgsType; + const ConfigVectorType&, + ConfigVectorType&> ArgsType; template<typename JointModel> static void algo(const JointModelBase<JointModel> & joint, @@ -225,9 +221,9 @@ namespace pinocchio private: template<int axis> static void _algo (const JointModelRevoluteUnboundedTpl<Scalar,Options,axis> & joint, - const std::string& joint_name, - const ConfigVectorType& fromXML, - ConfigVectorType& config) + const std::string& joint_name, + const ConfigVectorType& fromXML, + ConfigVectorType& config) { typedef JointModelRevoluteUnboundedTpl<Scalar,Options,axis> JointModelRUB; PINOCCHIO_STATIC_ASSERT(JointModelRUB::NQ == 2, JOINT_MODEL_REVOLUTE_SHOULD_HAVE_2_PARAMETERS); @@ -235,16 +231,16 @@ namespace pinocchio std::cerr << "Could not read joint config (" << joint_name << " , " << fromXML.transpose() << ")" << std::endl; else { SINCOS(fromXML[0], - &config[joint.idx_q()+1], - &config[joint.idx_q()+0]); + &config[joint.idx_q()+1], + &config[joint.idx_q()+0]); } } template<typename JointModel> static void _algo (const JointModel & joint, - const std::string& joint_name, - const ConfigVectorType& fromXML, - ConfigVectorType& config) + const std::string& joint_name, + const ConfigVectorType& fromXML, + ConfigVectorType& config) { if (joint.nq() != fromXML.size()) std::cerr << "Could not read joint config (" << joint_name << " , " << fromXML.transpose() << ")" << std::endl;