Eduardo Vergara / Mbed 2 deprecated MPU9250_filter

Filter for 9250

Dependencies:   mbed

f_tri.h

Committer:
Edrum_x
Date:
2019-08-06
Revision:
1:c9547742263c

File content as of revision 1:c9547742263c:





double f_tri(double xi, double xf ,double  k ){
    double val;
    if (k<=((xf+xi)/2)){
        val = 1/((xf+xi)/2 -xi)*(k-xi);
        }
    else if (k>((xf+xi)/2) && k<xf){
        val= 1 - (1/(xf-(xf+xi)/2))*(k-(xf+xi)/2);
        }
    else{
        val=0;
    }
    return val;
}