sudo apt-get install ros-kinetic-tf2-geometry-msgs
sudo apt-get install ros-kinetic-tf2-eigen
sudo apt-get install ros-kinetic-tf2
#include
include_directories(${catkin_INCLUDE_DIRS} ${Boost_INCLUDE_DIRS} ${EIGEN3_INCLUDE_DIRS} "/opt/ros/kinetic/include/tf2_geometry_msgs")