40 lines
914 B
C++
40 lines
914 B
C++
|
/*
|
|||
|
|
* CurrentProcessing.cpp
|
|||
|
|
*
|
|||
|
|
* Created on: 27 янв. 2018 г.
|
|||
|
|
* Author: titov
|
|||
|
|
*/
|
|||
|
|
|
|||
|
|
#include "CurrentProcessing.hh"
|
|||
|
|
|
|||
|
|
using processing::CurrentProcessing;
|
|||
|
|
|
|||
|
|
CurrentProcessing::CurrentProcessing(
|
|||
|
|
systemic::ISignal & i1, systemic::ISignal & i2, systemic::ISignal & i3 ) :
|
|||
|
|
current_1(i1), current_2(i2), current_3(i3),
|
|||
|
|
current_uv(), current_ab(), offset(0.0f) {}
|
|||
|
|
|
|||
|
|
void processing::CurrentProcessing::process() {
|
|||
|
|
|
|||
|
|
control::NaturalCoordinate raw_current(
|
|||
|
|
current_1, current_2, current_3
|
|||
|
|
);
|
|||
|
|
|
|||
|
|
if( raw_current ) {
|
|||
|
|
|
|||
|
|
current_uv = control::normalize( raw_current );
|
|||
|
|
offset = control::calc_offset( raw_current );
|
|||
|
|
|
|||
|
|
current_ab = tf_clark( current_uv );
|
|||
|
|
|
|||
|
|
} else {
|
|||
|
|
|
|||
|
|
current_uv = control::NaturalCoordinate( 0.0f, 0.0f, 0.0f );
|
|||
|
|
current_ab = control::StandingVector( 0.0f, 0.0f );
|
|||
|
|
|
|||
|
|
offset = 0.0f;
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
}
|