import cv2
import os
if __name__ == '__main__':
folder = "/home/mathieu/Dataset/DeepTrack/dragon/"
dataset_path = os.path.join(folder, "train_raw_real")
new_dataset_path = os.path.join(folder, "train_raw_real_resized")
if not os.path.exists(new_dataset_path):
os.mkdir(new_dataset_path)
dataset = Dataset(dataset_path)
if not dataset.load():
print("[Error]: Train dataset empty")
sys.exit(-1)
new_dataset = Dataset(new_dataset_path)
new_dataset.camera = dataset.camera.copy()
new_dataset.camera.set_ratio(2)
for i in range(dataset.size()):
rgb, depth, pose = dataset.load_image(i)
new_rgb = cv2.resize(
rgb, (new_dataset.camera.width, new_dataset.camera.height))
new_depth = cv2.resize(
depth, (new_dataset.camera.width, new_dataset.camera.height))
new_dataset.add_pose(new_rgb, new_depth, pose)
if i % (1 * dataset.size() / 100) == 0:
print("Progress : {}%".format(i * 100 / dataset.size()))
new_dataset.set_save_type(dataset.metadata["save_type"])
new_dataset.dump_images_on_disk()
new_dataset.save_json_files(dataset.metadata)
class DataAugmentation:
def __init__(self):
self.occluder = None
self.background = None
self.rgb_noise = None
self.depth_noise = None
self.blur_kernel = None
self.jitter = None
self.hue_noise = None
def set_background(self, path):
self.background = RGBDDataset(path)
def set_occluder(self, path):
self.occluder = Dataset(path)
self.occluder.load()
def set_rgb_noise(self, gaussian_std):
self.rgb_noise = gaussian_std
def set_depth_noise(self, gaussian_std):
self.depth_noise = gaussian_std
def set_hue_noise(self, offset):
"""
offset is the % of random hue offset distribution
:param offset:
:return:
"""
self.hue_noise = offset
def set_blur(self, size):
self.blur_kernel = size
def set_jitter(self, max_x, max_y):
self.jitter = (max_x, max_y)
def augment(self, rgb, depth, prior, real=False):
ret_rgb = rgb
ret_depth = depth
if real and self.occluder:
if random.uniform(0, 1) < 0.75:
rand_id = random.randint(0, self.occluder.size() - 1)
occluder_rgb, occluder_depth, occ_pose = self.occluder.load_image(rand_id)
if random.randint(0, 1):
occluder_rgb, occluder_depth, _ = self.occluder.load_pair(rand_id, 0)
occluder_depth = occluder_depth.astype(np.float32)
# Z offset of occluder to be closer to the occluded object ( with random distance in front of the object)
offset = -occ_pose.matrix[2, 3] + prior.matrix[2, 3] - random.uniform(0.07, 0.01)
occluder_depth += offset
occluder_rgb = self.add_hue_noise(occluder_rgb, 1)
occluder_rgb = imresize(occluder_rgb, ret_depth.shape, interp='nearest')
occluder_depth = imresize(occluder_depth, ret_depth.shape, interp='nearest', mode="F").astype(np.int16)
ret_rgb, ret_depth = self.depth_blend(ret_rgb, ret_depth, occluder_rgb, occluder_depth)
if real and self.hue_noise:
if random.uniform(0, 1) > 0.05:
ret_rgb = self.add_hue_noise(ret_rgb, self.hue_noise)
if self.jitter:
self.x_jitter = random.randint(-self.jitter[0], self.jitter[0])
self.y_jitter = random.randint(-self.jitter[1], self.jitter[1])
if self.x_jitter > 0:
ret_rgb = np.pad(ret_rgb, ((self.x_jitter, 0), (0, 0), (0, 0)), mode='constant')[:-self.x_jitter, :, :]
ret_depth = np.pad(ret_depth, ((self.x_jitter, 0), (0, 0)), mode='constant')[:-self.x_jitter, :]
else:
ret_rgb = np.pad(ret_rgb, ((0, abs(self.x_jitter)), (0, 0), (0, 0)), mode='constant')[
abs(self.x_jitter):, :, :]
ret_depth = np.pad(ret_depth, ((0, abs(self.x_jitter)), (0, 0)), mode='constant')[abs(self.x_jitter):,
:]
if self.y_jitter > 0:
ret_rgb = np.pad(ret_rgb, ((0, 0), (self.y_jitter, 0), (0, 0)), mode='constant')[:, :-self.y_jitter, :]
ret_depth = np.pad(ret_depth, ((0, 0), (self.y_jitter, 0)), mode='constant')[:, :-self.y_jitter]
else:
ret_rgb = np.pad(ret_rgb, ((0, 0), (0, abs(self.y_jitter)), (0, 0)), mode='constant')[:,
abs(self.y_jitter):, :]
ret_depth = np.pad(ret_depth, ((0, 0), (0, abs(self.y_jitter))), mode='constant')[:,
abs(self.y_jitter):]
if real and self.background:
color_background, depth_background = self.background.load_random_image(ret_rgb.shape[1])
depth_background = depth_background.astype(np.int32)
ret_rgb, ret_depth = self.color_blend(ret_rgb, ret_depth, color_background, depth_background)
if real and self.rgb_noise:
if random.uniform(0, 1) > 0.05:
noise = random.uniform(0, self.rgb_noise)
ret_rgb = self.add_noise(ret_rgb, noise)
if real and self.depth_noise:
if random.uniform(0, 1) > 0.05:
noise = random.uniform(0, self.depth_noise)
ret_depth = self.add_noise(ret_depth, noise)
if real and self.blur_kernel is not None:
if random.uniform(0, 1) < 0.75:
kernel_size = random.randint(3, self.blur_kernel)
kernel = self.gkern(kernel_size)
ret_rgb[0, :, :] = scipy.signal.convolve2d(ret_rgb[0, :, :], kernel, mode='same')
ret_rgb[1, :, :] = scipy.signal.convolve2d(ret_rgb[1, :, :], kernel, mode='same')
ret_rgb[2, :, :] = scipy.signal.convolve2d(ret_rgb[2, :, :], kernel, mode='same')
if random.uniform(0, 1) < 0.75:
kernel_size = random.randint(3, self.blur_kernel)
kernel = self.gkern(kernel_size)
ret_depth[:, :] = scipy.signal.convolve2d(ret_depth[:, :], kernel, mode='same')
return ret_rgb.astype(np.uint8), ret_depth
@staticmethod
def add_noise(img, gaussian_std):
type = img.dtype
copy = img.astype(np.float)
gaussian_noise = np.random.normal(0, gaussian_std, img.shape)
copy = (gaussian_noise + copy)
if type == np.uint8:
copy[copy < 0] = 0
copy[copy > 255] = 255
return copy.astype(type)
@staticmethod
def add_hue_noise(rgb, hue_offset):
hsv = rgb2hsv(rgb)
hsv[:, :, 0] = (hsv[:, :, 0] + random.uniform(-hue_offset, hue_offset)) % 1
rgb = hsv2rgb(hsv) * 255
return rgb.astype(np.uint8)
@staticmethod
def color_blend(rgb1, depth1, rgb2, depth2):
mask = np.all(rgb1 == 0, axis=2)
mask = ndimage.binary_dilation(mask).astype(mask.dtype)
depth1[mask] = 0
rgb1[mask, :] = 0
mask = mask.astype(np.uint8)
new_depth = depth2 * mask + depth1
new_color = rgb2 * mask[:, :, np.newaxis] + rgb1
return new_color.astype(np.uint8), new_depth
@staticmethod
def depth_blend(rgb1, depth1, rgb2, depth2):
new_depth2 = depth2.copy()
new_depth1 = depth1.copy()
rgb1_mask = np.all(rgb1 == 0, axis=2)
rgb2_mask = np.all(rgb2 == 0, axis=2)
rgb1_mask = ndimage.binary_dilation(rgb1_mask)
new_depth2[rgb2_mask] = -100000
new_depth1[rgb1_mask] = -100000
mask = (new_depth1 < new_depth2)
pos_mask = mask.astype(np.uint8)
neg_mask = (mask == False).astype(np.uint8)
masked_rgb_occluder = rgb1 * pos_mask[:, :, np.newaxis]
masked_rgb_object = rgb2 * neg_mask[:, :, np.newaxis]
masked_depth_occluder = depth1 * pos_mask
masked_depth_object = depth2 * neg_mask
blend_rgb = masked_rgb_occluder + masked_rgb_object
blend_depth = masked_depth_occluder + masked_depth_object
return blend_rgb, blend_depth
@staticmethod
def gkern(kernlen=21, nsig=3.5):
"""Returns a 2D Gaussian kernel array."""
interval = (2 * nsig + 1.) / (kernlen)
x = np.linspace(-nsig - interval / 2., nsig + interval / 2., kernlen + 1)
kern1d = np.diff(st.norm.cdf(x))
kernel_raw = np.sqrt(np.outer(kern1d, kern1d))
kernel = kernel_raw / kernel_raw.sum()
return kernel
background_path = "/home/mathieu/Dataset/RGBD/SUN3D"
object_dataset = Dataset(object_path)
object_dataset.load()
data_augmentation = DataAugmentation()
data_augmentation.set_rgb_noise(2)
data_augmentation.set_depth_noise(2)
data_augmentation.set_hue_noise(0.07)
data_augmentation.set_occluder(occluder_path)
data_augmentation.set_background(background_path)
data_augmentation.set_blur(5)
# data_augmentation.set_jitter(20, 20)
for i in range(object_dataset.size()):
rgb, depth, pose = object_dataset.load_image(i)
rgb, depth, label = object_dataset.load_pair(i, 0)
rgb_augmented, depth_augmented = data_augmentation.augment(
rgb, depth, pose, True)
plt.figure(0)
plt.imshow(rgb)
plt.figure(1)
plt.imshow(rgb_augmented)
plt.figure(2)
plt.imshow(rgb - rgb_augmented)
plt.show()
plt.figure(0)
plt.imshow(depth)
plt.figure(1)
