bkinnightskytw
/
kdl_parser
mirror of https://github.com/existedinnettw/kdl_parser.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

feat: support basic conan build

This commit is contained in:
insleker 2025-05-27 12:29:59 +08:00
parent 7bdfb82e6b
commit 42a8fd2d45
5 changed files with 306 additions and 154 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
.gitignore vendored Normal file
View File

@ -0,0 +1,2 @@
build/
*Presets.json

183
kdl_parser/CMakeLists.txt
View File

@ -3,100 +3,139 @@ cmake_minimum_required(VERSION 3.7.2)
project(kdl_parser) project(kdl_parser)
set(CMAKE_CXX_STANDARD 17) set(CMAKE_CXX_STANDARD 17)
set(CMAKE_CXX_STANDARD_REQUIRED ON)
find_package(catkin QUIET
COMPONENTS rosconsole cmake_modules
)
if(NOT catkin_FOUND)
# use local copies of FindTinyXML.cmake and FindTinyXML2.cmake from
# 'cmake_modules' (https://github.com/ros/cmake_modules)
list(APPEND CMAKE_MODULE_PATH ${CMAKE_CURRENT_LIST_DIR}/cmake)
endif()
find_package(urdfdom REQUIRED)
include_directories(${urdfdom_INCLUDE_DIRS})
find_package(orocos_kdl REQUIRED)
find_package(TinyXML REQUIRED)
find_package(TinyXML2 REQUIRED)
# check for rosconsole
# We check additionally for catkin to distinguish between an "official" ROS distribution
# and the one provided in the distribution's repository.
find_package(rosconsole QUIET)
if(rosconsole_FOUND AND catkin_FOUND)
add_definitions(-DHAS_ROS)
endif()
find_package(urdf QUIET)
if(urdf_FOUND)
add_definitions(-DHAS_URDF)
include_directories(${urdf_INCLUDE_DIRS})
endif()
include_directories(include ${orocos_kdl_INCLUDE_DIRS} ${TinyXML_INCLUDE_DIRS} ${TinyXML2_INCLUDE_DIRS})
find_package(catkin QUIET COMPONENTS rosconsole cmake_modules)
if(catkin_FOUND) if(catkin_FOUND)
find_package(urdfdom REQUIRED)
include_directories(${urdfdom_INCLUDE_DIRS})
find_package(orocos_kdl REQUIRED)
find_package(TinyXML REQUIRED)
find_package(TinyXML2 REQUIRED)
# check for rosconsole We check additionally for catkin to distinguish between
# an "official" ROS distribution and the one provided in the distribution's
# repository.
find_package(rosconsole QUIET)
if(rosconsole_FOUND)
add_definitions(-DHAS_ROS)
endif()
find_package(urdf QUIET)
if(urdf_FOUND)
add_definitions(-DHAS_URDF)
include_directories(${urdf_INCLUDE_DIRS})
endif()
include_directories(include ${orocos_kdl_INCLUDE_DIRS}
${TinyXML_INCLUDE_DIRS} ${TinyXML2_INCLUDE_DIRS})
link_directories(${catkin_LIBRARY_DIRS}) link_directories(${catkin_LIBRARY_DIRS})
include_directories(${catkin_INCLUDE_DIRS}) include_directories(${catkin_INCLUDE_DIRS})
catkin_package( catkin_package(
LIBRARIES ${PROJECT_NAME} ${orocos_kdl_LIBRARIES} LIBRARIES
INCLUDE_DIRS include ${PROJECT_NAME}
CATKIN_DEPENDS rosconsole urdf ${orocos_kdl_LIBRARIES}
DEPENDS orocos_kdl TinyXML TinyXML2 INCLUDE_DIRS
) include
endif() CATKIN_DEPENDS
rosconsole
urdf
DEPENDS
orocos_kdl
TinyXML
TinyXML2)
add_library(${PROJECT_NAME} SHARED src/kdl_parser.cpp) add_library(${PROJECT_NAME} SHARED src/kdl_parser.cpp)
target_link_libraries(${PROJECT_NAME} target_link_libraries(${PROJECT_NAME} ${TinyXML_LIBRARIES}
${TinyXML_LIBRARIES} ${TinyXML2_LIBRARIES} ${orocos_kdl_LIBRARIES} ${TinyXML2_LIBRARIES} ${orocos_kdl_LIBRARIES})
)
target_link_libraries(${PROJECT_NAME} ${urdfdom_LIBRARIES}) target_link_libraries(${PROJECT_NAME} ${urdfdom_LIBRARIES})
if(catkin_FOUND)
target_link_libraries(${PROJECT_NAME} ${catkin_LIBRARIES}) target_link_libraries(${PROJECT_NAME} ${catkin_LIBRARIES})
endif()
if(urdf_FOUND) if(urdf_FOUND)
target_link_libraries(${PROJECT_NAME} ${urdf_LIBRARIES}) target_link_libraries(${PROJECT_NAME} ${urdf_LIBRARIES})
endif() endif()
if(WIN32) if(WIN32)
target_compile_definitions(${PROJECT_NAME} PRIVATE "KDL_PARSER_BUILDING_DLL") target_compile_definitions(${PROJECT_NAME}
endif() PRIVATE "KDL_PARSER_BUILDING_DLL")
endif()
add_executable(check_kdl_parser src/check_kdl_parser.cpp ) add_executable(check_kdl_parser src/check_kdl_parser.cpp)
target_link_libraries(check_kdl_parser ${PROJECT_NAME}) target_link_libraries(check_kdl_parser ${PROJECT_NAME})
if(catkin_FOUND AND CATKIN_ENABLE_TESTING) if(CATKIN_ENABLE_TESTING)
find_package(catkin REQUIRED COMPONENTS roscpp rostest) find_package(catkin REQUIRED COMPONENTS roscpp rostest)
add_rostest_gtest(test_kdl_parser test/test_kdl_parser.launch test/test_kdl_parser.cpp ) add_rostest_gtest(test_kdl_parser test/test_kdl_parser.launch
target_link_libraries(test_kdl_parser ${PROJECT_NAME}) test/test_kdl_parser.cpp)
target_link_libraries(test_kdl_parser ${PROJECT_NAME})
add_rostest_gtest(test_inertia_rpy test/test_inertia_rpy.launch test/test_inertia_rpy.cpp ) add_rostest_gtest(test_inertia_rpy test/test_inertia_rpy.launch
target_link_libraries(test_inertia_rpy ${PROJECT_NAME}) test/test_inertia_rpy.cpp)
endif() target_link_libraries(test_inertia_rpy ${PROJECT_NAME})
endif()
if(catkin_FOUND)
# How does CATKIN do this? # How does CATKIN do this?
#rosbuild_add_rostest(${PROJECT_SOURCE_DIR}/test/test_kdl_parser.launch) # rosbuild_add_rostest(${PROJECT_SOURCE_DIR}/test/test_kdl_parser.launch)
# Install library # Install library
install(TARGETS ${PROJECT_NAME} install(
TARGETS ${PROJECT_NAME}
ARCHIVE DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION} ARCHIVE DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION}
LIBRARY DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION} LIBRARY DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION}
RUNTIME DESTINATION ${CATKIN_GLOBAL_BIN_DESTINATION}) RUNTIME DESTINATION ${CATKIN_GLOBAL_BIN_DESTINATION})
install(DIRECTORY include/${PROJECT_NAME}/ install(DIRECTORY include/${PROJECT_NAME}/
DESTINATION ${CATKIN_PACKAGE_INCLUDE_DESTINATION}) DESTINATION ${CATKIN_PACKAGE_INCLUDE_DESTINATION})
else() else()
install(TARGETS ${PROJECT_NAME}
LIBRARY DESTINATION lib find_package(urdfdom CONFIG REQUIRED)
ARCHIVE DESTINATION lib) find_package(orocos-kdl CONFIG REQUIRED)
install(DIRECTORY include/${PROJECT_NAME}/ find_package(tinyxml REQUIRED CONFIG)
DESTINATION include) find_package(tinyxml2 REQUIRED CONFIG)
add_library(${PROJECT_NAME} src/kdl_parser.cpp)
if(WIN32)
set(BUILD_SHARED_LIBS ON)
target_compile_definitions(${PROJECT_NAME} PUBLIC "KDL_PARSER_BUILDING_DLL")
endif()
target_include_directories(
${PROJECT_NAME}
PUBLIC $<BUILD_INTERFACE:${CMAKE_CURRENT_SOURCE_DIR}/include>
$<INSTALL_INTERFACE:include>)
target_link_libraries(
${PROJECT_NAME} PUBLIC urdfdom::urdfdom orocos-kdl::orocos-kdl
tinyxml::tinyxml tinyxml2::tinyxml2)
if(NOT BUILD_TESTING STREQUAL OFF)
enable_testing()
find_package(GTest REQUIRED)
include_directories(${GTEST_INCLUDE_DIRS})
include(GoogleTest)
add_executable(test_kdl_parser test/test_kdl_parser.launch
test/test_kdl_parser.cpp)
target_compile_definitions(
test_kdl_parser
PRIVATE ROBOT_URDF="${CMAKE_CURRENT_SOURCE_DIR}/test/test_robot.urdf")
target_link_libraries(test_kdl_parser ${PROJECT_NAME} GTest::gtest_main)
gtest_add_tests(TARGET test_kdl_parser)
add_executable(test_inertia_rpy test/test_inertia_rpy.launch
test/test_inertia_rpy.cpp)
target_compile_definitions(
test_inertia_rpy
PRIVATE
RPY_URDF1="${CMAKE_CURRENT_SOURCE_DIR}/test/testInertiaRPYmodel1.urdf"
RPY_URDF2="${CMAKE_CURRENT_SOURCE_DIR}/test/testInertiaRPYmodel2.urdf")
target_link_libraries(test_inertia_rpy ${PROJECT_NAME} GTest::gtest_main)
gtest_add_tests(TARGET test_inertia_rpy)
endif()
endif() endif()

