File size: 4,898 Bytes
55e58d1
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
import pickle
from pathlib import Path
import torch
import cv2
import numpy as np
import os
import open3d as o3d
from tqdm import tqdm

def process_scene(scene_params, target_depth_shape=None):
    images = scene_params["image_files"]
    poses = scene_params["poses"]
    depths = scene_params["depths"]
    Ks = scene_params["Ks"]
    pts3d = scene_params["pts3d"]
    im_confs = scene_params["im_conf"]
    print(scene_params.keys())
    im_shapes = scene_params["imshapes"]
    im_shape = im_shapes[0]

    image_hw = cv2.imread(images[0]).shape[:2]
    image_scale = np.ones((3, 3))
    image_scale[0] *= image_hw[1] / im_shape[1]
    image_scale[1] *= image_hw[0] / im_shape[0]

    if target_depth_shape is None:
        target_depth_shape = image_hw


    depth_scale = np.ones((3, 3))
    depth_scale[0] *= target_depth_shape[1] / im_shape[1]
    depth_scale[1] *= target_depth_shape[0] / im_shape[0]

    data = [
        {
            "image_path": image,
            "pose": pose,
            "depth": cv2.resize(depth.numpy(), target_depth_shape[::-1], interpolation=cv2.INTER_LINEAR),
            "source_K": K,
            "image_K": K * image_scale,
            "depth_K": K * depth_scale,
            "pts3d": pts,
            "im_conf": im_conf,
            "im_shape_target": image_hw,
            "depth_shape_target": target_depth_shape,
            "shape_original": im_shape,
        } for image, pose, depth, K, pts, im_conf in zip(images, poses, depths, Ks, pts3d, im_confs)
    ]

    return data


def export_scene(scene_id, data, processing_args):
    out_path = processing_args["out_dir"] / scene_id
    K_color = data[0]["image_K"]
    K_depth = data[0]["depth_K"]
    
    def proc_k(K):
        res = np.eye(4)
        res[:3, :3] = K[:3, :3]
        return res
    
    K_color = proc_k(K_color)
    K_depth = proc_k(K_depth)
    intrinsics_path = out_path / "intrinsic"
    intrinsics_path.mkdir(parents=True, exist_ok=True)
    np.savetxt(intrinsics_path / "intrinsic_color.txt", K_color)
    np.savetxt(intrinsics_path / "intrinsic_depth.txt", K_depth)

    np.savetxt(intrinsics_path / "extrinsic_color.txt", np.eye(4))
    np.savetxt(intrinsics_path / "extrinsic_depth.txt", np.eye(4))

    for i, item in enumerate(data):
        img_name = Path(item["image_path"]).stem
        image_path = out_path / "color" / f"{img_name}.jpg"
        image_path.parent.mkdir(parents=True, exist_ok=True)
        try:
            os.symlink(item["image_path"], image_path)
        except FileExistsError:
            pass
        

        depth_path = out_path / "depth" / f"{img_name}.png"
        depth_path.parent.mkdir(parents=True, exist_ok=True)
        try:
            os.symlink(item["depth_path"], depth_path)
        except FileExistsError:
            pass

        pose_path = out_path / "pose" / f"{img_name}.txt"
        pose_path.parent.mkdir(parents=True, exist_ok=True)
        np.savetxt(pose_path, item["pose"])
    
    try:
        os.symlink(item["pts3d_path"], out_path / f"{scene_id}_vh_clean_2.ply")
    except FileExistsError:
        pass

    
    
    
    

processing_args = {
    "confidence_threshold": 1,
    "voxel_size": 0.025,
    "out_dir": Path("data/arkit_gt_train/processed"),
}


val_path = Path("../") / "OKNO/data/arkitscenes/arkitscenes_offline_infos_train.pkl"
out_dir = Path("data/arkit_gt/processed")
with open(val_path, "rb") as f:
    data = pickle.load(f)

data_list = data["data_list"]
val_scenes = [scene["lidar_points"]["lidar_path"] for scene in data_list][:2500]
def extract_name(item):
    return item.split("_")[0]
val_scenes = [extract_name(scene) for scene in val_scenes]

scenes_path = Path("/workspace-SR006.nfs2/datasets/arkitscenes/offline_prepared_data/posed_images")
pcd_path = Path("/workspace-SR006.nfs2/datasets/arkit_data/3dod/Training/")
scene = val_scenes[0]
num_images = 160


for scene in tqdm(val_scenes):
    try:
        if (processing_args["out_dir"] / scene).exists():
            continue
        scene_path = scenes_path / scene

        colors = sorted(scene_path.glob("*.jpg"))
        if len(colors) > num_images:
            indices = np.linspace(0, len(colors) - 1, num_images).astype(int)
            colors = [colors[i] for i in indices]
        depths = [a.parent / (a.stem + ".png") for a in colors]
        poses = [a.parent / (a.stem + ".txt") for a in colors]
        K = np.loadtxt(scene_path / "intrinsic.txt")

        scene_params = [{
            "image_path": image,
            "pose": np.loadtxt(pose),
            "depth_path": depth,
            "source_K": K,
            "image_K": K,
            "depth_K": K,
            "pts3d_path": pcd_path / scene / f"{scene}_3dod_mesh.ply",
        } for image, depth, pose in zip(colors, depths, poses)]
        export_scene(scene, scene_params, processing_args)
    except Exception as e:
        print(e)
        continue