You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
86 lines
2.5 KiB
86 lines
2.5 KiB
|
|
#ifndef __INTERPOLATION_H__
|
|
#define __INTERPOLATION_H__
|
|
#include <stdint.h>
|
|
#include <stdbool.h>
|
|
|
|
#ifdef __cplusplus
|
|
extern "C"
|
|
{
|
|
#endif
|
|
|
|
void interpolation_f(const float *x, const float *y, int Num, float x0, float*y0);
|
|
void interpolation_s(const float *x, const unsigned short *y, int Num, float x0, unsigned short *y0);
|
|
int interpolation_b(unsigned char *x, bool *y, int xNum, unsigned char x0, bool *y0);
|
|
void pre_interp(int iso, uint32_t *iso_list, int num, int *lo, int *hi, float *ratio);
|
|
void interpolation_set_iso_list(const uint32_t *iso_list);
|
|
void interpolation_get_iso_list(uint32_t *iso_list);
|
|
|
|
#define RATIO_FIXBIT 14
|
|
|
|
static inline bool interpolation_bool(bool lower, bool upper, uint16_t ratio) {
|
|
bool is_upper = !! (ratio & (1 << (RATIO_FIXBIT - 1)));
|
|
// return is_upper?: upper: lower;
|
|
return (is_upper && upper) || (!is_upper && lower);
|
|
}
|
|
|
|
static inline uint8_t interpolation_u8(uint8_t lower, uint8_t upper, uint16_t ratio) {
|
|
int32_t tmp = (int32_t)upper - (int32_t) lower;
|
|
tmp = (tmp * ratio) >> RATIO_FIXBIT;
|
|
return lower + tmp;
|
|
}
|
|
|
|
static inline int8_t interpolation_i8(int8_t lower, int8_t upper, uint16_t ratio) {
|
|
int32_t tmp = (int32_t)upper - (int32_t) lower;
|
|
tmp = (tmp * ratio) >> RATIO_FIXBIT;
|
|
return lower + tmp;
|
|
}
|
|
|
|
static inline uint16_t interpolation_u16(uint16_t lower, uint16_t upper, uint16_t ratio) {
|
|
int32_t tmp = (int32_t)upper - (int32_t) lower;
|
|
tmp = (tmp * ratio) >> RATIO_FIXBIT;
|
|
return lower + tmp;
|
|
}
|
|
|
|
static inline int16_t interpolation_i16(int16_t lower, int16_t upper, uint16_t ratio) {
|
|
int32_t tmp = (int32_t)upper - (int32_t) lower;
|
|
tmp = (tmp * ratio) >> RATIO_FIXBIT;
|
|
return lower + tmp;
|
|
}
|
|
|
|
static inline int32_t interpolation_i32(int32_t lower, int32_t upper, float ratio) {
|
|
if (lower == upper) {
|
|
return lower;
|
|
} else {
|
|
float tmp = (float)upper - (float) lower;
|
|
tmp = lower + tmp * ratio;
|
|
return ((int32_t)(tmp + 0.5));
|
|
}
|
|
}
|
|
|
|
static inline uint32_t interpolation_u32(uint32_t lower, uint32_t upper, float ratio) {
|
|
if (lower == upper) {
|
|
return lower;
|
|
} else {
|
|
float tmp = (float)upper - (float) lower;
|
|
tmp = lower + tmp * ratio;
|
|
return ((uint32_t)(tmp + 0.5));
|
|
}
|
|
}
|
|
|
|
static inline float interpolation_f32(float lower, float upper, float ratio) {
|
|
if (lower == upper) {
|
|
return lower;
|
|
} else {
|
|
float tmp = (float)upper - (float) lower;
|
|
tmp = lower + tmp * ratio;
|
|
return tmp;
|
|
}
|
|
}
|
|
|
|
#ifdef __cplusplus
|
|
}
|
|
#endif
|
|
|
|
#endif
|