1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
|
/* Copyright (c) 2014, Stanislaw Halik <sthalik@misaki.pl>
* Permission to use, copy, modify, and/or distribute this
* software for any purpose with or without fee is hereby granted,
* provided that the above copyright notice and this permission
* notice appear in all copies.
*/
#include "test.h"
#include "api/plugin-api.hpp"
#include <cmath>
#include <QDebug>
const double FTNoIR_Tracker::incr[6] =
{
50, 40, 80,
70, 5, 3
};
FTNoIR_Tracker::FTNoIR_Tracker() :
last_x { 0, 0, 0, 0, 0, 0 }
{
}
FTNoIR_Tracker::~FTNoIR_Tracker()
{
}
void FTNoIR_Tracker::start_tracker(QFrame*)
{
t.start();
}
#ifdef EMIT_NAN
# include <cstdlib>
#endif
void FTNoIR_Tracker::data(double *data)
{
using std::fmod;
using std::sin;
using std::fabs;
using std::copysign;
const double dt = t.elapsed_seconds();
t.start();
#ifdef EMIT_NAN
if ((rand()%4) == 0)
{
for (int i = 0; i < 6; i++)
data[i] = 0./0.;
}
else
#endif
for (int i = 0; i < 6; i++)
{
double x = fmod(last_x[i] + incr[i] * d2r * dt, 2 * M_PI);
last_x[i] = x;
if (i >= 3)
{
#ifdef DISCONTINUITY
if (x > pi + pi/2)
x -= M_PI;
else if (x > pi/2 && x < pi)
x += M_PI;
#endif
data[i] = sin(x) * 180;
}
else
{
data[i] = sin(x) * 100;
}
}
}
TrackerControls::TrackerControls()
{
ui.setupUi(this);
connect(ui.buttonBox, SIGNAL(accepted()), this, SLOT(doOK()));
connect(ui.buttonBox, SIGNAL(rejected()), this, SLOT(doCancel()));
}
void TrackerControls::doOK()
{
//s.b->save();
close();
}
void TrackerControls::doCancel()
{
close();
}
OPENTRACK_DECLARE_TRACKER(FTNoIR_Tracker, TrackerControls, FTNoIR_TrackerDll)
|
