Segmentation fault trying to publish a tf2 message in ROS

[IvanPrzOl]

Hello,
I hope you can help me,

I'm using ROS kinetic and Ubuntu 16.04 LTS.

I'm trying to publish the camera pose of the monocular node as a tf2 message, I've followed the commits on #102 to guide me, but if I try to access to a member function on a tf2::Matrix3x3 object (i.e to convert a 3x3 rotation matrix into a quaternion) the node crashes.

So I tried to run it with gdb and it says:
Thread 1 "Mono" received signal SIGSEGV, Segmentation fault.
0x000000000040bf52 in ImageGrabber::GrabImage(boost::shared_ptr<sensor_msgs::Image_<std::allocator > const> const&) ()

This problem also happen when a try to send a TransformStamped object with the TransformBroadcaster.

Anybody knows what could be the problem?

Thanks.