Update function depthMapToImageMsg.