nodelet的应用

1.创建一个包，如example_pkg

catkin_create_pkg  example_pkg

2.创建MyNodeletClass.h文件

cd ~/catkin_ws/src/example_pkg/

mkdir -p include/example_pkg

touch include/example_pkg/MyNodeletClass.h

vim include/example_pkg/MyNodeletClass.h
其内容为

#include <nodelet/nodelet.h>

namespace example_pkg

{

    class MyNodeletClass : public nodelet::Nodelet

    {

        public:

            virtual void onInit();

    };

}

3.创建MyNodeletClass.cpp文件

cd ~/catkin_ws/src/example_pkg/

mkdir src

touch src/MyNodeletClass.cpp

vim src/MyNodeletClass.cpp
其内容为

// this should really be in the implementation (.cpp file)

#include <ros/ros.h>

#include <pluginlib/class_list_macros.h>

#include <example_pkg/MyNodeletClass.h>

namespace example_pkg

{

    void MyNodeletClass::onInit()

    {

        NODELET_DEBUG("Initializing nodelet...");

        ROS_INFO("Nodelet is Ok for test!!");

    }

}

// watch the capitalization carefully

PLUGINLIB_DECLARE_CLASS(example_pkg, MyNodeletClass, example_pkg::MyNodeletClass, nodelet::Nodelet)
成功则输出"Nodelet is Ok for test!!"

4.创建nodelet_plugins.xml文件

cd ~/catkin_ws/src/example_pkg/

mkdir plugins

touch plugins/nodelet_plugins.xml

vim plugins/nodelet_plugins.xml
其内容为

<library path="lib/libexample_pkg">

  <class name="example_pkg/MyNodeletClass" type="example_pkg::MyNodeletClass" base_class_type="nodelet::Nodelet">

  <description>

  This is my nodelet.

  </description>

  </class>

</library>

5.修改package.xml文件，增加：

cd ~/catkin_ws/src/example_pkg/

vim package.xml
其内容为

 <buildtool_depend>catkin</buildtool_depend>

  <build_depend>nodelet</build_depend>

  <build_depend>roscpp</build_depend>

  <run_depend>nodelet</run_depend>

  <run_depend>roscpp</run_depend>

  <!-- The export tag contains other, unspecified, tags -->

  <export>

    <!-- Other tools can request additional information be placed here -->

    <nodelet plugin="${prefix}/plugins/nodelet_plugins.xml" />

  </export>

6.修改CMakeLists.txt

cd ~/catkin_ws/src/example_pkg

vim  CMakeLists.txt 

其内容为

## Specify additional locations of header files

## Your package locations should be listed before other locations

include_directories(

  include

  ${catkin_INCLUDE_DIRS}

  ${Boost_INCLUDE_DIRS}

)

## Declare a C++ library

add_library(${PROJECT_NAME}  src/MyNodeletClass.cpp)

add_dependencies(${PROJECT_NAME}

   ${${PROJECT_NAME}_EXPORTED_TARGETS}

   ${catkin_EXPORTED_TARGETS}

)

target_link_libraries(${PROJECT_NAME}

   ${catkin_LIBRARIES}

)

6.创建mynodelet.launch文件

d ~/catkin_ws/src/example_pkg/

mkdir launch

touch launch/mynodelet.launch

vim  launch/mynodelet.launch
其内容为

<launch>

  <node pkg="nodelet" type="nodelet" name="standalone_nodelet"  args="manager" output="screen"/>

  <node pkg="nodelet" type="nodelet" name="MyNodeletClass" args="load example_pkg/MyNodeletClass standalone_nodelet" output="screen">

  </node>

</launch>

6.编译

cd ~/catkin_ws/

catkin_make

rospack profile

7.运行

• 新终端，运行roscore

$ roscore

• 新终端，运行launch

$ rosluanch examples_pkg mynodelet.launch

参考：
http://www.ncnynl.com/archives/201702/1326.html
http://blog.csdn.net/zhangrelay/article/details/62048915
http://rosclub.cn/post-164.html
http://blog.csdn.net/yiranhaiziqi/article/details/53308657
http://www.lai18.com/content/2386868.html

