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);
}
}
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);
}
}
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);
}
}
}