Eigen pred

• Add dummy print gtest macro PRINT_TEST_FINISHED -> simply prints test & test-case name once test-case has finished.
• Moved (well copied) MatrixSizeCheck to separate file & added VectorSizeCheck & RowVectorSizeCheck aliases
• Add plenty of predicates (lambdas functions) to test Eigen-related things - e.g. later use in gtest test macro
• Add a getYaw function to rotation.h

src/rotations.h

@@ -416,6 +416,13 @@ inline Eigen::Matrix<T, 3, 3> matrixRollPitchYaw(const T roll,
   return (az * ay * ax).toRotationMatrix().matrix();
 }
 
+template <typename Derived>
+inline typename Eigen::MatrixBase<Derived>::Scalar
+getYaw(const Eigen::MatrixBase<Derived>& r)
+{
+  using std::atan2;
+  return atan2( r(1, 0), r(0, 0) );
+}
 
 } // namespace wolf