75
kdl_parser/conanfile.py Normal file
View File

@ -0,0 +1,75 @@
from conan import ConanFile
from conan.tools.cmake import CMakeToolchain, CMake, cmake_layout, CMakeDeps
from conan.tools.build import check_min_cppstd, can_run
from conan.errors import ConanInvalidConfiguration
class kdl_parserRecipe(ConanFile):
name = "kdl_parser"
version = "2.12.1"
package_type = "library"
license = ""
author = "orocos ()"
url = ""
description = " kdl_parser and kdl_parser_py provide tools to construct a KDL tree from an XML robot representation in URDF."
topics = ("KDL", "URDF", "parser")
settings = "os", "compiler", "build_type", "arch"
options = {
"shared": [True, False],
"fPIC": [True, False],
}
default_options = {"shared": False, "fPIC": True}
exports_sources = (
"CMakeLists.txt",
"src/*",
"tests/*",
"include/*",
)
def requirements(self):
self.requires("orocos-kdl/[>=1.5.1 <2]")
self.requires("tinyxml/[>=2.6.0 <3]")
self.requires("tinyxml2/[>=11.0.0 <13.0.0]")
self.requires("urdfdom/[>=3.1.1 <5.0.0]")
self.requires("urdfdom_headers/[>=1.1.1 <2]")
self.tool_requires("cmake/[>=3.12 <5]")
self.test_requires("gtest/[>=1.11]")
def validate(self):
check_min_cppstd(self, "14")
def config_options(self):
if self.settings.os == "Windows":
self.options.rm_safe("fPIC")
def configure(self):
if self.settings.os == "Windows" and not self.options.shared:
raise ConanInvalidConfiguration(
"Static libraries are not supported on Windows. Please set option 'shared=True'."
)
if self.options.shared:
self.options.rm_safe("fPIC")
def layout(self):
cmake_layout(self)
def generate(self):
deps = CMakeDeps(self)
deps.generate()
tc = CMakeToolchain(self)
tc.generate()
def build(self):
cmake = CMake(self)
cmake.configure()
cmake.build()
def package(self):
cmake = CMake(self)
cmake.install()
def package_info(self):
self.cpp_info.libs = ["kdl_parser"]

