00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035 #include "ros/node.h"
00036 #include <string>
00037 #include <map>
00038
00039 #include "rosrecord/Player.h"
00040 #include "rosrecord/AnyMsg.h"
00041 #include "std_msgs/String.h"
00042
00043 using namespace std;
00044
00045 void all_handler(string name, ros::Message* m, ros::Time t, ros::Time t_no_use, void* n)
00046 {
00047 int* counter = (int*)(n);
00048
00049 cout << "all_handler saw a message named " << name << " with datatype: " << m->__getDataType() << " Count at: " << (*counter)++ << endl;
00050 }
00051
00052 void string_handler(string name, std_msgs::String* str, ros::Time t, ros::Time t_no_use, void* n)
00053 {
00054 cout << "string_handler saw a message named " << name << " with datatype: " << str->__getDataType() << " and value: " << str->data << endl;
00055 }
00056
00057 class Handler
00058 {
00059 public:
00060 int counter;
00061
00062 Handler() : counter(0) {}
00063
00064 void all_handler(string name, ros::Message* m, ros::Time t, ros::Time t_no_use, void* n)
00065 {
00066 cout << "Handler::all_handler saw a message named " << name << " with datatype: " << m->__getDataType() << " Count at: " << counter++ << endl;
00067 }
00068
00069 void string_handler(string name, std_msgs::String* str, ros::Time t, ros::Time t_no_use, void* n)
00070 {
00071 cout << "Handler::string_handler saw a message named " << name << " with datatype: " << str->__getDataType() << " and value: " << str->data << endl;
00072 }
00073 };
00074
00075 int main(int argc, char **argv)
00076 {
00077 if (argc != 2)
00078 {
00079 cout << endl << "usage:" << endl << " demo BAG" << endl;
00080 return 1;
00081 }
00082
00083 ros::record::Player player;
00084 Handler handler;
00085
00086 int counter = 0;
00087
00088 if (player.open(string(argv[1]), ros::Time()))
00089 {
00090 player.addHandler<AnyMsg>(string("*"), &all_handler, &counter, false);
00091 player.addHandler<std_msgs::String>(string("chatter"), &string_handler, NULL);
00092 player.addHandler<AnyMsg>(string("babble"), &Handler::all_handler, &handler, &counter, false);
00093 player.addHandler<std_msgs::String>(string("*"), &Handler::string_handler, &handler, NULL);
00094 }
00095
00096 while(player.nextMsg())
00097 {
00098 }
00099
00100 return 0;
00101 }