feat(ros): rosparam realtime config effect.

This commit is contained in:
TinyO 2019-09-19 09:18:54 +08:00
parent 7114e4b807
commit f1b6ec9e04

View File

@ -201,13 +201,6 @@ class ROSWrapperNodelet : public nodelet::Nodelet {
pthread_mutex_init(&mutex_data_, nullptr); pthread_mutex_init(&mutex_data_, nullptr);
private_nh_.getParamCached("model_rotation_x",
mesh_rotation_x);
private_nh_.getParamCached("model_rotation_y",
mesh_rotation_y);
private_nh_.getParamCached("model_rotation_z",
mesh_rotation_z);
// node params // node params
std::map<Stream, std::string> stream_names{ std::map<Stream, std::string> stream_names{
@ -1283,6 +1276,12 @@ class ROSWrapperNodelet : public nodelet::Nodelet {
mesh_msg_.header.stamp = ros::Time::now(); mesh_msg_.header.stamp = ros::Time::now();
mesh_msg_.type = visualization_msgs::Marker::MESH_RESOURCE; mesh_msg_.type = visualization_msgs::Marker::MESH_RESOURCE;
geometry_msgs::Quaternion q; geometry_msgs::Quaternion q;
private_nh_.getParamCached("model_rotation_x",
mesh_rotation_x);
private_nh_.getParamCached("model_rotation_y",
mesh_rotation_y);
private_nh_.getParamCached("model_rotation_z",
mesh_rotation_z);
q = tf::createQuaternionMsgFromRollPitchYaw( q = tf::createQuaternionMsgFromRollPitchYaw(
mesh_rotation_x, mesh_rotation_x,