Skip to content
Snippets Groups Projects
Commit 5ab3c6e6 authored by Sergi Hernandez's avatar Sergi Hernandez
Browse files

Chnaged the NodeHandler used to publish depending on wether a nodelet is used or not.

parent b3215d9d
No related branches found
No related tags found
1 merge request!4Filtered localization
...@@ -9,7 +9,6 @@ IrFootSensorDriverNode::IrFootSensorDriverNode(ros::NodeHandle &nh) : ...@@ -9,7 +9,6 @@ IrFootSensorDriverNode::IrFootSensorDriverNode(ros::NodeHandle &nh) :
this->loop_rate_ = 10;//in [Hz] this->loop_rate_ = 10;//in [Hz]
// [init publishers] // [init publishers]
this->sensor_data_publisher_ = this->node_handle_.advertise<humanoid_common_msgs::ir_foot_data>("sensor_data", 1);
// [init subscribers] // [init subscribers]
...@@ -38,6 +37,11 @@ IrFootSensorDriverNode::IrFootSensorDriverNode(ros::NodeHandle &nh) : ...@@ -38,6 +37,11 @@ IrFootSensorDriverNode::IrFootSensorDriverNode(ros::NodeHandle &nh) :
this->driver_.set_dynamixel_baudrate(dyn_baudrate); this->driver_.set_dynamixel_baudrate(dyn_baudrate);
this->node_handle_.getParam("ir_foot_id",dev_id); this->node_handle_.getParam("ir_foot_id",dev_id);
this->driver_.set_device_id(dev_id); this->driver_.set_device_id(dev_id);
if(dyn_serial!="" && dyn_baudrate!=-1 && dev_id!=-1)
this->sensor_data_publisher_ = this->node_handle_.advertise<humanoid_common_msgs::ir_foot_data>("sensor_data", 1);
else
this->sensor_data_publisher_ = this->public_node_handle_.advertise<humanoid_common_msgs::ir_foot_data>("sensor_data", 1);
} }
void IrFootSensorDriverNode::mainNodeThread(void) void IrFootSensorDriverNode::mainNodeThread(void)
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment