foxBMS  1.3.0
The foxBMS Battery Management System API Documentation
foxmath.c
Go to the documentation of this file.
1 /**
2  *
3  * @copyright © 2010 - 2022, Fraunhofer-Gesellschaft zur Foerderung der angewandten Forschung e.V.
4  * All rights reserved.
5  *
6  * SPDX-License-Identifier: BSD-3-Clause
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions are met:
10  *
11  * 1. Redistributions of source code must retain the above copyright notice, this
12  * list of conditions and the following disclaimer.
13  *
14  * 2. Redistributions in binary form must reproduce the above copyright notice,
15  * this list of conditions and the following disclaimer in the documentation
16  * and/or other materials provided with the distribution.
17  *
18  * 3. Neither the name of the copyright holder nor the names of its
19  * contributors may be used to endorse or promote products derived from
20  * this software without specific prior written permission.
21  *
22  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
23  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
25  * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
26  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
28  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
29  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
30  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
31  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32  *
33  * We kindly request you to use one or more of the following phrases to refer to
34  * foxBMS in your hardware, software, documentation or advertising materials:
35  *
36  * - ″This product uses parts of foxBMS®″
37  * - ″This product includes parts of foxBMS®″
38  * - ″This product is derived from foxBMS®″
39  *
40  */
41 
42 /**
43  * @file foxmath.c
44  * @author foxBMS Team
45  * @date 2018-01-18 (date of creation)
46  * @updated 2022-05-30 (date of last update)
47  * @version v1.3.0
48  * @ingroup DRIVERS
49  * @prefix MATH
50  *
51  * @brief mathlib function implementations
52  *
53  */
54 
55 /*========== Includes =======================================================*/
56 #include "foxmath.h"
57 
58 /*========== Macros and Definitions =========================================*/
59 /** shift one byte (8 positions) */
60 #define SHIFT_ONE_BYTE (8u)
61 
62 /** shift two bytes (16 positions) */
63 #define SHIFT_TWO_BYTES (16u)
64 
65 /** shift four bytes (32 positions) */
66 #define SHIFT_FOUR_BYTES (32u)
67 
68 /*========== Static Constant and Variable Definitions =======================*/
69 
70 /*========== Extern Constant and Variable Definitions =======================*/
71 
72 /*========== Static Function Prototypes =====================================*/
73 
74 /*========== Static Function Implementations ================================*/
75 
76 /*========== Extern Function Implementations ================================*/
77 
78 /* AXIVION Disable Style Generic-MissingParameterAssert: If not specified otherwise, functions in this lib are designed to take full range input. No assert needed. */
79 
80 extern void MATH_StartupSelfTest(void) {
81  FAS_ASSERT(MATH_AbsInt64_t(INT64_MIN) == INT64_MAX);
82  FAS_ASSERT(MATH_AbsInt32_t(INT32_MIN) == INT32_MAX);
83 }
84 
86  const float x1,
87  const float y1,
88  const float x2,
89  const float y2,
90  const float x_interpolate) {
91  float slope = 0.0f;
92 
93  if (fabsf(x1 - x2) >= FLT_EPSILON) {
94  /* Calculate slope */
95  slope = (y2 - y1) / (x2 - x1);
96  }
97  /* In the case that the if clause is not entered (x values are identical)
98  * -> no interpolation possible: return y1 value
99  * -> slope takes initialization value of 0.0f
100  */
101 
102  /* Interpolate starting from x1/y1 */
103  float y_interpolate = y1 + (slope * (x_interpolate - x1));
104 
105  return y_interpolate;
106 }
107 
108 extern uint16_t MATH_SwapBytesUint16_t(const uint16_t val) {
109  return (val << SHIFT_ONE_BYTE) | (val >> SHIFT_ONE_BYTE);
110 }
111 
112 extern uint32_t MATH_SwapBytesUint32_t(const uint32_t val) {
113  const uint32_t alternating2PatternStartFF = 0xFF00FF00u;
114  const uint32_t alternating2PatternStart00 = 0x00FF00FFu;
115  const uint32_t intermediate = ((val << SHIFT_ONE_BYTE) & alternating2PatternStartFF) |
116  ((val >> SHIFT_ONE_BYTE) & alternating2PatternStart00);
117  return (intermediate << SHIFT_TWO_BYTES) | (intermediate >> SHIFT_TWO_BYTES);
118 }
119 
120 extern uint64_t MATH_SwapBytesUint64_t(const uint64_t val) {
121  const uint64_t alternating2PatternStartFF = 0xFF00FF00FF00FF00uLL;
122  const uint64_t alternating2PatternStart00 = 0x00FF00FF00FF00FFuLL;
123  const uint64_t alternating4PatternStartFFFF = 0xFFFF0000FFFF0000uLL;
124  const uint64_t alternating4PatternStart0000 = 0x0000FFFF0000FFFFuLL;
125 
126  uint64_t intermediate = ((val << SHIFT_ONE_BYTE) & alternating2PatternStartFF) |
127  ((val >> SHIFT_ONE_BYTE) & alternating2PatternStart00);
128  intermediate = ((intermediate << SHIFT_TWO_BYTES) & alternating4PatternStartFFFF) |
129  ((intermediate >> SHIFT_TWO_BYTES) & alternating4PatternStart0000);
130  return (intermediate << SHIFT_FOUR_BYTES) | (intermediate >> SHIFT_FOUR_BYTES);
131 }
132 
133 extern float MATH_MinimumOfTwoFloats(const float value1, const float value2) {
134  return fminf(value1, value2);
135 }
136 
137 extern uint8_t MATH_MinimumOfTwoUint8_t(const uint8_t value1, const uint8_t value2) {
138  uint8_t returnvalue = value1;
139  if (returnvalue > value2) {
140  returnvalue = value2;
141  }
142  return returnvalue;
143 }
144 
145 extern uint16_t MATH_MinimumOfTwoUint16_t(const uint16_t value1, const uint16_t value2) {
146  uint16_t returnvalue = value1;
147  if (returnvalue > value2) {
148  returnvalue = value2;
149  }
150  return returnvalue;
151 }
152 
153 extern int32_t MATH_AbsInt32_t(const int32_t value) {
154  int32_t absValue = INT32_MAX;
155  if (value != INT32_MIN) {
156  absValue = labs(value);
157  }
158  return absValue;
159 }
160 
161 extern int64_t MATH_AbsInt64_t(const int64_t value) {
162  int64_t absValue = INT64_MAX;
163  if (value != INT64_MIN) {
164  absValue = llabs(value);
165  }
166  return absValue;
167 }
168 
169 /* AXIVION Enable Style Generic-MissingParameterAssert: */
170 
171 /*========== Externalized Static Function Implementations (Unit Test) =======*/
#define FAS_ASSERT(x)
Assertion macro that asserts that x is true.
Definition: fassert.h:241
int32_t MATH_AbsInt32_t(const int32_t value)
Returns the absolute value of passed int32_t value.
Definition: foxmath.c:153
float MATH_LinearInterpolation(const float x1, const float y1, const float x2, const float y2, const float x_interpolate)
Linear inter-/extrapolates a third point according to two given points.
Definition: foxmath.c:85
uint16_t MATH_SwapBytesUint16_t(const uint16_t val)
Swap bytes of uint16_t value.
Definition: foxmath.c:108
int64_t MATH_AbsInt64_t(const int64_t value)
Returns the absolute value of passed int64_t value.
Definition: foxmath.c:161
uint16_t MATH_MinimumOfTwoUint16_t(const uint16_t value1, const uint16_t value2)
Returns the minimum of the passed uint16_t values.
Definition: foxmath.c:145
#define SHIFT_TWO_BYTES
Definition: foxmath.c:63
#define SHIFT_ONE_BYTE
Definition: foxmath.c:60
#define SHIFT_FOUR_BYTES
Definition: foxmath.c:66
uint32_t MATH_SwapBytesUint32_t(const uint32_t val)
Swap bytes of uint32_t value.
Definition: foxmath.c:112
void MATH_StartupSelfTest(void)
: self test for math functions that can be called at startup
Definition: foxmath.c:80
uint8_t MATH_MinimumOfTwoUint8_t(const uint8_t value1, const uint8_t value2)
Returns the minimum of the passed uint8_t values.
Definition: foxmath.c:137
float MATH_MinimumOfTwoFloats(const float value1, const float value2)
Returns the minimum of the passed float values.
Definition: foxmath.c:133
uint64_t MATH_SwapBytesUint64_t(const uint64_t val)
Swap bytes of uint64_t value.
Definition: foxmath.c:120
math library for often used math functions