| 1 |
#include "cc3_math.h" |
|---|
| 2 |
|
|---|
| 3 |
|
|---|
| 4 |
#define iter1(N) \ |
|---|
| 5 |
try = root + (1 << (N)); \ |
|---|
| 6 |
if (n >= try << (N)) \ |
|---|
| 7 |
{ n -= try << (N); \ |
|---|
| 8 |
root |= 2 << (N); \ |
|---|
| 9 |
} |
|---|
| 10 |
|
|---|
| 11 |
uint32_t cc3_isqrt (uint32_t n) |
|---|
| 12 |
{ |
|---|
| 13 |
uint32_t root = 0, try; |
|---|
| 14 |
iter1 (15); iter1 (14); iter1 (13); iter1 (12); |
|---|
| 15 |
iter1 (11); iter1 (10); iter1 ( 9); iter1 ( 8); |
|---|
| 16 |
iter1 ( 7); iter1 ( 6); iter1 ( 5); iter1 ( 4); |
|---|
| 17 |
iter1 ( 3); iter1 ( 2); iter1 ( 1); iter1 ( 0); |
|---|
| 18 |
return root >> 1; |
|---|
| 19 |
} |
|---|
| 20 |
|
|---|
| 21 |
|
|---|
| 22 |
|
|---|
| 23 |
double cc3_mean( uint8_t data[], uint32_t size ) |
|---|
| 24 |
{ |
|---|
| 25 |
|
|---|
| 26 |
double mean = 0.0; |
|---|
| 27 |
uint32_t sum = 0; |
|---|
| 28 |
uint32_t i; |
|---|
| 29 |
|
|---|
| 30 |
for (i = 0; i < size; i++) { |
|---|
| 31 |
sum = sum + data[i]; |
|---|
| 32 |
} |
|---|
| 33 |
|
|---|
| 34 |
mean = sum / size; |
|---|
| 35 |
return mean; |
|---|
| 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 |
void cc3_linear_reg(uint8_t x_data[], uint8_t y_data[], uint8_t size,cc3_linear_reg_data_t *reg_out ) |
|---|
| 61 |
{ |
|---|
| 62 |
|
|---|
| 63 |
|
|---|
| 64 |
if (size > 0) { |
|---|
| 65 |
|
|---|
| 66 |
|
|---|
| 67 |
|
|---|
| 68 |
double muX = cc3_mean( x_data,size ); |
|---|
| 69 |
double muY = cc3_mean( y_data,size ); |
|---|
| 70 |
|
|---|
| 71 |
|
|---|
| 72 |
|
|---|
| 73 |
|
|---|
| 74 |
|
|---|
| 75 |
|
|---|
| 76 |
|
|---|
| 77 |
|
|---|
| 78 |
|
|---|
| 79 |
|
|---|
| 80 |
|
|---|
| 81 |
|
|---|
| 82 |
|
|---|
| 83 |
|
|---|
| 84 |
|
|---|
| 85 |
double SSxy = 0; |
|---|
| 86 |
double SSxx = 0; |
|---|
| 87 |
double SSyy = 0; |
|---|
| 88 |
double Sx = 0; |
|---|
| 89 |
double Sy = 0; |
|---|
| 90 |
double Sxy = 0; |
|---|
| 91 |
double SSy = 0; |
|---|
| 92 |
double SSx = 0; |
|---|
| 93 |
|
|---|
| 94 |
for (uint8_t i = 0; i < size; i++) { |
|---|
| 95 |
double subX = (x_data[i] - muX); |
|---|
| 96 |
double subY = (y_data[i] - muY); |
|---|
| 97 |
Sx = Sx + x_data[i]; |
|---|
| 98 |
Sy = Sy + y_data[i]; |
|---|
| 99 |
Sxy = Sxy + (x_data[i] * y_data[i]); |
|---|
| 100 |
SSx = SSx + (x_data[i] * x_data[i]); |
|---|
| 101 |
SSy = SSy + (y_data[i] * y_data[i]); |
|---|
| 102 |
SSyy = SSyy + subY * subY; |
|---|
| 103 |
SSxy = SSxy + subX * subY; |
|---|
| 104 |
SSxx = SSxx + subX * subX; |
|---|
| 105 |
|
|---|
| 106 |
} |
|---|
| 107 |
|
|---|
| 108 |
|
|---|
| 109 |
|
|---|
| 110 |
|
|---|
| 111 |
double m = SSxy / SSxx; |
|---|
| 112 |
|
|---|
| 113 |
double b = muY - m * muX; |
|---|
| 114 |
|
|---|
| 115 |
double r2Numerator = (size * Sxy) - (Sx * Sy); |
|---|
| 116 |
double r2Denominator = ((size*SSx) - (Sx * Sx))*((size*SSy) - (Sy * Sy)); |
|---|
| 117 |
double r2 = (r2Numerator * r2Numerator) / r2Denominator; |
|---|
| 118 |
|
|---|
| 119 |
reg_out->r_sqr = r2; |
|---|
| 120 |
reg_out->b = b; |
|---|
| 121 |
reg_out->m = m; |
|---|
| 122 |
} |
|---|
| 123 |
|
|---|
| 124 |
} |
|---|
| 125 |
|
|---|
| 126 |
|
|---|