twist_mux_diagnostics.h

Go to the documentation of this file.

/*********************************************************************
 * Software License Agreement (CC BY-NC-SA 4.0 License)
 *
 *  Copyright (c) 2014, PAL Robotics, S.L.
 *  All rights reserved.
 *
 *  This work is licensed under the Creative Commons
 *  Attribution-NonCommercial-ShareAlike 4.0 International License.
 *
 *  To view a copy of this license, visit
 *  http://creativecommons.org/licenses/by-nc-sa/4.0/
 *  or send a letter to
 *  Creative Commons, 444 Castro Street, Suite 900,
 *  Mountain View, California, 94041, USA.
 *********************************************************************/
 
/*
 * @author Enrique Fernandez
 */
 
#ifndef TWIST_MUX_DIAGNOSTICS_H
#define TWIST_MUX_DIAGNOSTICS_H
 
#include <twist_mux/twist_mux_diagnostics_status.h>
 
#include <diagnostic_updater/diagnostic_updater.h>
#include <ros/ros.h>
 
#include <boost/shared_ptr.hpp>
 
namespace twist_mux
{
 
class TwistMuxDiagnostics
{
  public:
    typedef TwistMuxDiagnosticsStatus status_type;
 
    static constexpr double MAIN_LOOP_TIME_MIN = 0.2; // [s]
    static constexpr double READING_AGE_MIN    = 3.0; // [s]
 
    TwistMuxDiagnostics();
    virtual ~TwistMuxDiagnostics();
 
    void diagnostics(diagnostic_updater::DiagnosticStatusWrapper& stat);
 
    void update();
 
    void updateStatus(const status_type::ConstPtr& status);
 
  private:
 
    enum
    {
      OK    = diagnostic_msgs::DiagnosticStatus::OK,
      WARN  = diagnostic_msgs::DiagnosticStatus::WARN,
      ERROR = diagnostic_msgs::DiagnosticStatus::ERROR
    };
 
    diagnostic_updater::Updater diagnostic_;
    status_type                 status_;
};
 
} // namespace twist_mux
 
#endif // TWIST_MUX_DIAGNOSTICS_H