Use geometry_msgs/Vector3 as data type