Question

Hi everyone, I'm trying to get an older project working again. There I have an subscriber which saves the data to a file unfortunately the callback function isnt called. The rqt_graph showes, that there are the right connections and even messages are published image description

The project is quite large so I hope i have everything included here.

TestNode.cpp:

#include <ros/ros.h>
#include "utils/Log.h"
#include "guidance/Test.h"

int main(int argc, char** argv){
// Init ROS
ros::init( argc, argv, "paramIdent" );

// Create ROS node
l_inf( "Creating ROS node... " );
ros::NodeHandle node( "/cause/guidupdate" );

// Creating datarecorder
l_inf( "Creating datarecorder..." );
cause::Test recordData( &node );

// Loop
l_inf( "Processing..." );
while(ros::ok()) ros::spinOnce();

l_inf( "Done." );
return 0;

}

Test.cpp

#include "utils/Log.h"
#include "cause_msgs/Deviation.h"
#include "utils/Timestamp.h"
#include "guidance/Test.h"
#include "utils/PoseSE3.h"

#include <thread>
#include <future>
#include <math.h>
#include <memory>
#include <geometry_msgs/Point.h>
#include <geometry_msgs/Quaternion.h>
#include <geometry_msgs/TwistStamped.h>
#include <geometry_msgs/PoseStamped.h>
#include <std_msgs/Bool.h>

namespace cause {


Test::Test(ros::NodeHandle *node) :
m_node(node) {
m_controlSub = m_node->subscribe("/RosAria/cmd_vel", 1000, &Test::GetControlCallback, this);
m_odomSub = m_node->subscribe("/RosAria/pose", 1000, &Test::GetOdometryCallback, this);
l_inf("Setup completed");
}

void Test::GetControlCallback(const geometry_msgs::TwistConstPtr &control) 
{
l_inf("Entering Callback");
}

void Test::GetOdometryCallback(const nav_msgs::OdometryConstPtr &odometry) 
{
l_inf("Entering Odometry Callback");
}

UPDATE

RecordData.launch

<launch>
    <node pkg="cause" type="TestNode" name="recordmodeldata" /> 
</launch>

.

rostopic echo /RosAria/cmd_vel
linear:
  x: 0.7
  y: 0.0
  z: 0.0    
angular:
  x: 0.0
  y: 0.0
  z: -0.5
---
linear:
  x: 0.7
  y: 0.0
  z: 0.0
angular:
  x: 0.0
  y: 0.0
  z: -0.5
---
....

Asked by eed on 2020-08-21 04:27:06 UTC

Subscriber callback function isn't called

Comments

Answers