SE2 -> Eigen::Isometry2d() cast operator
Adding tictoc profiling utility code