Use geometry_msgs/Vector3, also for the next two variables