-
Notifications
You must be signed in to change notification settings - Fork 0
/
Kalman.cpp
70 lines (68 loc) · 2.57 KB
/
Kalman.cpp
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
//
// FFT3DFilter plugin for Avisynth 2.6 - 3D Frequency Domain filter
// Functions for CreateThread and initialization of KalmanFilter
//
// Copyright(C) 2018 Daniel Klíma aka Klimax
//
// This program is free software; you can redistribute it and/or modify
// it under the terms of the GNU General Public License version 2 as published by
// the Free Software Foundation.
//
// This program is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
// GNU General Public License for more details.
//
// You should have received a copy of the GNU General Public License
// along with this program; if not, write to the Free Software
// Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
//
//-----------------------------------------------------------------------------------------
//
#include "Kalman.h"
#include "enums.h"
KalmanFilter::KalmanFilter(fftwf_complex *covar_in, fftwf_complex *covarProcess_in, int start_block,
int blocks, int outwidth, int outpitch, int bh, int CPUFlags, float kratio2) :
covar_in(covar_in), covarProcess_in(covarProcess_in), start_block(start_block),
blocks(blocks), outwidth(outwidth), outpitch(outpitch), bh(bh), CPUFlags(CPUFlags), kratio2(kratio2),
outcur(nullptr), outLast(nullptr), covarNoiseNormed2(nullptr), covarNoiseNormed(0),
ApplyKalman(&KalmanFilter::ApplyKalman_SSE2), ApplyKalmanPattern(&KalmanFilter::ApplyKalmanPattern_SSE2)
{
if (CPUFlags & CPUK_AVX512)
{
ApplyKalman = &KalmanFilter::ApplyKalman_AVX512;
ApplyKalmanPattern = &KalmanFilter::ApplyKalmanPattern_AVX512;
}
else if (CPUFlags & CPUK_AVX2)
{
ApplyKalman = &KalmanFilter::ApplyKalman_AVX2;
ApplyKalmanPattern = &KalmanFilter::ApplyKalmanPattern_AVX2;
}
else if (CPUFlags & CPUK_AVX)
{
ApplyKalman = &KalmanFilter::ApplyKalman_AVX;
ApplyKalmanPattern = &KalmanFilter::ApplyKalmanPattern_AVX;
}
else if (CPUFlags & CPUK_SSE4_1)
{
ApplyKalman = &KalmanFilter::ApplyKalman_SSE4;
ApplyKalmanPattern = &KalmanFilter::ApplyKalmanPattern_SSE4;
}
else if (CPUFlags & CPUK_SSE2)
{
ApplyKalman = &KalmanFilter::ApplyKalman_SSE2;
ApplyKalmanPattern = &KalmanFilter::ApplyKalmanPattern_SSE2;
}
#ifndef SSE2BUILD
else if (CPUFlags & CPUK_SSE)
{
ApplyKalman = &KalmanFilter::ApplyKalman_SSE;
ApplyKalmanPattern = &KalmanFilter::ApplyKalmanPattern_SSE;
}
else
{
ApplyKalman = &KalmanFilter::ApplyKalman_C;
ApplyKalmanPattern = &KalmanFilter::ApplyKalmanPattern_C;
}
#endif
}