Bayley Wang / Mbed 2 deprecated priustroller

Prius IPM controller

Dependencies:   mbed

Fork of analoghalls5_5 by N K

util/fastmath.cpp

Committer:
bwang
Date:
2015-03-08
Revision:
11:dccbaa9274c5
Parent:
fastmath.cpp@ 9:d3b70c15baa9

File content as of revision 11:dccbaa9274c5:

#include "includes.h"
#include "fastmath.h"
#include "lut.h"

float FastMath::FastSin(float theta) {
    if (theta < 0.0f) theta += 360.0f;
    if (theta >= 360.0f) theta -= 360.0f;
    return 2.0f * sinetab[(int) theta] - 1.0f;
}

float FastMath::FastCos(float theta) {
    return FastSin(90.0f - theta);
}

float FastMath::FastSin01(float theta) {
    return FastSin(theta) * 0.5f + 0.5f;
}

float FastMath::FastCos01(float theta) {
    return FastCos(theta) * 0.5f + 0.5f;
}