-
Notifications
You must be signed in to change notification settings - Fork 0
/
interpolatore_lin_matrix.cxx
47 lines (38 loc) · 1.08 KB
/
interpolatore_lin_matrix.cxx
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
/*
* Author: Sever Oraz
* This is a linear interpolator that uses Matrix arithmetic instead
* of classic algebra.
*/
#include <iostream>
#include <cstdlib>
#include <Eigen/Core>
#include <Eigen/LU>
int main(const int argc, const char* argv[]) {
// $0 x0 x1 y0 y1 x -> y
if (argc != 6) {
std::cout << argv[0] << " x0 x1 y0 y1 x" << std::endl <<
"Return: y" << std::endl;
return 1;
}
else {
// Convert parameters to floats
float xn[2] = {strtof(argv[1],NULL), strtof(argv[2],NULL)};
float yn[2] = {strtof(argv[3],NULL), strtof(argv[4],NULL)};
// Known values
Eigen::Matrix2f X;
X << 1, xn[0], 1, xn[1];
Eigen::Matrix2f Xt = X.transpose();
Eigen::Matrix2f Z = Xt*X;
Eigen::Vector2f Y(yn[0],yn[1]);
Eigen::Vector2f x(1,strtof(argv[5],NULL));
// Unknowns
Eigen::Vector2f C;
float y = 0.0;
// Solution
C = Z.inverse()*Xt*Y;
y = C.dot(x);
// Reveal
std::cout << y << std::endl;
return 0;
}
}