niklas/rclcpp
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

hide static typesupport headers

Browse source
This commit is contained in:
Dirk Thomas 2014-08-07 14:38:38 -07:00
parent 17ef4a3de2
commit a0757ed0b4
7 changed files with 46 additions and 14 deletions
Download patch file Download diff file Expand all files Collapse all files

14
ros_dds_connext_dynamic/CMakeLists.txt
View file

@ -7,8 +7,17 @@ find_package(ros_middleware_interface REQUIRED)
find_package(rosidl_generator_cpp REQUIRED)
find_package(ndds_cpp REQUIRED)
set(CONNEXT_INCLUDE_DIRS ${ndds_cpp_INCLUDE_DIRS})
set(CONNEXT_LIBRARIES ${ndds_cpp_LIBRARIES})
#set(CONNEXT_INCLUDE_DIRS ${ndds_cpp_INCLUDE_DIRS})
set(CONNEXT_INCLUDE_DIRS
"/home/dthomas/RTI/ndds.5.1.0/include/ndds"
"/home/dthomas/RTI/ndds.5.1.0/include"
)
#set(CONNEXT_LIBRARIES ${ndds_cpp_LIBRARIES})
set(CONNEXT_LIBRARIES
"/home/dthomas/RTI/ndds.5.1.0/lib/x64Linux2.6gcc4.4.5/libnddscppz.a"
"/home/dthomas/RTI/ndds.5.1.0/lib/x64Linux2.6gcc4.4.5/libnddscz.a"
"/home/dthomas/RTI/ndds.5.1.0/lib/x64Linux2.6gcc4.4.5/libnddscorez.a"
)
set(CONNEXT_DEFINITIONS ${ndds_cpp_DEFINITIONS})
@ -24,6 +33,7 @@ ament_export_libraries(ros_dds_connext_dynamic dl pthread)
ament_package()
include_directories(${ros_middleware_interface_INCLUDE_DIRS} ${rosidl_generator_cpp_INCLUDE_DIRS} ${CONNEXT_INCLUDE_DIRS})
link_directories("/home/dthomas/RTI/ndds.5.1.0/lib/x64Linux2.6gcc4.4.5")
add_definitions(${CONNEXT_DEFINITIONS})
add_library(ros_dds_connext_dynamic SHARED src/functions.cpp)
target_link_libraries(ros_dds_connext_dynamic ${std_msgs_LIBRARIES} ${CONNEXT_LIBRARIES})

17
ros_dds_connext_dynamic/src/functions.cpp
View file

@ -10,7 +10,7 @@
namespace ros_middleware_interface
{
const char * _rti_connext_identifier = "connext_dynamic";
const char * _rti_connext_dynamic_identifier = "connext_dynamic";
ros_middleware_interface::NodeHandle create_node()
{
@ -37,7 +37,7 @@ ros_middleware_interface::NodeHandle create_node()
std::cout << " create_node() pass opaque node handle" << std::endl;
ros_middleware_interface::NodeHandle node_handle = {
_rti_connext_identifier,
_rti_connext_dynamic_identifier,
participant
};
return node_handle;
@ -55,7 +55,7 @@ ros_middleware_interface::PublisherHandle create_publisher(const ros_middleware_
{
std::cout << "create_publisher()" << std::endl;
if (node_handle._implementation_identifier != _rti_connext_identifier)
if (node_handle._implementation_identifier != _rti_connext_dynamic_identifier)
{
printf("node handle not from this implementation\n");
printf("but from: %s\n", node_handle._implementation_identifier);
@ -67,6 +67,13 @@ ros_middleware_interface::PublisherHandle create_publisher(const ros_middleware_
std::cout << " create_publisher() extract participant from opaque node handle" << std::endl;
DDSDomainParticipant* participant = (DDSDomainParticipant*)node_handle._data;
if (type_support_handle._implementation_identifier != ros_dds_cpp_dynamic_typesupport::_dynamic_identifier)
{
printf("type support not from this implementation\n");
printf("but from: %s\n", type_support_handle._implementation_identifier);
throw std::runtime_error("type support not from this implementation");
}
ros_dds_cpp_dynamic_typesupport::MessageTypeSupportMembers * members = (ros_dds_cpp_dynamic_typesupport::MessageTypeSupportMembers*)type_support_handle._data;
std::string type_name = std::string(members->_package_name) + "/" + members->_message_name;
@ -177,7 +184,7 @@ ros_middleware_interface::PublisherHandle create_publisher(const ros_middleware_
custom_publisher_info->dynamic_data = dynamic_data;
ros_middleware_interface::PublisherHandle publisher_handle = {
_rti_connext_identifier,
_rti_connext_dynamic_identifier,
custom_publisher_info
};
return publisher_handle;
@ -188,7 +195,7 @@ void publish(const ros_middleware_interface::PublisherHandle& publisher_handle,
//std::cout << "publish()" << std::endl;
if (publisher_handle._implementation_identifier != _rti_connext_identifier)
if (publisher_handle._implementation_identifier != _rti_connext_dynamic_identifier)
{
printf("publisher handle not from this implementation\n");
printf("but from: %s\n", publisher_handle._implementation_identifier);