string_utils/ros.hpp

Go to the documentation of this file.

#pragma once
 
// SPDX-License-Identifier: BSD-3-Clause
// SPDX-FileCopyrightText: Czech Technical University in Prague
 
#include <sstream>
#include <string>
#include <type_traits>
 
#include <ros/duration.h>
#include <ros/rate.h>
#include <ros/time.h>
#include <ros/message_traits.h>
 
#include <cras_cpp_common/optional.hpp>
#include <cras_cpp_common/string_utils.hpp>
#include <cras_cpp_common/time_utils.hpp>
 
namespace cras
{
 
template<typename T, typename ::std::enable_if_t<
    ::std::is_same<T, ::ros::Time>::value ||
    ::std::is_same<T, ::ros::WallTime>::value ||
    ::std::is_same<T, ::ros::SteadyTime>::value ||
    ::std::is_same<T, ::ros::Duration>::value ||
    ::std::is_same<T, ::ros::WallDuration>::value
  >* = nullptr>
inline ::std::string to_string(const T& value)
{
  ::std::stringstream ss;
  ss << value;
  return ss.str();
}
 
template<typename T, typename ::std::enable_if_t<
    ::std::is_same<T, ::ros::Time>::value ||
    ::std::is_same<T, ::ros::WallTime>::value ||
    ::std::is_same<T, ::ros::SteadyTime>::value
  >* = nullptr>
::std::string to_pretty_string(const T& value);
 
template<typename T, typename ::std::enable_if_t<
    ::std::is_same<T, ::ros::Rate>::value ||
    ::std::is_same<T, ::ros::WallRate>::value
  >* = nullptr>
inline ::std::string to_string(const T& value)
{
  ::std::stringstream ss;
  ss << ::cras::frequency(value, true);
  return ss.str();
}
 
template<typename M, ::std::enable_if_t<::ros::message_traits::IsMessage<M>::value>* = nullptr>
inline std::string to_string(const M& msg)
{
  ::std::stringstream ss;
  ss << msg;
  ::std::string s = ss.str();
  if (!s.empty() && s[s.length() - 1] == '\n')
    s.erase(s.length()-1);
  ::cras::replace(s, "\n", ", ");
  return s;
}
 
template<typename D = ::ros::Duration, typename ::std::enable_if_t<
    ::std::is_same<D, ::ros::Duration>::value ||
    ::std::is_same<D, ::ros::WallDuration>::value
  >* = nullptr>
D parseTimezoneOffset(const ::std::string& s);
 
template<typename T = ::ros::Time, typename ::std::enable_if_t<
    ::std::is_same<T, ::ros::Time>::value ||
    ::std::is_same<T, ::ros::WallTime>::value ||
    ::std::is_same<T, ::ros::SteadyTime>::value
  >* = nullptr>
T parseTime(const ::std::string& s,
  const ::cras::optional<typename ::cras::DurationType<T>::value>& timezoneOffset = {}, const T& referenceDate = {});
 
template<typename D = ::ros::Duration, typename ::std::enable_if_t<
    ::std::is_same<D, ::ros::Duration>::value ||
    ::std::is_same<D, ::ros::WallDuration>::value
  >* = nullptr>
D parseDuration(const ::std::string& s);
 
}