Changing rgb image topic and getting z coord from keypoint