Mirrors_Framework/paparazzi
1
0
Fork 0
mirror of https://github.com/paparazzi/paparazzi.git synced 2026-05-30 03:27:33 +08:00
Code Issues Actions 25 Packages Projects Releases Wiki Activity

[math] fix polyfit init

Browse Source
This commit is contained in:
Gautier Hattenberger
2014-10-17 18:46:45 +02:00
parent 2049726585
commit e971ddb32a
1 changed files with 2 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sw/airborne/math/pprz_polyfit_float.c
+2
View File
@@ -72,10 +72,12 @@ void pprz_polyfit_float(float* x, float* y, int n, int p, float* c)
// First build a table of element S_i = sum_{k=0,n-1} x_k^i of dimension 2*p+1 // First build a table of element S_i = sum_{k=0,n-1} x_k^i of dimension 2*p+1
float S[2*p + 1]; float S[2*p + 1];
float_vect_zero(S, 2*p + 1);
// and a table of element T_i = sum_{k=0,n-1} x_k^i*y_k of dimension p+1 // and a table of element T_i = sum_{k=0,n-1} x_k^i*y_k of dimension p+1
// make it a matrix for later use // make it a matrix for later use
float _T[p + 1][1]; float _T[p + 1][1];
MAKE_MATRIX_PTR(T, _T, p + 1); MAKE_MATRIX_PTR(T, _T, p + 1);
float_mat_zero(T, p + 1, 1);
S[0] = n; // S_0 is always the number of input measurements S[0] = n; // S_0 is always the number of input measurements
for (k = 0; k < n; k++) { for (k = 0; k < n; k++) {
float x_tmp = x[k]; float x_tmp = x[k];