Extracting Utils class

This commit is contained in:
Ben V. Brown
2021-04-28 20:57:43 +10:00
parent a36e0c4c6e
commit 3d5b189bfd
2 changed files with 53 additions and 0 deletions

View File

@@ -0,0 +1,33 @@
/*
* Utils.cpp
*
* Created on: 28 Apr 2021
* Author: Ralim
*/
#include <Utils.h>
int32_t Utils::InterpolateLookupTable(const uint16_t *lookupTable,
const uint16_t value) {
if (value) {
int noItems = sizeof(lookupTable) / (2 * sizeof(uint16_t));
for (int i = 1; i < (noItems - 1); i++) {
// If current tip temp is less than current lookup, then this current lookup is the higher point to interpolate
if (value < lookupTable[i * 2]) {
return LinearInterpolate(lookupTable[(i - 1) * 2],
lookupTable[((i - 1) * 2) + 1], lookupTable[i * 2],
lookupTable[(i * 2) + 1], value);
}
}
return LinearInterpolate(lookupTable[(noItems - 2) * 2],
lookupTable[((noItems - 2) * 2) + 1],
lookupTable[(noItems - 1) * 2],
lookupTable[((noItems - 1) * 2) + 1], value);
}
return 0;
}
int32_t Utils::LinearInterpolate(int32_t x1, int32_t y1, int32_t x2, int32_t y2,
int32_t x) {
return y1 + (((((x - x1) * 1000) / (x2 - x1)) * (y2 - y1))) / 1000;
}

View File

@@ -0,0 +1,20 @@
/*
* Utils.h
*
* Created on: 28 Apr 2021
* Author: Ralim
*/
#ifndef CORE_DRIVERS_UTILS_H_
#define CORE_DRIVERS_UTILS_H_
#include <stdint.h>
class Utils {
public:
static int32_t InterpolateLookupTable(const uint16_t *lookupTable,
const uint16_t value);
static int32_t LinearInterpolate(int32_t x1, int32_t y1, int32_t x2,
int32_t y2, int32_t x) ;
};
#endif /* CORE_DRIVERS_UTILS_H_ */