Updated depth2cloud model, world frame measurement model