Yoji KURODA / Mbed 2 deprecated Odometry_test

This is an example of an odometry calculation

Dependencies:   Eigen mbed

Fork of Eigen_test by Yoji KURODA

main.cpp@0:5971b11ad8ff, 2016-10-13 (annotated)

Committer:
ykuroda
Date:
Thu Oct 13 04:07:45 2016 +0000
Revision:
0:5971b11ad8ff
Child:
1:ad6e79769c8f
First commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ykuroda 0:5971b11ad8ff 1 #include "mbed.h"
ykuroda 0:5971b11ad8ff 2 #include <iostream>
ykuroda 0:5971b11ad8ff 3 #include <Eigen/Dense.h>
ykuroda 0:5971b11ad8ff 4 using namespace std;
ykuroda 0:5971b11ad8ff 5 using namespace Eigen;
ykuroda 0:5971b11ad8ff 6
ykuroda 0:5971b11ad8ff 7 int main() {
ykuroda 0:5971b11ad8ff 8
ykuroda 0:5971b11ad8ff 9 Matrix3f A;
ykuroda 0:5971b11ad8ff 10 Vector3f b;
ykuroda 0:5971b11ad8ff 11 A << 1,2,3, 4,5,6, 7,8,10;
ykuroda 0:5971b11ad8ff 12 b << 3, 3, 4;
ykuroda 0:5971b11ad8ff 13 cout << "Here is the matrix A:\n" << A << endl;
ykuroda 0:5971b11ad8ff 14 cout << "Here is the vector b:\n" << b << endl;
ykuroda 0:5971b11ad8ff 15 Vector3f x = A.colPivHouseholderQr().solve(b);
ykuroda 0:5971b11ad8ff 16 //Vector3f x = A.inverse() * b;
ykuroda 0:5971b11ad8ff 17 cout << "The solution is:\n" << x << endl;
ykuroda 0:5971b11ad8ff 18 }