void FrameManager::messageFailed(const std::string& frame_id, const ros::Time& stamp, const std::string& caller_id, tf::FilterFailureReason reason/*, Display* display*/)
{
    std::string status_name = getTransformStatusName(caller_id);
    std::string status_text = discoverFailureReason(frame_id, stamp, caller_id, reason);
    std::cerr << "FrameManager Message failed with frame_id " << frame_id << ": " << status_text <<  std::endl;
    //display->setStatus(status_levels::Error, status_name, status_text);
}
void FrameManager::messageFailed( const std::string& frame_id, const ros::Time& stamp,
                                  const std::string& caller_id, tf::FilterFailureReason reason, Display* display )
{
  std::string status_name = getTransformStatusName( caller_id );
  std::string status_text = discoverFailureReason( frame_id, stamp, caller_id, reason );

  display->setStatusStd(StatusProperty::Error, status_name, status_text );
}
void FrameManager::messageArrived( const std::string& frame_id, const ros::Time& stamp,
                                   const std::string& caller_id, Display* display )
{
  display->setStatusStd( StatusProperty::Ok, getTransformStatusName( caller_id ), "Transform OK" );
}