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