PhasorEstimator Class Reference

Public Member Functions
	PhasorEstimator (double sampleRate=1e6, double notchRadius=0.5)
void	Reset ()
void	UpdateFrequency (double freq)
void	Update (double current, double phase, double freq)
double	GetId () const
double	GetIq () const
double	GetMagnitude () const
double	GetAngle () const

Private Attributes
double	Fs
double	r
double	lastFreq
double	b0
double	b1
double	b2
double	a1
double	a2
double	x1Id
double	x2Id
double	y1Id
double	y2Id
double	x1Iq
double	x2Iq
double	y1Iq
double	y2Iq
double	Id
double	Iq

Detailed Description

Definition at line 7 of file PSPModel.cpp.

Constructor & Destructor Documentation

PhasorEstimator()

PhasorEstimator::PhasorEstimator ( double  sampleRate = 1e6, double  notchRadius = 0.5  )

inline

Definition at line 11 of file PSPModel.cpp.

                                                                       : Fs(sampleRate), r(notchRadius)
    {
        Reset();
        UpdateFrequency(60.0);
    }

Member Function Documentation

GetAngle()

double PhasorEstimator::GetAngle ( ) const

inline

Definition at line 113 of file PSPModel.cpp.

    {
        return atan2(GetIq(),GetId());
    }

GetId()

double PhasorEstimator::GetId ( ) const

inline

Definition at line 95 of file PSPModel.cpp.

    {
        return sqrt(2.0)*Id;
    }

GetIq()

double PhasorEstimator::GetIq ( ) const

inline

Definition at line 100 of file PSPModel.cpp.

    {
        return sqrt(2.0)*Iq;
    }

GetMagnitude()

double PhasorEstimator::GetMagnitude ( ) const

inline

Definition at line 105 of file PSPModel.cpp.

    {
        double ir = GetId();
        double ii = GetIq();
 
        return sqrt(ir*ir+ii*ii);
    }

Reset()

void PhasorEstimator::Reset ( )

inline

Definition at line 17 of file PSPModel.cpp.

    {
        x1Id = x2Id = 0.0;
        y1Id = y2Id = 0.0;
 
        x1Iq = x2Iq = 0.0;
        y1Iq = y2Iq = 0.0;
 
        Id = 0.0;
        Iq = 0.0;
        
        lastFreq = -1.0;
    }

Update()

void PhasorEstimator::Update ( double  current, double  phase, double  freq  )

inline

Definition at line 58 of file PSPModel.cpp.

    {
        UpdateFrequency(freq);
 
        double s = sin(phase);
        double c = cos(phase);
 
        double IdRaw = current*s;
        double IqRaw = current*c;
 
        //-----------------------------------
        // Id
        //-----------------------------------
 
        Id = b0*IdRaw + b1*x1Id + b2*x2Id - a1*y1Id - a2*y2Id;
 
        x2Id = x1Id;
        x1Id = IdRaw;
 
        y2Id = y1Id;
        y1Id = Id;
 
        //-----------------------------------
        // Iq
        //-----------------------------------
 
        Iq = b0*IqRaw + b1*x1Iq + b2*x2Iq - a1*y1Iq - a2*y2Iq;
 
        x2Iq = x1Iq;
        x1Iq = IqRaw;
 
        y2Iq = y1Iq;
        y1Iq = Iq;
    }

UpdateFrequency()

void PhasorEstimator::UpdateFrequency ( double  freq )

inline

Definition at line 31 of file PSPModel.cpp.

    {
        if(std::abs(freq-lastFreq) < 1e-9)
            return;
 
        lastFreq = freq;
 
        double w0 = 2.0*M_PI*(2.0*freq)/Fs;
 
        double c = cos(w0);
 
        double bb0 = 1.0;
        double bb1 = -2.0*c;
        double bb2 = 1.0;
 
        a1 = -2.0*r*c;
        a2 = r*r;
 
        double gain =
            (1.0+a1+a2)/
            (bb0+bb1+bb2);
 
        b0 = gain*bb0;
        b1 = gain*bb1;
        b2 = gain*bb2;
    }

Member Data Documentation

a1

double PhasorEstimator::a1

private

Definition at line 126 of file PSPModel.cpp.

a2

double PhasorEstimator::a2

private

Definition at line 126 of file PSPModel.cpp.

b0

double PhasorEstimator::b0

private

Definition at line 125 of file PSPModel.cpp.

b1

double PhasorEstimator::b1

private

Definition at line 125 of file PSPModel.cpp.

b2

double PhasorEstimator::b2

private

Definition at line 125 of file PSPModel.cpp.

Fs

double PhasorEstimator::Fs

private

Definition at line 120 of file PSPModel.cpp.

Id

double PhasorEstimator::Id

private

Definition at line 144 of file PSPModel.cpp.

Iq

double PhasorEstimator::Iq

private

Definition at line 145 of file PSPModel.cpp.

lastFreq

double PhasorEstimator::lastFreq

private

Definition at line 123 of file PSPModel.cpp.

r

double PhasorEstimator::r

private

Definition at line 121 of file PSPModel.cpp.

x1Id

double PhasorEstimator::x1Id

private

Definition at line 132 of file PSPModel.cpp.

x1Iq

double PhasorEstimator::x1Iq

private

Definition at line 139 of file PSPModel.cpp.

x2Id

double PhasorEstimator::x2Id

private

Definition at line 132 of file PSPModel.cpp.

x2Iq

double PhasorEstimator::x2Iq

private

Definition at line 139 of file PSPModel.cpp.

y1Id

double PhasorEstimator::y1Id

private

Definition at line 133 of file PSPModel.cpp.

y1Iq

double PhasorEstimator::y1Iq

private

Definition at line 140 of file PSPModel.cpp.

y2Id

double PhasorEstimator::y2Id

private

Definition at line 133 of file PSPModel.cpp.

y2Iq

double PhasorEstimator::y2Iq

private

Definition at line 140 of file PSPModel.cpp.

---

The documentation for this class was generated from the following file:

• Project/data/atp/PSPModel.cpp