hobbyking_cheetah source code modified 2020/12/15
Dependencies: mbed-dev-f303 FastPWM3
FastMath/FastMath.cpp
- Committer:
- WinnieLiu
- Date:
- 2020-12-15
- Revision:
- 55:71a6e5fe5805
- Parent:
- 20:bf9ea5125d52
File content as of revision 55:71a6e5fe5805:
#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); }