Use geometry_msgs/Vector3 as data type, also for the next three variables