Syncronized callbacks in ROS2

It is still catkin version, not completed