-
Notifications
You must be signed in to change notification settings - Fork 0
/
testEvaluteMVGchanges.cpp~
37 lines (28 loc) · 1.1 KB
/
testEvaluteMVGchanges.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
#include 'logUtils.h'
#include <vector>
#include <iostream>
int main(){
//Move this outside later maybe
double transArray[] = {0.0001,0.0,0.0,0.0001};
std::vector<double> transCovMat;
transCovMat.assign(transArray, transArray + sizeof(transArray)/sizeof(double));
// set additional variables
// create inverse matrix (hard coded)
double invTransArray[] = {10000.0,0.0,0.0,10000.0};
std::vector<double> invTransCovMat;
invTransCovMat.assign(invTransArray, invTransArray + sizeof(invTransArray)/sizeof(double));
// create determinant (hard coded)
double detCovMat = 0.00000001;
//Move this outside later maybe
double obsArray[] = {0.01,0.0,0.0,0.01};
std::vector<double> obsCovMat;
obsCovMat.assign(obsArray, obsArray + sizeof(obsArray)/sizeof(double));
// set additional variables
// create inverse matrix (hard coded)
double invObsArray[] = {100.0,0.0,0.0,100.0};
std::vector<double> invObsCovMat;
invObsCovMat.assign(invObsArray, invObsArray + sizeof(invObsArray)/sizeof(double));
// create determinant (hard coded)
double detCovMatO = 0.0001;
return 1;
}