102
kdl_parser/test/test_inertia_rpy.cpp
View File

@ -1,36 +1,36 @@
/********************************************************************* /*********************************************************************
* Software License Agreement (BSD License) * Software License Agreement (BSD License)
* *
* Copyright (c) 2015 Open Source Robotics Foundation, Inc. * Copyright (c) 2015 Open Source Robotics Foundation, Inc.
* All rights reserved. * All rights reserved.
* *
* Redistribution and use in source and binary forms, with or without * Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions * modification, are permitted provided that the following conditions
* are met: * are met:
* *
* * Redistributions of source code must retain the above copyright * * Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer. * notice, this list of conditions and the following disclaimer.
* * Redistributions in binary form must reproduce the above * * Redistributions in binary form must reproduce the above
* copyright notice, this list of conditions and the following * copyright notice, this list of conditions and the following
* disclaimer in the documentation and/or other materials provided * disclaimer in the documentation and/or other materials provided
* with the distribution. * with the distribution.
* * Neither the name of the copyright holder nor the names of its * * Neither the name of the copyright holder nor the names of its
* contributors may be used to endorse or promote products derived * contributors may be used to endorse or promote products derived
* from this software without specific prior written permission. * from this software without specific prior written permission.
* *
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
* CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE. * POSSIBILITY OF SUCH DAMAGE.
*********************************************************************/ *********************************************************************/
/* Author: Jackie Kay */ /* Author: Jackie Kay */
@ -41,12 +41,19 @@
#include <kdl/jntarray.hpp> #include <kdl/jntarray.hpp>
#include <kdl/chainidsolver_recursive_newton_euler.hpp> #include <kdl/chainidsolver_recursive_newton_euler.hpp>
#include <ros/ros.h>
#include <ros/console.h>
#include "kdl_parser/kdl_parser.hpp" #include "kdl_parser/kdl_parser.hpp"
#ifdef HAS_ROS
#include <ros/ros.h>
#else
// forward ROS warnings and errors to stderr
#define ROS_DEBUG(...) fprintf(stdout, __VA_ARGS__);
#define ROS_ERROR(...) fprintf(stderr, __VA_ARGS__);
#define ROS_WARN(...) fprintf(stderr, __VA_ARGS__);
#endif
int g_argc; int g_argc;
char ** g_argv; char **g_argv;
class TestInertiaRPY : public testing::Test class TestInertiaRPY : public testing::Test
{ {
@ -63,11 +70,11 @@ protected:
} }
}; };
TEST_F(TestInertiaRPY, test_torques)
TEST_F(TestInertiaRPY, test_torques) { {
// workaround for segfault issue with parsing 2 trees instantiated on the stack // workaround for segfault issue with parsing 2 trees instantiated on the stack
KDL::Tree * tree_1 = new KDL::Tree; KDL::Tree *tree_1 = new KDL::Tree;
KDL::Tree * tree_2 = new KDL::Tree; KDL::Tree *tree_2 = new KDL::Tree;
KDL::JntArray torques_1; KDL::JntArray torques_1;
KDL::JntArray torques_2; KDL::JntArray torques_2;
@ -112,13 +119,24 @@ TEST_F(TestInertiaRPY, test_torques) {
SUCCEED(); SUCCEED();
} }
int main(int argc, char ** argv) int main(int argc, char **argv)
{ {
testing::InitGoogleTest(&argc, argv); testing::InitGoogleTest(&argc, argv);
ros::init(argc, argv, "test_kdl_parser"); #ifdef HAS_ROS
for (size_t i = 0; i < argc; ++i) { ros::init(argc, argv, "test_inertia_rpy");
#endif
for (size_t i = 0; i < argc; ++i)
{
std::cout << argv[i] << std::endl; std::cout << argv[i] << std::endl;
} }
if (argc < 3)
{
static const char *default_argv[] = {argv[0], RPY_URDF1, RPY_URDF2};
argc = 3;
argv = const_cast<char **>(default_argv);
}
g_argc = argc; g_argc = argc;
g_argv = argv; g_argv = argv;
return RUN_ALL_TESTS(); return RUN_ALL_TESTS();

98
kdl_parser/test/test_kdl_parser.cpp
View File

@ -1,45 +1,53 @@
/********************************************************************* /*********************************************************************
* Software License Agreement (BSD License) * Software License Agreement (BSD License)
* *
* Copyright (c) 2008, Willow Garage, Inc. * Copyright (c) 2008, Willow Garage, Inc.
* All rights reserved. * All rights reserved.
* *
* Redistribution and use in source and binary forms, with or without * Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions * modification, are permitted provided that the following conditions
* are met: * are met:
* *
* * Redistributions of source code must retain the above copyright * * Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer. * notice, this list of conditions and the following disclaimer.
* * Redistributions in binary form must reproduce the above * * Redistributions in binary form must reproduce the above
* copyright notice, this list of conditions and the following * copyright notice, this list of conditions and the following
* disclaimer in the documentation and/or other materials provided * disclaimer in the documentation and/or other materials provided
* with the distribution. * with the distribution.
* * Neither the name of the Willow Garage nor the names of its * * Neither the name of the Willow Garage nor the names of its
* contributors may be used to endorse or promote products derived * contributors may be used to endorse or promote products derived
* from this software without specific prior written permission. * from this software without specific prior written permission.
* *
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
* CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE. * POSSIBILITY OF SUCH DAMAGE.
*********************************************************************/ *********************************************************************/
/* Author: Wim Meeussen */ /* Author: Wim Meeussen */
#include <gtest/gtest.h> #include <gtest/gtest.h>
#include <ros/ros.h>
#include "kdl_parser/kdl_parser.hpp" #include "kdl_parser/kdl_parser.hpp"
#ifdef HAS_ROS
#include <ros/ros.h>
#else
// forward ROS warnings and errors to stderr
#define ROS_DEBUG(...) fprintf(stdout, __VA_ARGS__);
#define ROS_ERROR(...) fprintf(stderr, __VA_ARGS__);
#define ROS_WARN(...) fprintf(stderr, __VA_ARGS__);
#endif
int g_argc; int g_argc;
char ** g_argv; char **g_argv;
class TestParser : public testing::Test class TestParser : public testing::Test
{ {
@ -58,9 +66,10 @@ protected:
} }
}; };
TEST_F(TestParser, test)
TEST_F(TestParser, test) { {
for (int i = 1; i < g_argc - 2; i++) { for (int i = 1; i < g_argc - 2; i++)
{
ROS_ERROR("Testing file %s", g_argv[i]); ROS_ERROR("Testing file %s", g_argv[i]);
ASSERT_FALSE(kdl_parser::treeFromFile(g_argv[i], my_tree)); ASSERT_FALSE(kdl_parser::treeFromFile(g_argv[i], my_tree));
} }
@ -72,15 +81,24 @@ TEST_F(TestParser, test) {
ASSERT_EQ((unsigned int)1, my_tree.getRootSegment()->second.children.size()); ASSERT_EQ((unsigned int)1, my_tree.getRootSegment()->second.children.size());
ASSERT_TRUE(my_tree.getSegment("base_link")->second.parent == my_tree.getRootSegment()); ASSERT_TRUE(my_tree.getSegment("base_link")->second.parent == my_tree.getRootSegment());
ASSERT_EQ(10.0, my_tree.getSegment("base_link")->second.segment.getInertia().getMass()); ASSERT_EQ(10.0, my_tree.getSegment("base_link")->second.segment.getInertia().getMass());
ASSERT_NEAR(1.000, my_tree.getSegment( ASSERT_NEAR(1.000, my_tree.getSegment("base_link")->second.segment.getInertia().getRotationalInertia().data[0], 0.001);
"base_link")->second.segment.getInertia().getRotationalInertia().data[0], 0.001);
SUCCEED(); SUCCEED();
} }
int main(int argc, char ** argv) int main(int argc, char **argv)
{ {
testing::InitGoogleTest(&argc, argv); testing::InitGoogleTest(&argc, argv);
#ifdef HAS_ROS
ros::init(argc, argv, "test_kdl_parser"); ros::init(argc, argv, "test_kdl_parser");
#endif
if (argc < 2)
{
static const char *default_argv[] = {argv[0], ROBOT_URDF};
argc = 2;
argv = const_cast<char **>(default_argv);
}
g_argc = argc; g_argc = argc;
g_argv = argv; g_argv = argv;
return RUN_ALL_TESTS(); return RUN_ALL_TESTS();