Beispiel #1
0
void SonarRecorder::writeDump()
{
  boost::mutex::scoped_lock lock_write_buffer( mutex_ );
  std::list< std::vector<sensor_msgs::Range> >::iterator it;
  for (it = buffer_.begin(); it != buffer_.end(); it++)
  {
    write(*it);
  }
}
Beispiel #2
0
void LogRecorder::writeDump(const ros::Time& time)
{
  boost::mutex::scoped_lock lock_write_buffer( mutex_ );
  boost::circular_buffer< std::list<rosgraph_msgs::Log> >::iterator it;
  for (it = buffer_.begin(); it != buffer_.end(); it++)
  {
    write(*it);
  }
}
Beispiel #3
0
 virtual void writeDump(const ros::Time& time)
 {
   boost::mutex::scoped_lock lock_write_buffer( mutex_ );
   typename boost::circular_buffer<T>::iterator it;
   for (it = buffer_.begin(); it != buffer_.end(); it++)
   {
     if (!it->header.stamp.isZero()) {
       gr_->write(topic_, *it, it->header.stamp);
     }
     else {
       gr_->write(topic_, *it);
     }
   }
 }
void DiagnosticsRecorder::writeDump(const ros::Time& time)
{
  boost::mutex::scoped_lock lock_write_buffer( mutex_ );
  boost::circular_buffer<diagnostic_msgs::DiagnosticArray>::iterator it;
  for (it = buffer_.begin(); it != buffer_.end(); it++)
  {
    if (!it->header.stamp.isZero()) {
      gr_->write(topic_, *it, it->header.stamp);
    }
    else {
      gr_->write(topic_, *it);
    }
  }
}
void JointStateRecorder::writeDump()
{
  boost::mutex::scoped_lock lock_write_buffer( mutex_ );
  std::list< std::vector<geometry_msgs::TransformStamped> >::iterator it_tf;
  for (it_tf = bufferTF_.begin(); it_tf != bufferTF_.end(); it_tf++)
  {
    gr_->write("/tf", *it_tf);
  }
  for (std::list<sensor_msgs::JointState>::iterator it_js = bufferJoinState_.begin();
       it_js != bufferJoinState_.end(); it_js++)
  {
    if (!it_js->header.stamp.isZero()) {
      gr_->write(topic_, *it_js, it_js->header.stamp);
    }
    else {
      gr_->write(topic_, *it_js);
    }
  }
}