forked from u-blox/ubxlib
-
Notifications
You must be signed in to change notification settings - Fork 0
/
u_port_debug.c
108 lines (86 loc) · 2.86 KB
/
u_port_debug.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
/*
* Copyright 2019-2024 u-blox
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
/** @file
* @brief Implementation of the port debug API for the STM32F4 platform.
*/
#ifdef U_CFG_OVERRIDE
# include "u_cfg_override.h" // For a customer's configuration override
#endif
#include "stdarg.h"
#include "stdio.h" // vprintf()
#include "stdint.h"
#include "stdbool.h"
#include "u_port_clib_platform_specific.h" /* Integer stdio, must be included
before the other port files if
any print or scan function is used. */
#include "u_error_common.h"
#include "stm32f437xx.h" // For ITM_SendChar()
/* ----------------------------------------------------------------
* COMPILE-TIME MACROS
* -------------------------------------------------------------- */
/* ----------------------------------------------------------------
* TYPES
* -------------------------------------------------------------- */
/* ----------------------------------------------------------------
* VARIABLES
* -------------------------------------------------------------- */
/** Keep track of whether logging is on or off.
*/
static bool gPortLogOn = true;
/** Only used for detecting inactivity
*/
volatile int32_t gStdoutCounter;
/* ----------------------------------------------------------------
* STATIC FUNCTIONS
* -------------------------------------------------------------- */
/* ----------------------------------------------------------------
* PUBLIC FUNCTIONS
* -------------------------------------------------------------- */
// This function will replace the weakly-linked _write() function in
// syscalls.c and will send output to the SWV trace port.
int _write(int file, char *pStr, int len)
{
(void) file;
for (size_t x = 0 ; x < len ; x++) {
ITM_SendChar(*pStr);
pStr++;
}
return len;
}
// printf()-style logging.
void uPortLogF(const char *pFormat, ...)
{
va_list args;
if (gPortLogOn) {
va_start(args, pFormat);
vprintf(pFormat, args);
va_end(args);
}
gStdoutCounter++;
}
// Switch logging off.
int32_t uPortLogOff(void)
{
gPortLogOn = false;
return (int32_t) U_ERROR_COMMON_SUCCESS;
}
// Switch logging on.
int32_t uPortLogOn(void)
{
gPortLogOn = true;
return (int32_t) U_ERROR_COMMON_SUCCESS;
}
// End of file