Added Eigen math library

Very helpful to convert the matrices in euler angles