Wooden Jin / BLDC_V2

bldc driver firmware based on hobbyking cheetah compact

Dependencies:   BLDC_V2 mbed-dev-f303 FastPWM3

Dependents:   BLDC_V2

FastMath/FastMath.cpp

Committer:
Wooden
Date:
2021-04-07
Revision:
48:a74e401a6d84
Parent:
20:bf9ea5125d52

File content as of revision 48:a74e401a6d84:

#include "FastMath.h"
#include "LUT.h"

const float Multiplier = 81.4873308631f;

float FastMath::FastSin(float theta){
    while (theta < 0.0f) theta += 6.28318530718f;
    while (theta >= 6.28318530718f) theta -= 6.28318530718f;    
    return SinTable[(int) (Multiplier*theta)] ;
    }
    
float FastMath::FastCos(float theta){
    return FastSin(1.57079632679f - theta);
    }