Project: engagement_recognition License: BSD Dependencies: engagement_msgs engagement_srvs roscpp Used by: None All Packages

engagement_recognition/src/recognition/logger/console_logger.cpp Go to the documentation of this file. /* * Software License Agreement (BSD License) * * Copyright (c) 2010, Worcester Polytechnic Institute * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * * Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * * Redistributions in binary form must reproduce the above * copyright notice, this list of conditions and the following * disclaimer in the documentation and/or other materials provided * with the distribution. * * Neither the name of Worcester Polytechnic Institute. nor the names * of its contributors may be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ // @author Brett Ponsler (bponsler (at) wpi (dot) edu) #include "console_logger.h" #include <ros/ros.h> #include <sstream> #include <stdio.h> #include "../lib/engagement_params.h" std::string ConsoleLogger::start_color = "\033["; std::string ConsoleLogger::end_color = "\033[0m"; std::string ConsoleLogger::DEFAULT = "0m"; std::string ConsoleLogger::RED = "31m"; std::string ConsoleLogger::GREEN = "32m"; std::string ConsoleLogger::YELLOW = "33m"; std::string ConsoleLogger::BLUE = "34m"; std::string ConsoleLogger::PURPLE = "35m"; std::string ConsoleLogger::CYAN = "36m"; std::string ConsoleLogger::BRIGHT_RED = "91m"; std::string ConsoleLogger::BRIGHT_GREEN = "92m"; std::string ConsoleLogger::BRIGHT_YELLOW = "93m"; std::string ConsoleLogger::BRIGHT_BLUE = "94m"; std::string ConsoleLogger::BRIGHT_PURPLE = "95m"; std::string ConsoleLogger::BRIGHT_CYAN = "96m"; ConsoleLogger::ConsoleLogger() { this->verbosity_ = EngagementParams::getVerbosity(); this->prefix_ = std::string(""); } ConsoleLogger::ConsoleLogger(std::string prefix) { this->verbosity_ = EngagementParams::getVerbosity(); this->prefix_ = std::string(prefix); } ConsoleLogger::ConsoleLogger(ConsoleLogger *logger, std::string prefix) { this->verbosity_ = EngagementParams::getVerbosity(); this->prefix_ = std::string(prefix); // If the logger exists, then append its prefix before ours if (logger != NULL) this->prefix_ = std::string(logger->prefix_ + this->prefix_); } ConsoleLogger::ConsoleLogger(std::string prefix, int color) { this->verbosity_ = EngagementParams::getVerbosity(); // Create the prefix for this logger this->createPrefix(prefix, color); } ConsoleLogger::ConsoleLogger(ConsoleLogger *logger, std::string prefix, int color) { this->verbosity_ = EngagementParams::getVerbosity(); // Create the prefix for this logger this->createPrefix(prefix, color); // Now append the base logger's prefix before our prefix // so long as the console logger exists if (logger != NULL) this->prefix_ = std::string(logger->prefix_ + this->prefix_); } ConsoleLogger::ConsoleLogger(ConsoleLogger *logger) { this->verbosity_ = EngagementParams::getVerbosity(); // Make sure the given logger exists if (logger != NULL) { // Our prefix is the same as the logger's prefix this->prefix_ = std::string(logger->prefix_); } else this->prefix_ = std::string(""); } void ConsoleLogger::createPrefix(std::string prefix, int color) { // Make sure the prefix exists if (prefix.size() > 0) { // Convert the color into a string std::stringstream ss; ss << color; // Create the prefix using the color this->prefix_ = ConsoleLogger::start_color + ss.str() + std::string(prefix) + ConsoleLogger::end_color; } else this->prefix_ = std::string(""); } const char *ConsoleLogger::getPrefix() { return this->prefix_.c_str(); } void ConsoleLogger::debug(int level, const char *str, va_list args) { // Determine if the verbosity level is high enough if (level <= this->verbosity_) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::GREEN + buff + ConsoleLogger::end_color; ROS_DEBUG("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } } void ConsoleLogger::info(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::DEFAULT + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD %d] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::warn(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::YELLOW + buff + ConsoleLogger::end_color; ROS_WARN("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::error(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::RED + buff + ConsoleLogger::end_color; ROS_ERROR("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::fatal(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::RED + buff + ConsoleLogger::end_color; ROS_FATAL("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::red(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::RED + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::green(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::GREEN + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::yellow(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::YELLOW + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::blue(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::BLUE + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::purple(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::PURPLE + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::cyan(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::CYAN + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::brightRed(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::BRIGHT_RED + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::brightGreen(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::BRIGHT_GREEN + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::brightYellow(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::BRIGHT_YELLOW + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::brightBlue(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::BRIGHT_BLUE + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::brightPurple(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::BRIGHT_PURPLE + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); } void ConsoleLogger::brightCyan(const char *str, va_list args) { // Create a buffer to hold the formatted string char buff[4096]; // Print all the arguments to the buffer in the formatted string vsnprintf(buff, 4096, str, args); pthread_t thread = pthread_self(); // Append the correct color around the string std::string temp = this->prefix_ + ConsoleLogger::start_color + ConsoleLogger::BRIGHT_CYAN + buff + ConsoleLogger::end_color; ROS_INFO("[THREAD: %u] %s", (unsigned int)thread, temp.c_str()); }

---

engagement_recognition
Author(s): Brett Ponsler (bponsler (at) wpi (dot) edu)
autogenerated on Fri Sep 9 10:35:48 2011