errorhandler.cpp

Go to the documentation of this file.

 
#include <stdio.h>      // for printf() and fprintf()
#include <stdlib.h>     // for atoi() and exit()
// #include <string.h>     // for memset()
//#include <backward/iostream.h>        // fuer cout()
// #include "pthread.h"
#include "mutex"
#include "sick_scan/tcp/errorhandler.hpp"
#ifndef ROSSIMU
#include "sick_scan/tcp/Time.hpp"
#endif
// Print mutex to print thread-safe
// pthread_mutex_t m_printMutex = PTHREAD_MUTEX_INITIALIZER;
std::mutex m_printMutex;
 
void doNothing()
{
}
 
 
void dieWithError(std::string errorMessage)
{
        {
        std::lock_guard<std::mutex> printGuard(m_printMutex);
 
        // Mutex setzen
        // pthread_mutex_lock(&m_printMutex);
        
        // Nachricht schreiben
    printError(errorMessage.c_str());
        
        // Mutex wieder freigeben
        // pthread_mutex_unlock(&m_printMutex);
        }
 
        // Programm abbrechen
    exit(1);
}
 
void infoMessage(std::string message, bool print)
{
        if (print == true)
        {
#ifndef ROSSIMU
                Time t = Time::now();
#endif  
        std::lock_guard<std::mutex> printGuard(m_printMutex);
                // Mutex setzen
                // pthread_mutex_lock(&m_printMutex);
                
                // Nachricht schreiben
#ifndef ROSSIMU
                printf("%s ", t.toString().c_str());
#endif  
                printf ("Info: %s\n", message.c_str());
                fflush(0);
 
                // Mutex wieder freigeben
                // pthread_mutex_unlock(&m_printMutex);
        }
}
 
 
 
//
// Warnungs-Text auf die Ausgabe schreiben.
//
void printWarning(std::string message)
{
#ifndef ROSSIMU
        Time t = Time::now();
#endif  
        std::lock_guard<std::mutex> printGuard(m_printMutex);
        // Mutex setzen
        // pthread_mutex_lock(&m_printMutex);
                
#ifndef ROSSIMU
        printf ("%s ", t.toString().c_str());
#endif
        printf ("Warning: %s\n", message.c_str());
        fflush(0);
                
        // Mutex wieder freigeben
        // pthread_mutex_unlock(&m_printMutex);
}
 
//
// Fehler-Text auf die Ausgabe schreiben.
//
void printError(std::string message)
{
#ifndef ROSSIMU
        Time t = Time::now();
#endif  
        
        std::lock_guard<std::mutex> printGuard(m_printMutex);
        // Mutex setzen
        // pthread_mutex_lock(&m_printMutex);
                
#ifndef ROSSIMU
        printf("%s ", t.toString().c_str());
#endif
        printf ("ERROR: %s\n", message.c_str());
        fflush(0);
        
        // Mutex wieder freigeben
        // pthread_mutex_unlock(&m_printMutex);
}