74 lines
2.3 KiB
C
74 lines
2.3 KiB
C
|
/*
|
||
|
|
Copyright (c) 2013, Matthias Schiffer <mschiffer@universe-factory.net>
|
||
|
|
All rights reserved.
|
||
|
|
|
||
|
|
Redistribution and use in source and binary forms, with or without
|
||
|
|
modification, are permitted provided that the following conditions are met:
|
||
|
|
|
||
|
|
1. Redistributions of source code must retain the above copyright notice,
|
||
|
|
this list of conditions and the following disclaimer.
|
||
|
|
2. 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.
|
||
|
|
|
||
|
|
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 HOLDER 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.
|
||
|
|
*/
|
||
|
|
|
||
|
|
|
||
|
|
#include "mmss.h"
|
||
|
|
|
||
|
|
#include <stdio.h>
|
||
|
|
|
||
|
|
|
||
|
|
static inline int snprintf_safe(char *buffer, size_t size, const char *format, ...) {
|
||
|
|
va_list ap;
|
||
|
|
va_start(ap, format);
|
||
|
|
int ret = vsnprintf(buffer, size, format, ap);
|
||
|
|
va_end(ap);
|
||
|
|
|
||
|
|
return ret < 0 ? 0 : ret > size ? size : ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline const char* get_log_prefix(int log_level) {
|
||
|
|
switch(log_level) {
|
||
|
|
case LOG_CRIT:
|
||
|
|
return "Fatal: ";
|
||
|
|
case LOG_ERR:
|
||
|
|
return "Error: ";
|
||
|
|
case LOG_WARNING:
|
||
|
|
return "Warning: ";
|
||
|
|
case LOG_NOTICE:
|
||
|
|
return "Info: ";
|
||
|
|
case LOG_INFO:
|
||
|
|
return "Verbose: ";
|
||
|
|
case LOG_DEBUG:
|
||
|
|
return "DEBUG: ";
|
||
|
|
default:
|
||
|
|
return "";
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
void gmrf_logf(gmrf_t *gmrf, int priority, const char *format, ...) {
|
||
|
|
char buf[1024];
|
||
|
|
size_t pos = 0;
|
||
|
|
|
||
|
|
pos += snprintf_safe(buf, sizeof(buf), "[% 5u.%03u] %s: %s", gmrf->mmss->now/1000, gmrf->mmss->now%1000, gmrf->name, get_log_prefix(priority));
|
||
|
|
|
||
|
|
va_list ap;
|
||
|
|
va_start(ap, format);
|
||
|
|
vsnprintf(buf+pos, sizeof(buf)-pos, format, ap);
|
||
|
|
va_end(ap);
|
||
|
|
|
||
|
|
fprintf(stderr, "%s\n", buf);
|
||
|
|
}
|