例子

http://blog.csdn.net/zyh821351004/article/details/52143309
创建包nodelet_test,依赖项nodelet roscpp std_msgs

CMakeLists.txt

1. cmake_minimum_required(VERSION 2.8.3)
2. project(nodelet_test_pkg)
3. find_package(catkin REQUIRED COMPONENTS nodelet roscpp std_msgs)#
4. ## Setup include directories
5. include_directories(${catkin_INCLUDE_DIRS})
6. catkin_package(
7. )
8. add_library(nodelet_test plus.cpp)
9. target_link_libraries(nodelet_test ${catkin_LIBRARIES})

package.xml

1. <package>
2. <name>nodelet_test_pkg</name>
3. <version>0.0.0</version>
4. <description>Nodelet test.</description>
5. <maintainer email="[email protected]">kint zhao</maintainer>
6. <license>BSD</license>
7. <buildtool_depend>catkin</buildtool_depend>
8. <build_depend>nodelet</build_depend>
9. <build_depend>roscpp</build_depend>
10. <build_depend>std_msgs</build_depend>
11. <run_depend>nodelet</run_depend>
12. <run_depend>roscpp</run_depend>
13. <run_depend>std_msgs</run_depend>
14. <export>
15. <nodelet plugin="${prefix}/nodelet_test_plugin.xml"/>
16. </export>
17. </package>

plugin

1. <library path="lib/libnodelet_test_lib">
2. <class name="nodelet_ns/Plus" type="nodelet_ns::Plus" base_class_type="nodelet::Nodelet">
3. <description>
4. A node to add a value and republish.
5. </description>
6. </class>
7. </library>

launch

1. <launch>
2. <node pkg="nodelet" type="nodelet" name="manager_1"  args="manager" output="screen"/>
3. <node pkg="nodelet" type="nodelet" name="test1" args="load nodelet_ns/Plus manager_1" output="screen"/>
4. <node pkg="nodelet" type="nodelet" name="test2" args="load nodelet_ns/Plus manager_1" output="screen"/>
5. <node pkg="nodelet" type="nodelet" name="test3" args="load nodelet_ns/Plus manager_1" output="screen"/>
6. <node pkg="nodelet" type="nodelet" name="manager_2"  args="manager" output="screen"/>
7. <node pkg="nodelet" type="nodelet" name="test4" args="load nodelet_ns/Plus manager_2" output="screen"/>
8. <node pkg="nodelet" type="nodelet" name="test5" args="load nodelet_ns/Plus manager_2" output="screen"/>
9. <node pkg="nodelet" type="nodelet" name="test6" args="standalone nodelet_ns/Plus " output="screen"/>
10. </launch>

.cpp文件

1. #include <pluginlib/class_list_macros.h>
2. #include <nodelet/nodelet.h>
3. #include <ros/ros.h>
4. #include <std_msgs/Float64.h>
5. #include <stdio.h>
6. #include <math.h> //fabs
7. namespace nodelet_ns
8. {
9. class Plus : public nodelet::Nodelet
10. {
11. public:
12. Plus()
13. : value_(0)
14. {}
15. private:
16. virtual void onInit()
17. {
18. ros::NodeHandle& private_nh = getPrivateNodeHandle();
19. private_nh.getParam("value", value_);
20. pub = private_nh.advertise<std_msgs::Float64>("out", 10);
21. sub = private_nh.subscribe("in", 10, &Plus::callback, this);
22. }
23. void callback(const std_msgs::Float64::ConstPtr& input)
24. {
25. std_msgs::Float64Ptr output(new std_msgs::Float64());
26. output->data = input->data + value_;
27. NODELET_DEBUG("Adding %f to get %f", value_, output->data);
28. pub.publish(output);
29. }
30. ros::Publisher pub;
31. ros::Subscriber sub;
32. double value_;
33. };
34. PLUGINLIB_DECLARE_CLASS(nodelet_ns, Plus, nodelet_ns::Plus, nodelet::Nodelet);//*******
35. }