ros 發佈/訂閱 長度不確定的數據

---------------------------------------
imgData.msg
  int32 upperLeft
  int32 lowerRight
  string color
  string cameraID

---------------------------------------
imgDataArray.msg
  imgData[] images

---------------------------------------
demo_pub.cpp
  ros::Publisher pub = n.advertise<my_pkg::imgDataArray>("test", 1000);

  my_pkg::imgData data;
  my_pkg::imgDataArray msg;

  data.upperleft=0; data.lowerRight=100; data.color="red"; data.cameraID="one";
  msg.images.push_back(data);
  data.upperleft=1; data.lowerRight=101; data.color="blue"; data.cameraID="two";
  msg.images.push_back(data);

  pub.publish(msg);

---------------------------------------
demo_sub.cpp
  void subCB(const my_pkg::imgDataArray::ConstPtr& msg)
  {
    for (int i=0; i<msg->images.size; ++i)
    {
      const my_pkg::imgData &data = msg->images[i];
      ROS_INFO_STREAM("UL: " << data.upperleft << "UR: " << data.upperright <<
                      "color: " << data.color << "ID: " << data.cameraID);
    }
  }

  int main(int argc, char **argv)
  {
    ...
    ros::Subscriber sub = n.subscribe("test", 1000, subCB);
    ros::spin();
  }

 

發表評論
所有評論
還沒有人評論,想成為第一個評論的人麼? 請在上方評論欄輸入並且點擊發布.
相關文章