diff options
Diffstat (limited to 'utils/hwstub/stub/logf.c')
-rw-r--r-- | utils/hwstub/stub/logf.c | 69 |
1 files changed, 69 insertions, 0 deletions
diff --git a/utils/hwstub/stub/logf.c b/utils/hwstub/stub/logf.c new file mode 100644 index 0000000000..623ddb1c6c --- /dev/null +++ b/utils/hwstub/stub/logf.c | |||
@@ -0,0 +1,69 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id$ | ||
9 | * | ||
10 | * Copyright (C) 2012 by Amaury Pouly | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #include "config.h" | ||
22 | #include "logf.h" | ||
23 | #include "format.h" | ||
24 | #include "string.h" | ||
25 | #include "memory.h" | ||
26 | |||
27 | static unsigned char logfbuffer[MAX_LOGF_SIZE]; | ||
28 | static int logfread = 0; | ||
29 | static int logfwrite = 0; | ||
30 | static int logfen = true; | ||
31 | |||
32 | void enable_logf(bool en) | ||
33 | { | ||
34 | logfen = en; | ||
35 | } | ||
36 | |||
37 | static int logf_push(void *userp, unsigned char c) | ||
38 | { | ||
39 | (void)userp; | ||
40 | |||
41 | logfbuffer[logfwrite++] = c; | ||
42 | if(logfwrite == MAX_LOGF_SIZE) | ||
43 | logfwrite = 0; | ||
44 | return true; | ||
45 | } | ||
46 | |||
47 | void logf(const char *fmt, ...) | ||
48 | { | ||
49 | if(!logfen) return; | ||
50 | va_list ap; | ||
51 | va_start(ap, fmt); | ||
52 | vuprintf(logf_push, NULL, fmt, ap); | ||
53 | va_end(ap); | ||
54 | } | ||
55 | |||
56 | size_t logf_readback(char *buf, size_t max_size) | ||
57 | { | ||
58 | if(logfread == logfwrite) | ||
59 | return 0; | ||
60 | if(logfread < logfwrite) | ||
61 | max_size = MIN(max_size, (size_t)(logfwrite - logfread)); | ||
62 | else | ||
63 | max_size = MIN(max_size, (size_t)(MAX_LOGF_SIZE - logfread)); | ||
64 | memcpy(buf, &logfbuffer[logfread], max_size); | ||
65 | logfread += max_size; | ||
66 | if(logfread == MAX_LOGF_SIZE) | ||
67 | logfread = 0; | ||
68 | return max_size; | ||
69 | } | ||