N K / Mbed 2 deprecated analoghalls5_5

working-est copy with class-based code. still open loop

Dependencies:   mbed

Fork of analoghalls6 by N K

referencesynthesizers.cpp

Committer:
nki
Date:
2015-03-08
Revision:
10:b4abecccec7a
Parent:
9:d3b70c15baa9

File content as of revision 10:b4abecccec7a:

#include "includes.h"
#include "meta.h"
#include "sensors.h"
#include "lut.h"
#include "core.h"

void SynchronousReferenceSynthesizer::GetReference(float angle, float throttle, float *ref_d, float *ref_q) {
    *ref_d = 0.0f;
    *ref_q = _max_phase_current*throttle;
}

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

float ReferenceSynthesizer::LutCos(float theta) {
    return LutSin(90.0f - theta);
}