ClockPublisher.h

Go to the documentation of this file.

#pragma once
 
#include <ros/ros.h>
 
#include <mujoco/mjdata.h>
#include <mujoco/mjmodel.h>
#include <mujoco/mjtnum.h>
#include <mujoco/mjvisualize.h>
 
#include <string>
 
namespace MujocoRosUtils
{
 
class ClockPublisher
{
public:
  static void RegisterPlugin();
 
  static ClockPublisher * Create(const mjModel * m, mjData * d, int plugin_id);
 
public:
  ClockPublisher(ClockPublisher &&) = default;
 
  void reset(const mjModel * m, int plugin_id);
 
  void compute(const mjModel * m, mjData * d, int plugin_id);
 
protected:
  ClockPublisher(const mjModel * m, mjData * d, const std::string & topic_name, mjtNum publish_rate, bool use_sim_time);
 
protected:
  std::shared_ptr<ros::NodeHandle> nh_;
 
  ros::Publisher pub_;
 
  std::string topic_name_;
 
  int publish_skip_ = 0;
 
  bool use_sim_time_ = false;
 
  int sim_cnt_ = 0;
};
 
} // namespace MujocoRosUtils