WORKS
Dependencies: MAX44000 PWM_Tone_Library nexpaq_mdk
Fork of LED_Demo by
mbd_os/features/FEATURE_COMMON_PAL/nanostack-libservice/source/libTrace/ns_trace.c@1:55a6170b404f, 2016-09-17 (annotated)
- Committer:
- nexpaq
- Date:
- Sat Sep 17 16:32:05 2016 +0000
- Revision:
- 1:55a6170b404f
checking in for sharing
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
nexpaq | 1:55a6170b404f | 1 | /* |
nexpaq | 1:55a6170b404f | 2 | * Copyright (c) 2014-2015 ARM Limited. All rights reserved. |
nexpaq | 1:55a6170b404f | 3 | * SPDX-License-Identifier: Apache-2.0 |
nexpaq | 1:55a6170b404f | 4 | * Licensed under the Apache License, Version 2.0 (the License); you may |
nexpaq | 1:55a6170b404f | 5 | * not use this file except in compliance with the License. |
nexpaq | 1:55a6170b404f | 6 | * You may obtain a copy of the License at |
nexpaq | 1:55a6170b404f | 7 | * |
nexpaq | 1:55a6170b404f | 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
nexpaq | 1:55a6170b404f | 9 | * |
nexpaq | 1:55a6170b404f | 10 | * Unless required by applicable law or agreed to in writing, software |
nexpaq | 1:55a6170b404f | 11 | * distributed under the License is distributed on an AS IS BASIS, WITHOUT |
nexpaq | 1:55a6170b404f | 12 | * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
nexpaq | 1:55a6170b404f | 13 | * See the License for the specific language governing permissions and |
nexpaq | 1:55a6170b404f | 14 | * limitations under the License. |
nexpaq | 1:55a6170b404f | 15 | */ |
nexpaq | 1:55a6170b404f | 16 | #include <stdio.h> |
nexpaq | 1:55a6170b404f | 17 | #include <string.h> |
nexpaq | 1:55a6170b404f | 18 | #include <stdarg.h> |
nexpaq | 1:55a6170b404f | 19 | #include <stdlib.h> |
nexpaq | 1:55a6170b404f | 20 | |
nexpaq | 1:55a6170b404f | 21 | #define HAVE_DEBUG 1 |
nexpaq | 1:55a6170b404f | 22 | |
nexpaq | 1:55a6170b404f | 23 | #include "ns_trace.h" |
nexpaq | 1:55a6170b404f | 24 | #include "ip6string.h" |
nexpaq | 1:55a6170b404f | 25 | #include "common_functions.h" |
nexpaq | 1:55a6170b404f | 26 | |
nexpaq | 1:55a6170b404f | 27 | #if defined(_WIN32) || defined(__unix__) || defined(__unix) || defined(unix) || (defined(YOTTA_CFG) && !defined(NDEBUG)) |
nexpaq | 1:55a6170b404f | 28 | //NOTE! It is not allowed to use this MEM_ALLOC/MEM_FREE from interrupt context. |
nexpaq | 1:55a6170b404f | 29 | #ifndef MEM_ALLOC |
nexpaq | 1:55a6170b404f | 30 | #define MEM_ALLOC malloc |
nexpaq | 1:55a6170b404f | 31 | #endif |
nexpaq | 1:55a6170b404f | 32 | #ifndef MEM_FREE |
nexpaq | 1:55a6170b404f | 33 | #define MEM_FREE free |
nexpaq | 1:55a6170b404f | 34 | #endif |
nexpaq | 1:55a6170b404f | 35 | #else |
nexpaq | 1:55a6170b404f | 36 | #include "nsdynmemLIB.h" |
nexpaq | 1:55a6170b404f | 37 | #ifndef MEM_ALLOC |
nexpaq | 1:55a6170b404f | 38 | #define MEM_ALLOC ns_dyn_mem_alloc |
nexpaq | 1:55a6170b404f | 39 | #endif |
nexpaq | 1:55a6170b404f | 40 | #ifndef MEM_FREE |
nexpaq | 1:55a6170b404f | 41 | #define MEM_FREE ns_dyn_mem_free |
nexpaq | 1:55a6170b404f | 42 | #endif |
nexpaq | 1:55a6170b404f | 43 | #endif |
nexpaq | 1:55a6170b404f | 44 | |
nexpaq | 1:55a6170b404f | 45 | #ifndef NS_TRACE_USE_MBED_TRACE |
nexpaq | 1:55a6170b404f | 46 | |
nexpaq | 1:55a6170b404f | 47 | #define VT100_COLOR_ERROR "\x1b[31m" |
nexpaq | 1:55a6170b404f | 48 | #define VT100_COLOR_WARN "\x1b[33m" |
nexpaq | 1:55a6170b404f | 49 | #define VT100_COLOR_INFO "\x1b[39m" |
nexpaq | 1:55a6170b404f | 50 | #define VT100_COLOR_DEBUG "\x1b[90m" |
nexpaq | 1:55a6170b404f | 51 | |
nexpaq | 1:55a6170b404f | 52 | /** default max trace line size in bytes */ |
nexpaq | 1:55a6170b404f | 53 | #define DEFAULT_TRACE_LINE_LENGTH 1024 |
nexpaq | 1:55a6170b404f | 54 | /** default max temporary buffer size in bytes, used in |
nexpaq | 1:55a6170b404f | 55 | trace_ipv6, trace_array and trace_strn */ |
nexpaq | 1:55a6170b404f | 56 | #define DEFAULT_TRACE_TMP_LINE_LEN 512 |
nexpaq | 1:55a6170b404f | 57 | /** default max filters (include/exclude) length in bytes */ |
nexpaq | 1:55a6170b404f | 58 | #define DEFAULT_TRACE_FILTER_LENGTH 24 |
nexpaq | 1:55a6170b404f | 59 | |
nexpaq | 1:55a6170b404f | 60 | /** default print function, just redirect str to printf */ |
nexpaq | 1:55a6170b404f | 61 | static void default_print(const char *str); |
nexpaq | 1:55a6170b404f | 62 | |
nexpaq | 1:55a6170b404f | 63 | typedef struct { |
nexpaq | 1:55a6170b404f | 64 | /** trace configuration bits */ |
nexpaq | 1:55a6170b404f | 65 | uint8_t trace_config; |
nexpaq | 1:55a6170b404f | 66 | /** exclude filters list, related group name */ |
nexpaq | 1:55a6170b404f | 67 | char *filters_exclude; |
nexpaq | 1:55a6170b404f | 68 | /** include filters list, related group name */ |
nexpaq | 1:55a6170b404f | 69 | char *filters_include; |
nexpaq | 1:55a6170b404f | 70 | /** Filters length */ |
nexpaq | 1:55a6170b404f | 71 | int filters_length; |
nexpaq | 1:55a6170b404f | 72 | /** trace line */ |
nexpaq | 1:55a6170b404f | 73 | char *line; |
nexpaq | 1:55a6170b404f | 74 | /** trace line length */ |
nexpaq | 1:55a6170b404f | 75 | int line_length; |
nexpaq | 1:55a6170b404f | 76 | /** temporary data */ |
nexpaq | 1:55a6170b404f | 77 | char *tmp_data; |
nexpaq | 1:55a6170b404f | 78 | /** temporary data array length */ |
nexpaq | 1:55a6170b404f | 79 | int tmp_data_length; |
nexpaq | 1:55a6170b404f | 80 | /** temporary data pointer */ |
nexpaq | 1:55a6170b404f | 81 | char *tmp_data_ptr; |
nexpaq | 1:55a6170b404f | 82 | |
nexpaq | 1:55a6170b404f | 83 | /** prefix function, which can be used to put time to the trace line */ |
nexpaq | 1:55a6170b404f | 84 | char *(*prefix_f)(size_t); |
nexpaq | 1:55a6170b404f | 85 | /** suffix function, which can be used to some string to the end of trace line */ |
nexpaq | 1:55a6170b404f | 86 | char *(*suffix_f)(void); |
nexpaq | 1:55a6170b404f | 87 | /** print out function. Can be redirect to flash for example. */ |
nexpaq | 1:55a6170b404f | 88 | void (*printf)(const char *); |
nexpaq | 1:55a6170b404f | 89 | /** print out function for TRACE_LEVEL_CMD */ |
nexpaq | 1:55a6170b404f | 90 | void (*cmd_printf)(const char *); |
nexpaq | 1:55a6170b404f | 91 | } trace_s; |
nexpaq | 1:55a6170b404f | 92 | |
nexpaq | 1:55a6170b404f | 93 | static trace_s m_trace = { |
nexpaq | 1:55a6170b404f | 94 | .filters_exclude = 0, |
nexpaq | 1:55a6170b404f | 95 | .filters_include = 0, |
nexpaq | 1:55a6170b404f | 96 | .line = 0, |
nexpaq | 1:55a6170b404f | 97 | .tmp_data = 0, |
nexpaq | 1:55a6170b404f | 98 | .prefix_f = 0, |
nexpaq | 1:55a6170b404f | 99 | .suffix_f = 0, |
nexpaq | 1:55a6170b404f | 100 | .printf = 0, |
nexpaq | 1:55a6170b404f | 101 | .cmd_printf = 0 |
nexpaq | 1:55a6170b404f | 102 | }; |
nexpaq | 1:55a6170b404f | 103 | |
nexpaq | 1:55a6170b404f | 104 | int trace_init(void) |
nexpaq | 1:55a6170b404f | 105 | { |
nexpaq | 1:55a6170b404f | 106 | m_trace.trace_config = TRACE_MODE_COLOR | TRACE_ACTIVE_LEVEL_ALL | TRACE_CARRIAGE_RETURN; |
nexpaq | 1:55a6170b404f | 107 | m_trace.line_length = DEFAULT_TRACE_LINE_LENGTH; |
nexpaq | 1:55a6170b404f | 108 | if (m_trace.line == NULL) { |
nexpaq | 1:55a6170b404f | 109 | m_trace.line = MEM_ALLOC(m_trace.line_length); |
nexpaq | 1:55a6170b404f | 110 | } |
nexpaq | 1:55a6170b404f | 111 | m_trace.tmp_data_length = DEFAULT_TRACE_TMP_LINE_LEN; |
nexpaq | 1:55a6170b404f | 112 | if (m_trace.tmp_data == NULL) { |
nexpaq | 1:55a6170b404f | 113 | m_trace.tmp_data = MEM_ALLOC(m_trace.tmp_data_length); |
nexpaq | 1:55a6170b404f | 114 | } |
nexpaq | 1:55a6170b404f | 115 | m_trace.tmp_data_ptr = m_trace.tmp_data; |
nexpaq | 1:55a6170b404f | 116 | m_trace.filters_length = DEFAULT_TRACE_FILTER_LENGTH; |
nexpaq | 1:55a6170b404f | 117 | if (m_trace.filters_exclude == NULL) { |
nexpaq | 1:55a6170b404f | 118 | m_trace.filters_exclude = MEM_ALLOC(m_trace.filters_length); |
nexpaq | 1:55a6170b404f | 119 | } |
nexpaq | 1:55a6170b404f | 120 | if (m_trace.filters_include == NULL) { |
nexpaq | 1:55a6170b404f | 121 | m_trace.filters_include = MEM_ALLOC(m_trace.filters_length); |
nexpaq | 1:55a6170b404f | 122 | } |
nexpaq | 1:55a6170b404f | 123 | |
nexpaq | 1:55a6170b404f | 124 | if (m_trace.line == NULL || |
nexpaq | 1:55a6170b404f | 125 | m_trace.tmp_data == NULL || |
nexpaq | 1:55a6170b404f | 126 | m_trace.filters_exclude == NULL || |
nexpaq | 1:55a6170b404f | 127 | m_trace.filters_include == NULL) { |
nexpaq | 1:55a6170b404f | 128 | //memory allocation fail |
nexpaq | 1:55a6170b404f | 129 | trace_free(); |
nexpaq | 1:55a6170b404f | 130 | return -1; |
nexpaq | 1:55a6170b404f | 131 | } |
nexpaq | 1:55a6170b404f | 132 | memset(m_trace.tmp_data, 0, m_trace.tmp_data_length); |
nexpaq | 1:55a6170b404f | 133 | memset(m_trace.filters_exclude, 0, m_trace.filters_length); |
nexpaq | 1:55a6170b404f | 134 | memset(m_trace.filters_include, 0, m_trace.filters_length); |
nexpaq | 1:55a6170b404f | 135 | memset(m_trace.line, 0, m_trace.line_length); |
nexpaq | 1:55a6170b404f | 136 | |
nexpaq | 1:55a6170b404f | 137 | m_trace.prefix_f = 0; |
nexpaq | 1:55a6170b404f | 138 | m_trace.suffix_f = 0; |
nexpaq | 1:55a6170b404f | 139 | m_trace.printf = default_print; |
nexpaq | 1:55a6170b404f | 140 | m_trace.cmd_printf = 0; |
nexpaq | 1:55a6170b404f | 141 | |
nexpaq | 1:55a6170b404f | 142 | return 0; |
nexpaq | 1:55a6170b404f | 143 | } |
nexpaq | 1:55a6170b404f | 144 | void trace_free(void) |
nexpaq | 1:55a6170b404f | 145 | { |
nexpaq | 1:55a6170b404f | 146 | MEM_FREE(m_trace.line); |
nexpaq | 1:55a6170b404f | 147 | m_trace.line_length = 0; |
nexpaq | 1:55a6170b404f | 148 | m_trace.line = 0; |
nexpaq | 1:55a6170b404f | 149 | MEM_FREE(m_trace.tmp_data); |
nexpaq | 1:55a6170b404f | 150 | m_trace.tmp_data = 0; |
nexpaq | 1:55a6170b404f | 151 | m_trace.tmp_data_ptr = 0; |
nexpaq | 1:55a6170b404f | 152 | MEM_FREE(m_trace.filters_exclude); |
nexpaq | 1:55a6170b404f | 153 | m_trace.filters_exclude = 0; |
nexpaq | 1:55a6170b404f | 154 | MEM_FREE(m_trace.filters_include); |
nexpaq | 1:55a6170b404f | 155 | m_trace.filters_include = 0; |
nexpaq | 1:55a6170b404f | 156 | m_trace.filters_length = 0; |
nexpaq | 1:55a6170b404f | 157 | } |
nexpaq | 1:55a6170b404f | 158 | /** @TODO do we need dynamically change trace buffer sizes ? |
nexpaq | 1:55a6170b404f | 159 | // reconfigure trace buffer sizes |
nexpaq | 1:55a6170b404f | 160 | void set_trace_buffer_sizes(int lineLength, int tmpLength) |
nexpaq | 1:55a6170b404f | 161 | { |
nexpaq | 1:55a6170b404f | 162 | REALLOC( m_trace.line, dataLength ); |
nexpaq | 1:55a6170b404f | 163 | REALLOC( m_trace.tmp_data, tmpLength); |
nexpaq | 1:55a6170b404f | 164 | m_trace.tmp_data_length = tmpLength; |
nexpaq | 1:55a6170b404f | 165 | } |
nexpaq | 1:55a6170b404f | 166 | */ |
nexpaq | 1:55a6170b404f | 167 | void set_trace_config(uint8_t config) |
nexpaq | 1:55a6170b404f | 168 | { |
nexpaq | 1:55a6170b404f | 169 | m_trace.trace_config = config; |
nexpaq | 1:55a6170b404f | 170 | } |
nexpaq | 1:55a6170b404f | 171 | uint8_t get_trace_config(void) |
nexpaq | 1:55a6170b404f | 172 | { |
nexpaq | 1:55a6170b404f | 173 | return m_trace.trace_config; |
nexpaq | 1:55a6170b404f | 174 | } |
nexpaq | 1:55a6170b404f | 175 | void set_trace_prefix_function(char *(*pref_f)(size_t)) |
nexpaq | 1:55a6170b404f | 176 | { |
nexpaq | 1:55a6170b404f | 177 | m_trace.prefix_f = pref_f; |
nexpaq | 1:55a6170b404f | 178 | } |
nexpaq | 1:55a6170b404f | 179 | void set_trace_suffix_function(char *(*suffix_f)(void)) |
nexpaq | 1:55a6170b404f | 180 | { |
nexpaq | 1:55a6170b404f | 181 | m_trace.suffix_f = suffix_f; |
nexpaq | 1:55a6170b404f | 182 | } |
nexpaq | 1:55a6170b404f | 183 | void set_trace_print_function(void (*printf)(const char *)) |
nexpaq | 1:55a6170b404f | 184 | { |
nexpaq | 1:55a6170b404f | 185 | m_trace.printf = printf; |
nexpaq | 1:55a6170b404f | 186 | } |
nexpaq | 1:55a6170b404f | 187 | void set_trace_cmdprint_function(void (*printf)(const char *)) |
nexpaq | 1:55a6170b404f | 188 | { |
nexpaq | 1:55a6170b404f | 189 | m_trace.cmd_printf = printf; |
nexpaq | 1:55a6170b404f | 190 | } |
nexpaq | 1:55a6170b404f | 191 | void set_trace_exclude_filters(char *filters) |
nexpaq | 1:55a6170b404f | 192 | { |
nexpaq | 1:55a6170b404f | 193 | if (filters) { |
nexpaq | 1:55a6170b404f | 194 | (void)strncpy(m_trace.filters_exclude, filters, m_trace.filters_length); |
nexpaq | 1:55a6170b404f | 195 | } else { |
nexpaq | 1:55a6170b404f | 196 | m_trace.filters_exclude[0] = 0; |
nexpaq | 1:55a6170b404f | 197 | } |
nexpaq | 1:55a6170b404f | 198 | } |
nexpaq | 1:55a6170b404f | 199 | const char *get_trace_exclude_filters(void) |
nexpaq | 1:55a6170b404f | 200 | { |
nexpaq | 1:55a6170b404f | 201 | return m_trace.filters_exclude; |
nexpaq | 1:55a6170b404f | 202 | } |
nexpaq | 1:55a6170b404f | 203 | const char *get_trace_include_filters(void) |
nexpaq | 1:55a6170b404f | 204 | { |
nexpaq | 1:55a6170b404f | 205 | return m_trace.filters_include; |
nexpaq | 1:55a6170b404f | 206 | } |
nexpaq | 1:55a6170b404f | 207 | void set_trace_include_filters(char *filters) |
nexpaq | 1:55a6170b404f | 208 | { |
nexpaq | 1:55a6170b404f | 209 | if (filters) { |
nexpaq | 1:55a6170b404f | 210 | (void)strncpy(m_trace.filters_include, filters, m_trace.filters_length); |
nexpaq | 1:55a6170b404f | 211 | } else { |
nexpaq | 1:55a6170b404f | 212 | m_trace.filters_include[0] = 0; |
nexpaq | 1:55a6170b404f | 213 | } |
nexpaq | 1:55a6170b404f | 214 | } |
nexpaq | 1:55a6170b404f | 215 | static int8_t trace_skip(int8_t dlevel, const char *grp) |
nexpaq | 1:55a6170b404f | 216 | { |
nexpaq | 1:55a6170b404f | 217 | if (dlevel >= 0 && grp != 0) { |
nexpaq | 1:55a6170b404f | 218 | // filter debug prints only when dlevel is >0 and grp is given |
nexpaq | 1:55a6170b404f | 219 | |
nexpaq | 1:55a6170b404f | 220 | /// @TODO this could be much better.. |
nexpaq | 1:55a6170b404f | 221 | if (m_trace.filters_exclude[0] != '\0' && |
nexpaq | 1:55a6170b404f | 222 | strstr(m_trace.filters_exclude, grp) != 0) { |
nexpaq | 1:55a6170b404f | 223 | //grp was in exclude list |
nexpaq | 1:55a6170b404f | 224 | return 1; |
nexpaq | 1:55a6170b404f | 225 | } |
nexpaq | 1:55a6170b404f | 226 | if (m_trace.filters_include[0] != '\0' && |
nexpaq | 1:55a6170b404f | 227 | strstr(m_trace.filters_include, grp) == 0) { |
nexpaq | 1:55a6170b404f | 228 | //grp was in include list |
nexpaq | 1:55a6170b404f | 229 | return 1; |
nexpaq | 1:55a6170b404f | 230 | } |
nexpaq | 1:55a6170b404f | 231 | } |
nexpaq | 1:55a6170b404f | 232 | return 0; |
nexpaq | 1:55a6170b404f | 233 | } |
nexpaq | 1:55a6170b404f | 234 | static void default_print(const char *str) |
nexpaq | 1:55a6170b404f | 235 | { |
nexpaq | 1:55a6170b404f | 236 | puts(str); |
nexpaq | 1:55a6170b404f | 237 | } |
nexpaq | 1:55a6170b404f | 238 | void tracef(uint8_t dlevel, const char *grp, const char *fmt, ...) |
nexpaq | 1:55a6170b404f | 239 | { |
nexpaq | 1:55a6170b404f | 240 | if (m_trace.line == NULL) { |
nexpaq | 1:55a6170b404f | 241 | // Quite likely the trace_init() has not been called yet, |
nexpaq | 1:55a6170b404f | 242 | // but it is better to just shut up instead of crashing with |
nexpaq | 1:55a6170b404f | 243 | // null pointer dereference. |
nexpaq | 1:55a6170b404f | 244 | m_trace.tmp_data_ptr = m_trace.tmp_data; |
nexpaq | 1:55a6170b404f | 245 | return; |
nexpaq | 1:55a6170b404f | 246 | } |
nexpaq | 1:55a6170b404f | 247 | |
nexpaq | 1:55a6170b404f | 248 | m_trace.line[0] = 0; //by default trace is empty |
nexpaq | 1:55a6170b404f | 249 | if (trace_skip(dlevel, grp) || fmt == 0 || grp == 0) { |
nexpaq | 1:55a6170b404f | 250 | m_trace.tmp_data_ptr = m_trace.tmp_data; |
nexpaq | 1:55a6170b404f | 251 | return; |
nexpaq | 1:55a6170b404f | 252 | } |
nexpaq | 1:55a6170b404f | 253 | if ((m_trace.trace_config & TRACE_MASK_LEVEL) & dlevel) { |
nexpaq | 1:55a6170b404f | 254 | bool color = (m_trace.trace_config & TRACE_MODE_COLOR) != 0; |
nexpaq | 1:55a6170b404f | 255 | bool plain = (m_trace.trace_config & TRACE_MODE_PLAIN) != 0; |
nexpaq | 1:55a6170b404f | 256 | bool cr = (m_trace.trace_config & TRACE_CARRIAGE_RETURN) != 0; |
nexpaq | 1:55a6170b404f | 257 | //printf("CFG: 0x%02x, plain: %i, color: %i, cr: %i\n", m_trace.trace_config, plain, color, cr); |
nexpaq | 1:55a6170b404f | 258 | |
nexpaq | 1:55a6170b404f | 259 | int retval = 0, bLeft = m_trace.line_length; |
nexpaq | 1:55a6170b404f | 260 | char *ptr = m_trace.line; |
nexpaq | 1:55a6170b404f | 261 | if (plain == true || dlevel == TRACE_LEVEL_CMD) { |
nexpaq | 1:55a6170b404f | 262 | va_list ap; |
nexpaq | 1:55a6170b404f | 263 | va_start(ap, fmt); |
nexpaq | 1:55a6170b404f | 264 | //add trace data |
nexpaq | 1:55a6170b404f | 265 | retval = vsnprintf(ptr, bLeft, fmt, ap); |
nexpaq | 1:55a6170b404f | 266 | va_end(ap); |
nexpaq | 1:55a6170b404f | 267 | if (dlevel == TRACE_LEVEL_CMD && m_trace.cmd_printf) { |
nexpaq | 1:55a6170b404f | 268 | m_trace.cmd_printf(m_trace.line); |
nexpaq | 1:55a6170b404f | 269 | m_trace.cmd_printf("\n"); |
nexpaq | 1:55a6170b404f | 270 | } else { |
nexpaq | 1:55a6170b404f | 271 | //print out whole data |
nexpaq | 1:55a6170b404f | 272 | m_trace.printf(m_trace.line); |
nexpaq | 1:55a6170b404f | 273 | } |
nexpaq | 1:55a6170b404f | 274 | } else { |
nexpaq | 1:55a6170b404f | 275 | if (color) { |
nexpaq | 1:55a6170b404f | 276 | if (cr) { |
nexpaq | 1:55a6170b404f | 277 | retval = snprintf(ptr, bLeft, "\r\x1b[2K"); |
nexpaq | 1:55a6170b404f | 278 | if (retval >= bLeft) { |
nexpaq | 1:55a6170b404f | 279 | retval = 0; |
nexpaq | 1:55a6170b404f | 280 | } |
nexpaq | 1:55a6170b404f | 281 | if (retval > 0) { |
nexpaq | 1:55a6170b404f | 282 | ptr += retval; |
nexpaq | 1:55a6170b404f | 283 | bLeft -= retval; |
nexpaq | 1:55a6170b404f | 284 | } |
nexpaq | 1:55a6170b404f | 285 | } |
nexpaq | 1:55a6170b404f | 286 | if (bLeft > 0) { |
nexpaq | 1:55a6170b404f | 287 | //include color in ANSI/VT100 escape code |
nexpaq | 1:55a6170b404f | 288 | switch (dlevel) { |
nexpaq | 1:55a6170b404f | 289 | case (TRACE_LEVEL_ERROR): |
nexpaq | 1:55a6170b404f | 290 | retval = snprintf(ptr, bLeft, "%s", VT100_COLOR_ERROR); |
nexpaq | 1:55a6170b404f | 291 | break; |
nexpaq | 1:55a6170b404f | 292 | case (TRACE_LEVEL_WARN): |
nexpaq | 1:55a6170b404f | 293 | retval = snprintf(ptr, bLeft, "%s", VT100_COLOR_WARN); |
nexpaq | 1:55a6170b404f | 294 | break; |
nexpaq | 1:55a6170b404f | 295 | case (TRACE_LEVEL_INFO): |
nexpaq | 1:55a6170b404f | 296 | retval = snprintf(ptr, bLeft, "%s", VT100_COLOR_INFO); |
nexpaq | 1:55a6170b404f | 297 | break; |
nexpaq | 1:55a6170b404f | 298 | case (TRACE_LEVEL_DEBUG): |
nexpaq | 1:55a6170b404f | 299 | retval = snprintf(ptr, bLeft, "%s", VT100_COLOR_DEBUG); |
nexpaq | 1:55a6170b404f | 300 | break; |
nexpaq | 1:55a6170b404f | 301 | default: |
nexpaq | 1:55a6170b404f | 302 | color = 0; //avoid unneeded color-terminate code |
nexpaq | 1:55a6170b404f | 303 | retval = 0; |
nexpaq | 1:55a6170b404f | 304 | break; |
nexpaq | 1:55a6170b404f | 305 | } |
nexpaq | 1:55a6170b404f | 306 | if (retval >= bLeft) { |
nexpaq | 1:55a6170b404f | 307 | retval = 0; |
nexpaq | 1:55a6170b404f | 308 | } |
nexpaq | 1:55a6170b404f | 309 | if (retval > 0 && color) { |
nexpaq | 1:55a6170b404f | 310 | ptr += retval; |
nexpaq | 1:55a6170b404f | 311 | bLeft -= retval; |
nexpaq | 1:55a6170b404f | 312 | } |
nexpaq | 1:55a6170b404f | 313 | } |
nexpaq | 1:55a6170b404f | 314 | |
nexpaq | 1:55a6170b404f | 315 | } |
nexpaq | 1:55a6170b404f | 316 | if (bLeft > 0 && m_trace.prefix_f) { |
nexpaq | 1:55a6170b404f | 317 | va_list ap; |
nexpaq | 1:55a6170b404f | 318 | va_start(ap, fmt); |
nexpaq | 1:55a6170b404f | 319 | //find out length of body |
nexpaq | 1:55a6170b404f | 320 | size_t sz = 0; |
nexpaq | 1:55a6170b404f | 321 | sz = vsnprintf(NULL, 0, fmt, ap) + retval + (retval ? 4 : 0); |
nexpaq | 1:55a6170b404f | 322 | //add prefix string |
nexpaq | 1:55a6170b404f | 323 | retval = snprintf(ptr, bLeft, "%s", m_trace.prefix_f(sz)); |
nexpaq | 1:55a6170b404f | 324 | if (retval >= bLeft) { |
nexpaq | 1:55a6170b404f | 325 | retval = 0; |
nexpaq | 1:55a6170b404f | 326 | } |
nexpaq | 1:55a6170b404f | 327 | if (retval > 0) { |
nexpaq | 1:55a6170b404f | 328 | ptr += retval; |
nexpaq | 1:55a6170b404f | 329 | bLeft -= retval; |
nexpaq | 1:55a6170b404f | 330 | } |
nexpaq | 1:55a6170b404f | 331 | va_end(ap); |
nexpaq | 1:55a6170b404f | 332 | } |
nexpaq | 1:55a6170b404f | 333 | if (bLeft > 0) { |
nexpaq | 1:55a6170b404f | 334 | //add group tag |
nexpaq | 1:55a6170b404f | 335 | switch (dlevel) { |
nexpaq | 1:55a6170b404f | 336 | case (TRACE_LEVEL_ERROR): |
nexpaq | 1:55a6170b404f | 337 | retval = snprintf(ptr, bLeft, "[ERR ][%-4s]: ", grp); |
nexpaq | 1:55a6170b404f | 338 | break; |
nexpaq | 1:55a6170b404f | 339 | case (TRACE_LEVEL_WARN): |
nexpaq | 1:55a6170b404f | 340 | retval = snprintf(ptr, bLeft, "[WARN][%-4s]: ", grp); |
nexpaq | 1:55a6170b404f | 341 | break; |
nexpaq | 1:55a6170b404f | 342 | case (TRACE_LEVEL_INFO): |
nexpaq | 1:55a6170b404f | 343 | retval = snprintf(ptr, bLeft, "[INFO][%-4s]: ", grp); |
nexpaq | 1:55a6170b404f | 344 | break; |
nexpaq | 1:55a6170b404f | 345 | case (TRACE_LEVEL_DEBUG): |
nexpaq | 1:55a6170b404f | 346 | retval = snprintf(ptr, bLeft, "[DBG ][%-4s]: ", grp); |
nexpaq | 1:55a6170b404f | 347 | break; |
nexpaq | 1:55a6170b404f | 348 | default: |
nexpaq | 1:55a6170b404f | 349 | retval = snprintf(ptr, bLeft, " "); |
nexpaq | 1:55a6170b404f | 350 | break; |
nexpaq | 1:55a6170b404f | 351 | } |
nexpaq | 1:55a6170b404f | 352 | if (retval >= bLeft) { |
nexpaq | 1:55a6170b404f | 353 | retval = 0; |
nexpaq | 1:55a6170b404f | 354 | } |
nexpaq | 1:55a6170b404f | 355 | if (retval > 0) { |
nexpaq | 1:55a6170b404f | 356 | ptr += retval; |
nexpaq | 1:55a6170b404f | 357 | bLeft -= retval; |
nexpaq | 1:55a6170b404f | 358 | } |
nexpaq | 1:55a6170b404f | 359 | } |
nexpaq | 1:55a6170b404f | 360 | if (retval > 0 && bLeft > 0) { |
nexpaq | 1:55a6170b404f | 361 | va_list ap; |
nexpaq | 1:55a6170b404f | 362 | va_start(ap, fmt); |
nexpaq | 1:55a6170b404f | 363 | //add trace text |
nexpaq | 1:55a6170b404f | 364 | retval = vsnprintf(ptr, bLeft, fmt, ap); |
nexpaq | 1:55a6170b404f | 365 | if (retval >= bLeft) { |
nexpaq | 1:55a6170b404f | 366 | retval = 0; |
nexpaq | 1:55a6170b404f | 367 | } |
nexpaq | 1:55a6170b404f | 368 | if (retval > 0) { |
nexpaq | 1:55a6170b404f | 369 | ptr += retval; |
nexpaq | 1:55a6170b404f | 370 | bLeft -= retval; |
nexpaq | 1:55a6170b404f | 371 | } |
nexpaq | 1:55a6170b404f | 372 | va_end(ap); |
nexpaq | 1:55a6170b404f | 373 | } |
nexpaq | 1:55a6170b404f | 374 | |
nexpaq | 1:55a6170b404f | 375 | if (retval > 0 && bLeft > 0 && m_trace.suffix_f) { |
nexpaq | 1:55a6170b404f | 376 | //add suffix string |
nexpaq | 1:55a6170b404f | 377 | retval = snprintf(ptr, bLeft, "%s", m_trace.suffix_f()); |
nexpaq | 1:55a6170b404f | 378 | if (retval >= bLeft) { |
nexpaq | 1:55a6170b404f | 379 | retval = 0; |
nexpaq | 1:55a6170b404f | 380 | } |
nexpaq | 1:55a6170b404f | 381 | if (retval > 0) { |
nexpaq | 1:55a6170b404f | 382 | ptr += retval; |
nexpaq | 1:55a6170b404f | 383 | bLeft -= retval; |
nexpaq | 1:55a6170b404f | 384 | } |
nexpaq | 1:55a6170b404f | 385 | } |
nexpaq | 1:55a6170b404f | 386 | |
nexpaq | 1:55a6170b404f | 387 | if (retval > 0 && bLeft > 0 && color) { |
nexpaq | 1:55a6170b404f | 388 | //add zero color VT100 when color mode |
nexpaq | 1:55a6170b404f | 389 | retval = snprintf(ptr, bLeft, "\x1b[0m"); |
nexpaq | 1:55a6170b404f | 390 | if (retval >= bLeft) { |
nexpaq | 1:55a6170b404f | 391 | retval = 0; |
nexpaq | 1:55a6170b404f | 392 | } |
nexpaq | 1:55a6170b404f | 393 | if (retval > 0) { |
nexpaq | 1:55a6170b404f | 394 | ptr += retval; |
nexpaq | 1:55a6170b404f | 395 | bLeft -= retval; |
nexpaq | 1:55a6170b404f | 396 | } |
nexpaq | 1:55a6170b404f | 397 | } |
nexpaq | 1:55a6170b404f | 398 | //print out whole data |
nexpaq | 1:55a6170b404f | 399 | m_trace.printf(m_trace.line); |
nexpaq | 1:55a6170b404f | 400 | } |
nexpaq | 1:55a6170b404f | 401 | //return tmp data pointer back to the beginning |
nexpaq | 1:55a6170b404f | 402 | } |
nexpaq | 1:55a6170b404f | 403 | m_trace.tmp_data_ptr = m_trace.tmp_data; |
nexpaq | 1:55a6170b404f | 404 | } |
nexpaq | 1:55a6170b404f | 405 | const char *trace_last(void) |
nexpaq | 1:55a6170b404f | 406 | { |
nexpaq | 1:55a6170b404f | 407 | return m_trace.line; |
nexpaq | 1:55a6170b404f | 408 | } |
nexpaq | 1:55a6170b404f | 409 | /* Helping functions */ |
nexpaq | 1:55a6170b404f | 410 | #define tmp_data_left() m_trace.tmp_data_length-(m_trace.tmp_data_ptr-m_trace.tmp_data) |
nexpaq | 1:55a6170b404f | 411 | char *trace_ipv6(const void *addr_ptr) |
nexpaq | 1:55a6170b404f | 412 | { |
nexpaq | 1:55a6170b404f | 413 | char *str = m_trace.tmp_data_ptr; |
nexpaq | 1:55a6170b404f | 414 | if (str == NULL) { |
nexpaq | 1:55a6170b404f | 415 | return ""; |
nexpaq | 1:55a6170b404f | 416 | } |
nexpaq | 1:55a6170b404f | 417 | if (tmp_data_left() < 41) { |
nexpaq | 1:55a6170b404f | 418 | return ""; |
nexpaq | 1:55a6170b404f | 419 | } |
nexpaq | 1:55a6170b404f | 420 | if (addr_ptr == NULL) { |
nexpaq | 1:55a6170b404f | 421 | return "<null>"; |
nexpaq | 1:55a6170b404f | 422 | } |
nexpaq | 1:55a6170b404f | 423 | str[0] = 0; |
nexpaq | 1:55a6170b404f | 424 | ip6tos(addr_ptr, str); |
nexpaq | 1:55a6170b404f | 425 | m_trace.tmp_data_ptr += strlen(str) + 1; |
nexpaq | 1:55a6170b404f | 426 | return str; |
nexpaq | 1:55a6170b404f | 427 | } |
nexpaq | 1:55a6170b404f | 428 | char *trace_ipv6_prefix(const uint8_t *prefix, uint8_t prefix_len) |
nexpaq | 1:55a6170b404f | 429 | { |
nexpaq | 1:55a6170b404f | 430 | char *str = m_trace.tmp_data_ptr; |
nexpaq | 1:55a6170b404f | 431 | int retval, bLeft = tmp_data_left(); |
nexpaq | 1:55a6170b404f | 432 | char tmp[40]; |
nexpaq | 1:55a6170b404f | 433 | uint8_t addr[16] = {0}; |
nexpaq | 1:55a6170b404f | 434 | |
nexpaq | 1:55a6170b404f | 435 | if (str == NULL) { |
nexpaq | 1:55a6170b404f | 436 | return ""; |
nexpaq | 1:55a6170b404f | 437 | } |
nexpaq | 1:55a6170b404f | 438 | if (bLeft < 40 + 1 + 3 + 1) {// "ipv6 addr" + "/" + "128" + nul |
nexpaq | 1:55a6170b404f | 439 | return ""; |
nexpaq | 1:55a6170b404f | 440 | } |
nexpaq | 1:55a6170b404f | 441 | |
nexpaq | 1:55a6170b404f | 442 | if (prefix_len != 0) { |
nexpaq | 1:55a6170b404f | 443 | if (prefix == NULL || prefix_len > 128) { |
nexpaq | 1:55a6170b404f | 444 | return "<err>"; |
nexpaq | 1:55a6170b404f | 445 | } |
nexpaq | 1:55a6170b404f | 446 | bitcopy(addr, prefix, prefix_len); |
nexpaq | 1:55a6170b404f | 447 | } |
nexpaq | 1:55a6170b404f | 448 | |
nexpaq | 1:55a6170b404f | 449 | ip6tos(addr, tmp); |
nexpaq | 1:55a6170b404f | 450 | retval = snprintf(str, bLeft, "%s/%u", tmp, prefix_len); |
nexpaq | 1:55a6170b404f | 451 | if (retval <= 0 || retval > bLeft) { |
nexpaq | 1:55a6170b404f | 452 | return ""; |
nexpaq | 1:55a6170b404f | 453 | } |
nexpaq | 1:55a6170b404f | 454 | |
nexpaq | 1:55a6170b404f | 455 | m_trace.tmp_data_ptr += retval + 1; |
nexpaq | 1:55a6170b404f | 456 | return str; |
nexpaq | 1:55a6170b404f | 457 | } |
nexpaq | 1:55a6170b404f | 458 | char *trace_array(const uint8_t *buf, uint16_t len) |
nexpaq | 1:55a6170b404f | 459 | { |
nexpaq | 1:55a6170b404f | 460 | int i, retval, bLeft = tmp_data_left(); |
nexpaq | 1:55a6170b404f | 461 | char *str, *wptr; |
nexpaq | 1:55a6170b404f | 462 | str = m_trace.tmp_data_ptr; |
nexpaq | 1:55a6170b404f | 463 | if (str == NULL || bLeft == 0) { |
nexpaq | 1:55a6170b404f | 464 | return ""; |
nexpaq | 1:55a6170b404f | 465 | } |
nexpaq | 1:55a6170b404f | 466 | if (buf == NULL) { |
nexpaq | 1:55a6170b404f | 467 | return "<null>"; |
nexpaq | 1:55a6170b404f | 468 | } |
nexpaq | 1:55a6170b404f | 469 | if (!bLeft) { |
nexpaq | 1:55a6170b404f | 470 | return ""; |
nexpaq | 1:55a6170b404f | 471 | } |
nexpaq | 1:55a6170b404f | 472 | wptr = str; |
nexpaq | 1:55a6170b404f | 473 | wptr[0] = 0; |
nexpaq | 1:55a6170b404f | 474 | const uint8_t *ptr = buf; |
nexpaq | 1:55a6170b404f | 475 | char overflow = 0; |
nexpaq | 1:55a6170b404f | 476 | for (i = 0; i < len; i++) { |
nexpaq | 1:55a6170b404f | 477 | if (bLeft <= 3) { |
nexpaq | 1:55a6170b404f | 478 | overflow = 1; |
nexpaq | 1:55a6170b404f | 479 | break; |
nexpaq | 1:55a6170b404f | 480 | } |
nexpaq | 1:55a6170b404f | 481 | retval = snprintf(wptr, bLeft, "%02x:", *ptr++); |
nexpaq | 1:55a6170b404f | 482 | if (retval <= 0 || retval > bLeft) { |
nexpaq | 1:55a6170b404f | 483 | break; |
nexpaq | 1:55a6170b404f | 484 | } |
nexpaq | 1:55a6170b404f | 485 | bLeft -= retval; |
nexpaq | 1:55a6170b404f | 486 | wptr += retval; |
nexpaq | 1:55a6170b404f | 487 | } |
nexpaq | 1:55a6170b404f | 488 | if (wptr > str) { |
nexpaq | 1:55a6170b404f | 489 | if( overflow ) { |
nexpaq | 1:55a6170b404f | 490 | // replace last character as 'star', |
nexpaq | 1:55a6170b404f | 491 | // which indicate buffer len is not enough |
nexpaq | 1:55a6170b404f | 492 | *(wptr - 1) = '*'; |
nexpaq | 1:55a6170b404f | 493 | } else { |
nexpaq | 1:55a6170b404f | 494 | //null to replace last ':' character |
nexpaq | 1:55a6170b404f | 495 | *(wptr - 1) = 0; |
nexpaq | 1:55a6170b404f | 496 | } |
nexpaq | 1:55a6170b404f | 497 | } |
nexpaq | 1:55a6170b404f | 498 | m_trace.tmp_data_ptr = wptr; |
nexpaq | 1:55a6170b404f | 499 | return str; |
nexpaq | 1:55a6170b404f | 500 | } |
nexpaq | 1:55a6170b404f | 501 | #endif /* NS_TRACE_USE_MBED_TRACE */ |
nexpaq | 1:55a6170b404f | 502 | |
nexpaq | 1:55a6170b404f | 503 | // rest of debug print functions will be obsolete and will be overridden with new trace interface.. |
nexpaq | 1:55a6170b404f | 504 | void debugf(const char *fmt, ...) |
nexpaq | 1:55a6170b404f | 505 | { |
nexpaq | 1:55a6170b404f | 506 | va_list ap; |
nexpaq | 1:55a6170b404f | 507 | va_start(ap, fmt); |
nexpaq | 1:55a6170b404f | 508 | vprintf(fmt, ap); |
nexpaq | 1:55a6170b404f | 509 | va_end(ap); |
nexpaq | 1:55a6170b404f | 510 | } |
nexpaq | 1:55a6170b404f | 511 | |
nexpaq | 1:55a6170b404f | 512 | void debug(const char *s) |
nexpaq | 1:55a6170b404f | 513 | { |
nexpaq | 1:55a6170b404f | 514 | fputs(s, stdout); |
nexpaq | 1:55a6170b404f | 515 | } |
nexpaq | 1:55a6170b404f | 516 | |
nexpaq | 1:55a6170b404f | 517 | void debug_put(char c) |
nexpaq | 1:55a6170b404f | 518 | { |
nexpaq | 1:55a6170b404f | 519 | putchar(c); |
nexpaq | 1:55a6170b404f | 520 | } |
nexpaq | 1:55a6170b404f | 521 | |
nexpaq | 1:55a6170b404f | 522 | void debug_hex(uint8_t x) |
nexpaq | 1:55a6170b404f | 523 | { |
nexpaq | 1:55a6170b404f | 524 | printf("%02x", x); |
nexpaq | 1:55a6170b404f | 525 | } |
nexpaq | 1:55a6170b404f | 526 | void debug_int(int i) |
nexpaq | 1:55a6170b404f | 527 | { |
nexpaq | 1:55a6170b404f | 528 | printf("%d", i); |
nexpaq | 1:55a6170b404f | 529 | } |
nexpaq | 1:55a6170b404f | 530 | void printf_array(const void *buf , uint16_t len) |
nexpaq | 1:55a6170b404f | 531 | { |
nexpaq | 1:55a6170b404f | 532 | int i; |
nexpaq | 1:55a6170b404f | 533 | const uint8_t *ptr = buf; |
nexpaq | 1:55a6170b404f | 534 | for (i = 0; i < len; i++) { |
nexpaq | 1:55a6170b404f | 535 | if (i && (0 == i % 16)) { |
nexpaq | 1:55a6170b404f | 536 | putchar('\n'); |
nexpaq | 1:55a6170b404f | 537 | } |
nexpaq | 1:55a6170b404f | 538 | printf("%02x:", *ptr++); |
nexpaq | 1:55a6170b404f | 539 | |
nexpaq | 1:55a6170b404f | 540 | } |
nexpaq | 1:55a6170b404f | 541 | putchar('\n'); |
nexpaq | 1:55a6170b404f | 542 | } |
nexpaq | 1:55a6170b404f | 543 | void printf_ipv6_address(const void *addr_ptr) |
nexpaq | 1:55a6170b404f | 544 | { |
nexpaq | 1:55a6170b404f | 545 | char buf[40] = {0}; |
nexpaq | 1:55a6170b404f | 546 | ip6tos(addr_ptr, buf); |
nexpaq | 1:55a6170b404f | 547 | printf("%s\n", buf); |
nexpaq | 1:55a6170b404f | 548 | } |
nexpaq | 1:55a6170b404f | 549 | void printf_string(const void *ptr, uint16_t len) |
nexpaq | 1:55a6170b404f | 550 | { |
nexpaq | 1:55a6170b404f | 551 | printf("%.*s\n", len, (const char *)ptr); |
nexpaq | 1:55a6170b404f | 552 | } |