summaryrefslogtreecommitdiffhomepage
path: root/FTNoIR_Filter_EWMA2
diff options
context:
space:
mode:
authorWim Vriend <facetracknoir@gmail.com>2011-04-01 17:16:11 +0000
committerWim Vriend <facetracknoir@gmail.com>2011-04-01 17:16:11 +0000
commit28c091a886e6c98f41d3f5f8b153768b4a589fcd (patch)
treee9744191a2926366b194c47230a91439fe4f3e07 /FTNoIR_Filter_EWMA2
parent43734bf0f9fa8531b817943756157a2c459886a8 (diff)
Started with placing the protocol's in DLL's. First one: FlightGear.
git-svn-id: svn+ssh://svn.code.sf.net/p/facetracknoir/code@60 19e81ba0-9b1a-49c3-bd6c-561e1906d5fb
Diffstat (limited to 'FTNoIR_Filter_EWMA2')
-rw-r--r--FTNoIR_Filter_EWMA2/ftnoir_filter_ewma2.cpp18
1 files changed, 18 insertions, 0 deletions
diff --git a/FTNoIR_Filter_EWMA2/ftnoir_filter_ewma2.cpp b/FTNoIR_Filter_EWMA2/ftnoir_filter_ewma2.cpp
index 957f5aec..7bdac328 100644
--- a/FTNoIR_Filter_EWMA2/ftnoir_filter_ewma2.cpp
+++ b/FTNoIR_Filter_EWMA2/ftnoir_filter_ewma2.cpp
@@ -1,6 +1,10 @@
#include "ftnoir_filter_base.h"
#include "math.h"
#include <QDebug>
+#include <QFile>
+#include <QCoreApplication>
+
+//#define LOG_OUTPUT
//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
//
@@ -157,6 +161,7 @@ void FTNoIR_Filter_EWMA2::FilterHeadPoseData(THeadPoseData *current_camera_posit
for (i=0;i<6;i++)
{
output[i]=target[i];
+ prev_alpha[i] = 0.0f;
}
new_camera_position->x=target[0];
@@ -215,6 +220,19 @@ void FTNoIR_Filter_EWMA2::FilterHeadPoseData(THeadPoseData *current_camera_posit
// output[i]=(smoothed_alpha[i]*target[i])+((1.0f-smoothed_alpha[i])*prev_output[i]);
}
+
+ #ifdef LOG_OUTPUT
+ // Use this for some debug-output to file...
+ QFile data(QCoreApplication::applicationDirPath() + "\\EWMA_output.txt");
+ if (data.open(QFile::WriteOnly | QFile::Append)) {
+ QTextStream out(&data);
+ out << "output:\t" << output[0] << "\t" << output[1] << "\t" << output[2] << "\t" << output[3] << "\t" << output[4] << "\t" << output[5] << '\n';
+ out << "target:\t" << target[0] << "\t" << target[1] << "\t" << target[2] << "\t" << target[3] << "\t" << target[4] << "\t" << target[5] << '\n';
+ out << "prev_output:\t" << prev_output[0] << "\t" << prev_output[1] << "\t" << prev_output[2] << "\t" << prev_output[3] << "\t" << prev_output[4] << "\t" << prev_output[5] << '\n';
+ out << "largest_alpha:\t" << largest_alpha << '\n';
+ }
+ #endif
+
new_camera_position->x=output[0];
new_camera_position->y=output[1];
new_camera_position->z=output[2];