cansat-d_2018 / Mbed 2 deprecated cansat_main_new_3

otamesi

Dependencies:   mbed

Math.cpp

Committer:
seangshim
Date:
2019-02-16
Revision:
41:7c537a922510
Parent:
18:2a47ed430cfe

File content as of revision 41:7c537a922510:

#include "Math.h"
#include "mbed.h"

const float gPI = 3.1415926536f;

float convertRange( float in, float oldMin, float oldMax, float newMin, float newMax ){
    return ( in - oldMin ) * ( newMax - newMin ) / ( oldMax - oldMin ) + newMin;
}

float convertRangePlusMinusPi( float deg ){
    while ( ( deg > gPI ) || ( deg < -gPI ) ){
        while ( deg > gPI ){
            deg -= 2.0f * gPI;
        }
        while ( deg < -gPI ){
            deg += 2.0f * gPI;
        }
    }
    
    return deg;
}

bool isNear( float a, float b, float error ){
    return ( abs( a - b ) < error );
}