[175] | 1 | /* Error & Logging functions
|
---|
| 2 |
|
---|
| 3 | Copyright (C) 2010 Travis Robinson. <libusbdotnet@gmail.com>
|
---|
| 4 | website: http://sourceforge.net/projects/libusb-win32
|
---|
| 5 |
|
---|
| 6 | This program is free software; you can redistribute it and/or modify it
|
---|
| 7 | under the terms of the GNU Lesser General Public License as published by
|
---|
| 8 | the Free Software Foundation; either version 2 of the License, or
|
---|
| 9 | (at your option) any later version.
|
---|
| 10 |
|
---|
| 11 | This program is distributed in the hope that it will be useful, but
|
---|
| 12 | WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
|
---|
| 13 | or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public
|
---|
| 14 | License for more details.
|
---|
| 15 |
|
---|
| 16 | You should have received a copy of the GNU Lesser General Public License
|
---|
| 17 | along with this program; if not, please visit www.gnu.org.
|
---|
| 18 | */
|
---|
| 19 |
|
---|
| 20 | #include "error.h"
|
---|
| 21 | #include <errno.h>
|
---|
| 22 | #include <string.h>
|
---|
| 23 | #include <stdio.h>
|
---|
| 24 |
|
---|
| 25 | #if IS_DRIVER
|
---|
| 26 | #ifdef __GNUC__
|
---|
| 27 | #define OBJ_KERNEL_HANDLE 0x00000200L
|
---|
| 28 | #include <ddk/usb100.h>
|
---|
| 29 | #include <ddk/usbdi.h>
|
---|
| 30 | #include <ddk/winddk.h>
|
---|
| 31 | #include "usbdlib_gcc.h"
|
---|
| 32 | #else
|
---|
| 33 | #include <ntddk.h>
|
---|
| 34 | #endif
|
---|
| 35 | #else
|
---|
| 36 | #include <windows.h>
|
---|
| 37 | #endif
|
---|
| 38 |
|
---|
| 39 | #define USB_ERROR_BEGIN 500000
|
---|
| 40 |
|
---|
| 41 | #ifndef LOG_APPNAME
|
---|
| 42 | #define LOG_APPNAME "LOG_APPNAME define missing"
|
---|
| 43 | #endif
|
---|
| 44 |
|
---|
| 45 | #define GetLogLevel(UsbLogLevel) ((UsbLogLevel & LOG_LEVEL_MASK)>LOG_LEVEL_MAX?LOG_LEVEL_MAX:UsbLogLevel & LOG_LEVEL_MASK)
|
---|
| 46 | #define GetLogOuput(LogOutputType) (LogOutputType>0?(_LOG_OUTPUT_TYPE & LogOutputType):1)
|
---|
| 47 |
|
---|
| 48 | void usb_err_v (const char* function, const char* format, va_list args);
|
---|
| 49 | void usb_wrn_v (const char* function, const char* format, va_list args);
|
---|
| 50 | void usb_msg_v (const char* function, const char* format, va_list args);
|
---|
| 51 | void usb_dbg_v (const char* function, const char* format, va_list args);
|
---|
| 52 |
|
---|
| 53 | void usb_log_v (enum USB_LOG_LEVEL level, const char* function, const char* format, va_list args);
|
---|
| 54 | void _usb_log (enum USB_LOG_LEVEL level, const char* app_name, const char* function, const char* format, ...);
|
---|
| 55 | void _usb_log_v (enum USB_LOG_LEVEL level, const char* app_name, const char* function, const char* format, va_list args);
|
---|
| 56 |
|
---|
| 57 | static int usb_log_def_handler(enum USB_LOG_LEVEL level,
|
---|
| 58 | const char* app_name,
|
---|
| 59 | const char* prefix,
|
---|
| 60 | const char* func,
|
---|
| 61 | int app_prefix_func_end,
|
---|
| 62 | char* message,
|
---|
| 63 | int message_length);
|
---|
| 64 |
|
---|
| 65 | #define STRIP_PREFIX(stringSrc, stringPrefix) \
|
---|
| 66 | (strstr(stringSrc,stringPrefix)==stringSrc?stringSrc+strlen(stringPrefix):stringSrc)
|
---|
| 67 |
|
---|
| 68 | static const char *log_level_string[LOG_LEVEL_MAX+1] =
|
---|
| 69 | {
|
---|
| 70 | "off",
|
---|
| 71 | "err",
|
---|
| 72 | "wrn",
|
---|
| 73 | "",
|
---|
| 74 | "dbg",
|
---|
| 75 |
|
---|
| 76 | "unknown",
|
---|
| 77 | };
|
---|
| 78 |
|
---|
| 79 | static const char *skipped_function_prefix_list[] =
|
---|
| 80 | {
|
---|
| 81 | "usb_registry_",
|
---|
| 82 | "usb_",
|
---|
| 83 | NULL
|
---|
| 84 | };
|
---|
| 85 |
|
---|
| 86 | int usb_error_errno = 0;
|
---|
| 87 | log_hander_t user_log_hander = NULL;
|
---|
| 88 |
|
---|
| 89 | #if (defined(_DEBUG) || defined(DEBUG) || defined(DBG))
|
---|
| 90 | int __usb_log_level = LOG_LEVEL_MAX;
|
---|
| 91 | #else
|
---|
| 92 | int __usb_log_level = LOG_OFF;
|
---|
| 93 | #endif
|
---|
| 94 |
|
---|
| 95 | usb_error_type_t usb_error_type = USB_ERROR_TYPE_NONE;
|
---|
| 96 |
|
---|
| 97 | const char** skipped_function_prefix = skipped_function_prefix_list;
|
---|
| 98 |
|
---|
| 99 | #if !IS_DRIVER
|
---|
| 100 |
|
---|
| 101 | char usb_error_str[LOGBUF_SIZE] = "";
|
---|
| 102 |
|
---|
| 103 | char *usb_strerror(void)
|
---|
| 104 | {
|
---|
| 105 | switch (usb_error_type)
|
---|
| 106 | {
|
---|
| 107 | case USB_ERROR_TYPE_NONE:
|
---|
| 108 | return "No error";
|
---|
| 109 | case USB_ERROR_TYPE_STRING:
|
---|
| 110 | return usb_error_str;
|
---|
| 111 | case USB_ERROR_TYPE_ERRNO:
|
---|
| 112 | if (usb_error_errno > -USB_ERROR_BEGIN)
|
---|
| 113 | return strerror(usb_error_errno);
|
---|
| 114 | else
|
---|
| 115 | /* Any error we don't know falls under here */
|
---|
| 116 | return "Unknown error";
|
---|
| 117 | }
|
---|
| 118 |
|
---|
| 119 | return "Unknown error";
|
---|
| 120 | }
|
---|
| 121 |
|
---|
| 122 | /* returns Windows' last error in a human readable form */
|
---|
| 123 | const char *usb_win_error_to_string(void)
|
---|
| 124 | {
|
---|
| 125 | static char tmp[LOGBUF_SIZE];
|
---|
| 126 |
|
---|
| 127 | FormatMessage(FORMAT_MESSAGE_FROM_SYSTEM, NULL, GetLastError(),
|
---|
| 128 | LANG_USER_DEFAULT, tmp, sizeof(tmp) - 1, NULL);
|
---|
| 129 |
|
---|
| 130 | return tmp;
|
---|
| 131 | }
|
---|
| 132 |
|
---|
| 133 |
|
---|
| 134 | int usb_win_error_to_errno(void)
|
---|
| 135 | {
|
---|
| 136 | switch (GetLastError())
|
---|
| 137 | {
|
---|
| 138 | case ERROR_SUCCESS:
|
---|
| 139 | return 0;
|
---|
| 140 | case ERROR_INVALID_PARAMETER:
|
---|
| 141 | return EINVAL;
|
---|
| 142 | case ERROR_SEM_TIMEOUT:
|
---|
| 143 | case ERROR_OPERATION_ABORTED:
|
---|
| 144 | return ETRANSFER_TIMEDOUT;
|
---|
| 145 | case ERROR_NOT_ENOUGH_MEMORY:
|
---|
| 146 | return ENOMEM;
|
---|
| 147 | default:
|
---|
| 148 | return EIO;
|
---|
| 149 | }
|
---|
| 150 | }
|
---|
| 151 |
|
---|
| 152 | #endif
|
---|
| 153 |
|
---|
| 154 | void usb_err(const char* function, const char* format, ...)
|
---|
| 155 | {
|
---|
| 156 | va_list args;
|
---|
| 157 | va_start(args, format);
|
---|
| 158 | usb_err_v(function, format, args);
|
---|
| 159 | va_end(args);
|
---|
| 160 | }
|
---|
| 161 | void usb_wrn(const char* function, const char* format, ...)
|
---|
| 162 | {
|
---|
| 163 | va_list args;
|
---|
| 164 | va_start(args, format);
|
---|
| 165 | usb_wrn_v(function, format, args);
|
---|
| 166 | va_end(args);
|
---|
| 167 | }
|
---|
| 168 |
|
---|
| 169 | void usb_msg(const char* function, const char* format, ...)
|
---|
| 170 | {
|
---|
| 171 | va_list args;
|
---|
| 172 | va_start(args, format);
|
---|
| 173 | usb_msg_v(function, format, args);
|
---|
| 174 | va_end(args);
|
---|
| 175 | }
|
---|
| 176 |
|
---|
| 177 | void usb_dbg(const char* function, const char* format, ...)
|
---|
| 178 | {
|
---|
| 179 | va_list args;
|
---|
| 180 | va_start(args, format);
|
---|
| 181 | usb_dbg_v(function, format, args);
|
---|
| 182 | va_end(args);
|
---|
| 183 | }
|
---|
| 184 |
|
---|
| 185 | void usb_log(enum USB_LOG_LEVEL level, const char* function, const char* format, ...)
|
---|
| 186 | {
|
---|
| 187 | va_list args;
|
---|
| 188 | va_start(args, format);
|
---|
| 189 | usb_log_v(level, function, format, args);
|
---|
| 190 | va_end(args);
|
---|
| 191 | }
|
---|
| 192 |
|
---|
| 193 | void usb_err_v(const char* function, const char* format, va_list args)
|
---|
| 194 | {
|
---|
| 195 | usb_log_v(LOG_ERROR, function, format, args);
|
---|
| 196 | }
|
---|
| 197 |
|
---|
| 198 | void usb_wrn_v(const char* function, const char* format, va_list args)
|
---|
| 199 | {
|
---|
| 200 | usb_log_v(LOG_WARNING, function, format, args);
|
---|
| 201 | }
|
---|
| 202 |
|
---|
| 203 | void usb_msg_v(const char* function, const char* format, va_list args)
|
---|
| 204 | {
|
---|
| 205 | usb_log_v(LOG_INFO, function, format, args);
|
---|
| 206 | }
|
---|
| 207 |
|
---|
| 208 | void usb_dbg_v(const char* function, const char* format, va_list args)
|
---|
| 209 | {
|
---|
| 210 | usb_log_v(LOG_DEBUG, function, format, args);
|
---|
| 211 | }
|
---|
| 212 |
|
---|
| 213 | void usb_log_v(enum USB_LOG_LEVEL level, const char* function, const char* format, va_list args)
|
---|
| 214 | {
|
---|
| 215 | _usb_log_v(level, LOG_APPNAME, function, format, args);
|
---|
| 216 | }
|
---|
| 217 |
|
---|
| 218 | void _usb_log(enum USB_LOG_LEVEL level, const char* app_name, const char* function, const char* format, ...)
|
---|
| 219 | {
|
---|
| 220 | va_list args;
|
---|
| 221 | va_start(args, format);
|
---|
| 222 | _usb_log_v(level, app_name, function, format, args);
|
---|
| 223 | va_end(args);
|
---|
| 224 | }
|
---|
| 225 |
|
---|
| 226 | void _usb_log_v(enum USB_LOG_LEVEL level,
|
---|
| 227 | const char* app_name,
|
---|
| 228 | const char* function,
|
---|
| 229 | const char* format,
|
---|
| 230 | va_list args)
|
---|
| 231 | {
|
---|
| 232 |
|
---|
| 233 | char local_buffer[LOGBUF_SIZE];
|
---|
| 234 | int totalCount, count;
|
---|
| 235 | const char* prefix;
|
---|
| 236 | const char* func;
|
---|
| 237 | char* buffer;
|
---|
| 238 | int masked_level;
|
---|
| 239 | int app_prefix_func_end;
|
---|
| 240 | #ifndef LOG_STYLE_SHORT
|
---|
| 241 | const char** skip_list = NULL;
|
---|
| 242 | #endif
|
---|
| 243 |
|
---|
| 244 | masked_level = GetLogLevel(level);
|
---|
| 245 |
|
---|
| 246 | if (__usb_log_level < masked_level && masked_level != LOG_ERROR) return;
|
---|
| 247 | buffer = local_buffer;
|
---|
| 248 | totalCount = 0;
|
---|
| 249 | count = 0;
|
---|
| 250 | prefix = log_level_string[masked_level];
|
---|
| 251 | func = function;
|
---|
| 252 | app_prefix_func_end = 0;
|
---|
| 253 |
|
---|
| 254 | if (masked_level > LOG_LEVEL_MAX) masked_level = LOG_LEVEL_MAX;
|
---|
| 255 |
|
---|
| 256 | if ((level & LOG_RAW) == LOG_RAW)
|
---|
| 257 | {
|
---|
| 258 | count = _vsnprintf(buffer, LOGBUF_SIZE-1, format, args);
|
---|
| 259 | if (count > 0)
|
---|
| 260 | {
|
---|
| 261 | buffer += count;
|
---|
| 262 | totalCount += count;
|
---|
| 263 | }
|
---|
| 264 | }
|
---|
| 265 | else
|
---|
| 266 | {
|
---|
| 267 | #ifdef LOG_STYLE_SHORT
|
---|
| 268 | if ((prefix) && strlen(prefix))
|
---|
| 269 | {
|
---|
| 270 | count = _snprintf(buffer, (LOGBUF_SIZE-1), "%s: ", prefix);
|
---|
| 271 | }
|
---|
| 272 | else
|
---|
| 273 | {
|
---|
| 274 | count = 0;
|
---|
| 275 | }
|
---|
| 276 | func = "";
|
---|
| 277 | #else
|
---|
| 278 | func = function;
|
---|
| 279 |
|
---|
| 280 | if (func)
|
---|
| 281 | {
|
---|
| 282 | // strip some prefixes to shorten function names
|
---|
| 283 | skip_list=skipped_function_prefix;
|
---|
| 284 | while(*skip_list && ((func)) && func[0])
|
---|
| 285 | {
|
---|
| 286 | func = STRIP_PREFIX(func,skip_list[0]);
|
---|
| 287 | skip_list++;
|
---|
| 288 | }
|
---|
| 289 | }
|
---|
| 290 |
|
---|
| 291 | if(!func) func="none";
|
---|
| 292 |
|
---|
| 293 | // print app name, level string and short function name
|
---|
| 294 | if ((prefix) && strlen(prefix))
|
---|
| 295 | {
|
---|
| 296 | count = _snprintf(buffer, (LOGBUF_SIZE-1), "%s:%s [%s] ", app_name, prefix, func);
|
---|
| 297 | }
|
---|
| 298 | else
|
---|
| 299 | {
|
---|
| 300 | count = _snprintf(buffer, (LOGBUF_SIZE-1), "%s:[%s] ", app_name, func);
|
---|
| 301 | }
|
---|
| 302 | #endif
|
---|
| 303 |
|
---|
| 304 | if (count >= 0)
|
---|
| 305 | {
|
---|
| 306 | app_prefix_func_end = count;
|
---|
| 307 | buffer += count;
|
---|
| 308 | totalCount += count;
|
---|
| 309 | count = _vsnprintf(buffer, (LOGBUF_SIZE-1) - totalCount, format, args);
|
---|
| 310 | if (count > 0)
|
---|
| 311 | {
|
---|
| 312 | buffer += count;
|
---|
| 313 | totalCount += count;
|
---|
| 314 | }
|
---|
| 315 | }
|
---|
| 316 | }
|
---|
| 317 |
|
---|
| 318 | if (count < 0)
|
---|
| 319 | totalCount = LOGBUF_SIZE - 1;
|
---|
| 320 |
|
---|
| 321 | // make sure its null terminated
|
---|
| 322 | local_buffer[totalCount] = 0;
|
---|
| 323 |
|
---|
| 324 | #if (!IS_DRIVER)
|
---|
| 325 | if (masked_level == LOG_ERROR)
|
---|
| 326 | {
|
---|
| 327 | // if this is an error message then store it
|
---|
| 328 | strncpy(usb_error_str, local_buffer, totalCount);
|
---|
| 329 | usb_error_str[totalCount] = '\0';
|
---|
| 330 | usb_error_type = USB_ERROR_TYPE_STRING;
|
---|
| 331 | }
|
---|
| 332 | #endif
|
---|
| 333 |
|
---|
| 334 | if (user_log_hander)
|
---|
| 335 | {
|
---|
| 336 | if (user_log_hander(level, app_name, prefix, func, app_prefix_func_end, local_buffer, totalCount))
|
---|
| 337 | return;
|
---|
| 338 | }
|
---|
| 339 | if (__usb_log_level >= masked_level)
|
---|
| 340 | {
|
---|
| 341 | usb_log_def_handler(level, app_name, prefix, func, app_prefix_func_end, local_buffer, totalCount);
|
---|
| 342 | }
|
---|
| 343 | }
|
---|
| 344 |
|
---|
| 345 | void usb_log_set_level(enum USB_LOG_LEVEL level)
|
---|
| 346 | {
|
---|
| 347 | // Debug builds of the driver force all messages on; all the time;
|
---|
| 348 | // Application can no longer change this.
|
---|
| 349 | //
|
---|
| 350 | #if (defined(_DEBUG) || defined(DEBUG) || defined(DBG))
|
---|
| 351 | __usb_log_level = LOG_LEVEL_MAX;
|
---|
| 352 | #else
|
---|
| 353 | __usb_log_level = level > LOG_LEVEL_MAX ? LOG_LEVEL_MAX : level;
|
---|
| 354 | #endif
|
---|
| 355 | }
|
---|
| 356 |
|
---|
| 357 | int usb_log_get_level()
|
---|
| 358 | {
|
---|
| 359 | return __usb_log_level;
|
---|
| 360 | }
|
---|
| 361 |
|
---|
| 362 | /* Default log handler
|
---|
| 363 | */
|
---|
| 364 | static int usb_log_def_handler(enum USB_LOG_LEVEL level,
|
---|
| 365 | const char* app_name,
|
---|
| 366 | const char* prefix,
|
---|
| 367 | const char* func,
|
---|
| 368 | int app_prefix_func_end,
|
---|
| 369 | char* message,
|
---|
| 370 | int message_length)
|
---|
| 371 | {
|
---|
| 372 | #if IS_DRIVER
|
---|
| 373 | DbgPrint("%s",message);
|
---|
| 374 | #else
|
---|
| 375 | #if GetLogOuput(LOG_OUTPUT_TYPE_FILE)
|
---|
| 376 | FILE* file;
|
---|
| 377 | file = fopen(LOG_FILE_PATH,"a");
|
---|
| 378 | if (file)
|
---|
| 379 | {
|
---|
| 380 | fwrite(message,1,strlen(message),file);
|
---|
| 381 | fflush(file);
|
---|
| 382 | fclose(file);
|
---|
| 383 | }
|
---|
| 384 | #endif
|
---|
| 385 |
|
---|
| 386 | #if GetLogOuput(LOG_OUTPUT_TYPE_STDERR)
|
---|
| 387 | fprintf(stderr, "%s", message);
|
---|
| 388 | #endif
|
---|
| 389 |
|
---|
| 390 | #if GetLogOuput(LOG_OUTPUT_TYPE_DEBUGWINDOW)
|
---|
| 391 | OutputDebugStringA(message);
|
---|
| 392 | #endif
|
---|
| 393 |
|
---|
| 394 |
|
---|
| 395 | #if GetLogOuput(LOG_OUTPUT_TYPE_MSGBOX)
|
---|
| 396 | if (GetLogLevel(level)==LOG_ERROR)
|
---|
| 397 | {
|
---|
| 398 | message[app_prefix_func_end-1]='\0';
|
---|
| 399 | MessageBoxA(NULL,message+strlen(message),message,MB_OK|MB_ICONERROR);
|
---|
| 400 | }
|
---|
| 401 | #endif
|
---|
| 402 |
|
---|
| 403 | #endif // IS_DRIVER
|
---|
| 404 |
|
---|
| 405 | return 1;
|
---|
| 406 | }
|
---|
| 407 |
|
---|
| 408 | void usb_log_set_handler(log_hander_t log_hander)
|
---|
| 409 | {
|
---|
| 410 | user_log_hander = log_hander;
|
---|
| 411 | }
|
---|
| 412 |
|
---|
| 413 | log_hander_t usb_log_get_handler(void)
|
---|
| 414 | {
|
---|
| 415 | return user_log_hander;
|
---|
| 416 | }
|
---|