1

我将 ROS 与 C++ 一起使用，在从 void callback() 中的主题接收数据后，我需要将此数据传递给 int main() 中的变量。到目前为止，我发现我可以使用 boost 共享指针来做到这一点，并且应该使用“程序中的类，回调作为成员函数”。到目前为止我的部分代码：

double pos_z;
void callback(gazebo_msgs::LinkStates msgs_ls)
{
   double pos_z = msgs_ls.pose[43].position.z
   pos_z = pos_z + 1;
}
int main(int argc, char **argv)
{
   ros::init(...);
   ros::Nodehandle n;
   ros::Subscriber ls_sub = n.subscribe("/gazebo/link_states", 10, callback);
   ros::ServiceClient sls_client = n.serviceClient<gazebo_msgs::SetLinkState>("/gazebo/set_link_state");
   gazebo_msgs::SetLinkState setLinkState;
   while (ros::ok))
   {
      setLinkState.request.link_state.position.z = pos_z;
      sls_client.call(setLinkState);
  }

关于共享指针：这可能是boost::shared_ptr<double> a_ptr(&a, noop_deletewithauto noop_delete = [](double *){}但我真的不明白如何实现它。我也不清楚提到的具有回调作为成员函数的类。示例显示了使用 C 的实现，我不知道我是否可以使用它。感谢您的任何帮助。

4

1 回答 1

2

你得到的建议很好：

使用“程序中的类，回调作为成员函数”

你这样做：

class SuperCoolRobot {
public:
  SuperCoolRobot ():pos_z(0) {
    // Note : we provide the callback (a member) + a state (this)
    ls_sub = n.subscribe("/gazebo/link_states", 10, SuperCoolRobot::link_state_callback, this);
  }

  void link_state_callback(gazebo_msgs::LinkStates msgs_ls) {
    pos_z = msgs_ls.pose[43].position.z + 1;
  }

  void run() {
    gazebo_msgs::SetLinkState setLinkState;
    while (ros::ok))
    {
      setLinkState.request.link_state.position.z = pos_z;
      sls_client.call(setLinkState);
    }
  }
protected:
  // state here
  ros::Nodehandle n;
  ros::Subscriber ls_sub;
  double pos_z;
};

然后主要：

int main(int argc, char **argv) {
  SuperCoolRobot robot;
  robot.run();
}

请注意，我不了解 ROS，所以我只是抛出了我从您的代码中理解的内容。当然要调整。

于 2013-04-18T12:44:56.283 回答