parent
d5430fe5a4
commit
91df5f84a8
@ -1,209 +0,0 @@ |
||||
/*
|
||||
* interpolation.h |
||||
* |
||||
* interpolation - An interpolation library for Arduino. |
||||
* Author: Jose Gama 2015 |
||||
|
||||
* |
||||
* This library is free software; you can redistribute it |
||||
* and/or modify it under the terms of the GNU Lesser |
||||
* General Public License as published by the Free Software |
||||
* Foundation; either version 3 of the License, or (at |
||||
* your option) any later version. |
||||
* |
||||
* This library is distributed in the hope that it will |
||||
* be useful, but WITHOUT ANY WARRANTY; without even the |
||||
* implied warranty of MERCHANTABILITY or FITNESS FOR A |
||||
* PARTICULAR PURPOSE. See the GNU Lesser General Public |
||||
* License for more details. |
||||
* |
||||
* You should have received a copy of the GNU Lesser |
||||
* General Public License along with this library; if not, |
||||
* write to the Free Software Foundation, Inc., |
||||
* 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
||||
* |
||||
*/ |
||||
|
||||
/*
|
||||
* From: https://github.com/tuxcell/interpolationArduino
|
||||
* replaced all doubles by float (wirtz@parasitstudio.de) |
||||
*/ |
||||
|
||||
#include "interpolation.h" |
||||
|
||||
interpolation::interpolation(void) { |
||||
_valInterp = 0; |
||||
_lenXY = 0; |
||||
} |
||||
interpolation::interpolation( float x[], float y[], int lenXY){ |
||||
_x = x;_y = y;_lenXY = lenXY; |
||||
_valInterp = 0; |
||||
} |
||||
interpolation::interpolation( float x[], float y[], int lenXY, float valInterp){ |
||||
_x = x;_y = y;_lenXY = lenXY; |
||||
_valInterp = valInterp; |
||||
} |
||||
|
||||
void interpolation::valueI( float valInterp ) { |
||||
_valInterp = valInterp; |
||||
} |
||||
void interpolation::valuelenXY( int lenXY ) { |
||||
_lenXY = lenXY; |
||||
} |
||||
void interpolation::valueX( float x[]) { |
||||
_x = x; |
||||
} |
||||
void interpolation::valueY( float y[]) { |
||||
_y = y; |
||||
} |
||||
void interpolation::valueXM( float XM[]) { |
||||
_XM = XM; |
||||
} |
||||
void interpolation::valueZ( float Z[]) { |
||||
_Z = Z; |
||||
} |
||||
float interpolation::LinearInterpolate() {return(LinearInterp( _x, _y, _lenXY, _valInterp));} |
||||
float interpolation::CosineInterpolate() {return(CosineInterp( _x, _y, _lenXY, _valInterp));} |
||||
float interpolation::CubicInterpolate() {return(CubicInterp( _x, _y, _lenXY, _valInterp));} |
||||
float interpolation::LagrangeInterpolate() {return(LagrangeInterp( _x, _y, _lenXY, _valInterp));} |
||||
float interpolation::QuadraticInterpolate() {return(QuadraticInterp( _x, _y, _lenXY, _valInterp));} |
||||
float interpolation::AkimaInterpolate() {return(AkimaInterp( _x, _y, _XM, _Z, _lenXY, _valInterp));} |
||||
|
||||
|
||||
float interpolation::LinearInterp( float* x, float* y, int n, float p ) |
||||
{ |
||||
//http://paulbourke.net/miscellaneous/interpolation/
|
||||
int i; |
||||
float mu; |
||||
for( i = 0; i < n-1; i++ ) |
||||
{ |
||||
if (( x[i] <= p && x[i+1] >= p )||( x[i] >= p && x[i+1] <= p )) |
||||
{ |
||||
mu=(p - x[i])/(x[i] - x[i+1]); |
||||
if (mu<0) mu=-mu; |
||||
return(y[i]*(1-mu)+y[i+1]*mu); |
||||
} |
||||
} |
||||
return 0; // Not in Range
|
||||
} |
||||
|
||||
float interpolation::CosineInterp (float* x, float* y, int n, float p ) |
||||
{ |
||||
int i; |
||||
float mu, mu2; |
||||
for( i = 0; i < n-1; i++ ) |
||||
{ |
||||
if (( x[i] <= p && x[i+1] >= p )||( x[i] >= p && x[i+1] <= p )) |
||||
{ |
||||
mu=(p - x[i])/(x[i] - x[i+1]); |
||||
if (mu<0) mu=-mu; |
||||
mu2 = (1.0-cos(3.1415926535897*mu))/2.0; |
||||
return(y[i]*(1.0-mu2)+y[i+1]*mu2); |
||||
} |
||||
} |
||||
return 0; // Not in Range
|
||||
} |
||||
|
||||
float interpolation::CubicInterp(float* x, float* y, int n, float p ) |
||||
{ |
||||
int i; |
||||
float a0,a1,a2,a3,mu, mu2; |
||||
for( i = 0; i < n-1; i++ ) |
||||
{ |
||||
if (( x[i] <= p && x[i+1] >= p )||( x[i] >= p && x[i+1] <= p )) |
||||
{ |
||||
mu=(p - x[i])/(x[i] - x[i+1]); |
||||
if (mu<0) mu=-mu; |
||||
mu2 = mu*mu; |
||||
a0 = y[i+2] - y[i+1] - y[i-1] + y[i]; |
||||
a1 = y[i-1] - y[i] - a0; |
||||
a2 = y[i+1] - y[i-1]; |
||||
a3 = y[i]; |
||||
return(a0*mu*mu2+a1*mu2+a2*mu+a3); |
||||
} |
||||
} |
||||
return 0; // Not in Range
|
||||
} |
||||
|
||||
float interpolation::LagrangeInterp( float* x, float* y, int n, float p ) |
||||
{ |
||||
//http://www.dailyfreecode.com/code/lagranges-interpolation-method-finding-2376.aspx
|
||||
int i, j, k; |
||||
float t, r=0; |
||||
for(i=0;i<n;i++) |
||||
{ |
||||
t = 1; |
||||
k = i; |
||||
for(j=0;j<n;j++) |
||||
{ |
||||
if(k==j) |
||||
{ |
||||
continue; |
||||
} |
||||
else |
||||
{ |
||||
t = t * ((p-x[j])/(x[k]-x[j])); |
||||
} |
||||
} |
||||
r+=y[i]*t; |
||||
} |
||||
return r; // Not in Range
|
||||
} |
||||
|
||||
float interpolation::QuadraticInterp(float* x, float* y, int n, float p ) |
||||
{ |
||||
//view-source:http://www.johndcook.com/quadratic_interpolator.html
|
||||
int i; |
||||
float xi2, k; |
||||
for( i = 0; i < n-1; i++ ) |
||||
{ |
||||
if (( x[i] <= p && x[i+1] >= p )||( x[i] >= p && x[i+1] <= p )) |
||||
{ |
||||
if (i<(n-3)) xi2=x[i+2]; else xi2=0; |
||||
k = y[i]*(p - x[i+1])*(p - xi2)/((x[i] - x[i+1])*(x[i] - xi2)); |
||||
k += y[i+1]*(p - x[i])*(p - xi2)/((x[i+1] - x[i])*(x[i+1] - xi2)); |
||||
k += y[i+2]*(p - x[i])*(p - x[i+1])/((xi2 - x[i])*(xi2 - x[i+1])); |
||||
return(k); |
||||
} |
||||
} |
||||
return 0; // Not in Range
|
||||
} |
||||
|
||||
float interpolation::AkimaInterp( float* x, float* y, float* XM, float* Z, int n, float p ) { |
||||
//http://jean-pierre.moreau.pagesperso-orange.fr/Cplus/akima_cpp.txt
|
||||
int i; |
||||
float a,b,r; |
||||
//special case p=0
|
||||
if (p==0.0) { |
||||
return(0); |
||||
} |
||||
//Check to see if interpolation point is correct
|
||||
if (p<x[1] || p>=x[n-3]) { |
||||
return(-330); |
||||
} |
||||
x[0]=2.0*x[1]-x[2]; |
||||
//Calculate Akima coefficients, a and b
|
||||
for (i=1; i<n; i++) |
||||
//Shift i to i+2
|
||||
XM[i+2]=(y[i+1]-y[i])/(x[i+1]-x[i]); |
||||
XM[n+2]=2.0*XM[n+1]-XM[n]; |
||||
XM[n+3]=2.0*XM[n+2]-XM[n+1]; |
||||
XM[2]=2.0*XM[3]-XM[4]; |
||||
XM[1]=2.0*XM[2]-XM[3]; |
||||
for (i=1; i<n+1; i++) { |
||||
a=fabs(XM[i+3]-XM[i+2]); |
||||
b=fabs(XM[i+1]-XM[i]); |
||||
if (a+b==0) Z[i]=(a*XM[i+1]+b*XM[i+2])/(a+b); else Z[i]=(XM[i+2]+XM[i+1])/2.0; |
||||
} |
||||
//Find relevant table interval
|
||||
i=0; |
||||
while (p>x[i]) i++; |
||||
i--; |
||||
|
||||
//Begin interpolation
|
||||
b=x[i+1]-x[i]; |
||||
a=p-x[i]; |
||||
r=y[i]+Z[i]*a+(3.0*XM[i+2]-2.0*Z[i]-Z[i+1])*a*a/b; |
||||
r=r+(Z[i]+Z[i+1]-2.0*XM[i+2])*a*a*a/(b*b); |
||||
return(r); |
||||
} |
||||
@ -1,79 +0,0 @@ |
||||
/*
|
||||
* interpolation.h |
||||
* |
||||
* interpolation - An interpolation library for Arduino. |
||||
* Author: Jose Gama 2015 |
||||
|
||||
* |
||||
* This library is free software; you can redistribute it |
||||
* and/or modify it under the terms of the GNU Lesser |
||||
* General Public License as published by the Free Software |
||||
* Foundation; either version 3 of the License, or (at |
||||
* your option) any later version. |
||||
* |
||||
* This library is distributed in the hope that it will |
||||
* be useful, but WITHOUT ANY WARRANTY; without even the |
||||
* implied warranty of MERCHANTABILITY or FITNESS FOR A |
||||
* PARTICULAR PURPOSE. See the GNU Lesser General Public |
||||
* License for more details. |
||||
* |
||||
* You should have received a copy of the GNU Lesser |
||||
* General Public License along with this library; if not, |
||||
* write to the Free Software Foundation, Inc., |
||||
* 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
||||
* |
||||
*/ |
||||
|
||||
/*
|
||||
* From: https://github.com/tuxcell/interpolationArduino
|
||||
* replaced all doubles by float (wirtz@parasitstudio.de) |
||||
*/ |
||||
|
||||
#ifndef interpolation_h |
||||
#define interpolation_h |
||||
|
||||
#if defined(ARDUINO) && ARDUINO >= 100 |
||||
#include <Arduino.h> |
||||
#else |
||||
#include <WProgram.h> |
||||
#endif |
||||
|
||||
class interpolation |
||||
{ |
||||
public: |
||||
// constructor
|
||||
interpolation( void ); |
||||
interpolation( float x[], float y[], int lenXY); |
||||
interpolation( float x[], float y[], int lenXY, float valInterp); |
||||
|
||||
void valueI( float valInterp ); |
||||
void valuelenXY( int lenXY ); |
||||
void valueX( float x[]); |
||||
void valueY( float y[]); |
||||
void valueXM( float XM[]); |
||||
void valueZ( float Z[]); |
||||
float LinearInterpolate(); |
||||
float CosineInterpolate(); |
||||
float CubicInterpolate(); |
||||
float LagrangeInterpolate(); |
||||
float QuadraticInterpolate(); |
||||
float AkimaInterpolate(); |
||||
|
||||
private: |
||||
float* _x; |
||||
float* _y; |
||||
float* _XM; |
||||
float* _Z; |
||||
int _lenXY; |
||||
float _valInterp; |
||||
|
||||
float LinearInterp( float x[], float y[], int n, float p ); |
||||
float CosineInterp( float x[], float y[], int n, float p ); |
||||
float CubicInterp( float x[], float y[], int n, float p ); |
||||
float LagrangeInterp( float x[], float y[], int n, float p ); |
||||
float QuadraticInterp( float x[], float y[], int n, float p ); |
||||
float AkimaInterp( float x[], float y[], float XM[], float Z[], int n, float p ); |
||||
|
||||
}; |
||||
|
||||
#endif |
||||
Loading…
Reference in new issue