Changed core_object_server to use geometry_msgs Point and Quaternion messages.