dbsampler.py 12.8 KB
Newer Older
dingchang's avatar
dingchang committed
1
# Copyright (c) OpenMMLab. All rights reserved.
zhangwenwei's avatar
zhangwenwei committed
2
import copy
3
import os
4
from typing import List, Optional
5

6
import mmengine
zhangwenwei's avatar
zhangwenwei committed
7
import numpy as np
zhangwenwei's avatar
zhangwenwei committed
8

zhangshilong's avatar
zhangshilong committed
9
from mmdet3d.datasets.transforms import data_augment_utils
10
from mmdet3d.registry import TRANSFORMS
zhangshilong's avatar
zhangshilong committed
11
from mmdet3d.structures.ops import box_np_ops
zhangwenwei's avatar
zhangwenwei committed
12
13
14


class BatchSampler:
wangtai's avatar
wangtai committed
15
16
17
18
    """Class for sampling specific category of ground truths.

    Args:
        sample_list (list[dict]): List of samples.
19
20
        name (str, optional): The category of samples. Defaults to None.
        epoch (int, optional): Sampling epoch. Defaults to None.
21
22
        shuffle (bool): Whether to shuffle indices. Defaults to False.
        drop_reminder (bool): Drop reminder. Defaults to False.
wangtai's avatar
wangtai committed
23
    """
zhangwenwei's avatar
zhangwenwei committed
24
25

    def __init__(self,
26
27
28
29
30
                 sampled_list: List[dict],
                 name: Optional[str] = None,
                 epoch: Optional[int] = None,
                 shuffle: bool = True,
                 drop_reminder: bool = False) -> None:
zhangwenwei's avatar
zhangwenwei committed
31
32
33
34
35
36
37
38
39
40
41
42
        self._sampled_list = sampled_list
        self._indices = np.arange(len(sampled_list))
        if shuffle:
            np.random.shuffle(self._indices)
        self._idx = 0
        self._example_num = len(sampled_list)
        self._name = name
        self._shuffle = shuffle
        self._epoch = epoch
        self._epoch_counter = 0
        self._drop_reminder = drop_reminder

43
    def _sample(self, num: int) -> List[int]:
wangtai's avatar
wangtai committed
44
45
46
47
48
49
50
51
        """Sample specific number of ground truths and return indices.

        Args:
            num (int): Sampled number.

        Returns:
            list[int]: Indices of sampled ground truths.
        """
zhangwenwei's avatar
zhangwenwei committed
52
53
54
55
56
57
58
59
        if self._idx + num >= self._example_num:
            ret = self._indices[self._idx:].copy()
            self._reset()
        else:
            ret = self._indices[self._idx:self._idx + num]
            self._idx += num
        return ret

60
    def _reset(self) -> None:
wangtai's avatar
wangtai committed
61
        """Reset the index of batchsampler to zero."""
zhangwenwei's avatar
zhangwenwei committed
62
63
64
65
66
67
        assert self._name is not None
        # print("reset", self._name)
        if self._shuffle:
            np.random.shuffle(self._indices)
        self._idx = 0

68
    def sample(self, num: int) -> List[dict]:
wangtai's avatar
wangtai committed
69
70
71
72
73
74
75
76
        """Sample specific number of ground truths.

        Args:
            num (int): Sampled number.

        Returns:
            list[dict]: Sampled ground truths.
        """
zhangwenwei's avatar
zhangwenwei committed
77
78
79
80
        indices = self._sample(num)
        return [self._sampled_list[i] for i in indices]


81
@TRANSFORMS.register_module()
zhangwenwei's avatar
zhangwenwei committed
82
class DataBaseSampler(object):
83
84
85
86
87
88
89
90
    """Class for sampling data from the ground truth database.

    Args:
        info_path (str): Path of groundtruth database info.
        data_root (str): Path of groundtruth database.
        rate (float): Rate of actual sampled over maximum sampled number.
        prepare (dict): Name of preparation functions and the input value.
        sample_groups (dict): Sampled classes and numbers.
91
        classes (list[str], optional): List of classes. Defaults to None.
92
        points_loader (dict): Config of points loader. Defaults to
93
            dict(type='LoadPointsFromFile', load_dim=4, use_dim=[0, 1, 2, 3]).
94
95
96
        file_client_args (dict): Arguments to instantiate a FileClient.
            See :class:`mmengine.fileio.FileClient` for details.
            Defaults to dict(backend='disk').
97
    """
zhangwenwei's avatar
zhangwenwei committed
98

99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
    def __init__(
        self,
        info_path: str,
        data_root: str,
        rate: float,
        prepare: dict,
        sample_groups: dict,
        classes: Optional[List[str]] = None,
        points_loader: dict = dict(
            type='LoadPointsFromFile',
            coord_type='LIDAR',
            load_dim=4,
            use_dim=[0, 1, 2, 3]),
        file_client_args: dict = dict(backend='disk')
    ) -> None:
zhangwenwei's avatar
zhangwenwei committed
114
        super().__init__()
zhangwenwei's avatar
zhangwenwei committed
115
        self.data_root = data_root
zhangwenwei's avatar
zhangwenwei committed
116
117
118
        self.info_path = info_path
        self.rate = rate
        self.prepare = prepare
zhangwenwei's avatar
zhangwenwei committed
119
120
121
        self.classes = classes
        self.cat2label = {name: i for i, name in enumerate(classes)}
        self.label2cat = {i: name for i, name in enumerate(classes)}
122
        self.points_loader = TRANSFORMS.build(points_loader)
123
        self.file_client = mmengine.FileClient(**file_client_args)
zhangwenwei's avatar
zhangwenwei committed
124

125
        # load data base infos
126
127
128
        with self.file_client.get_local_path(info_path) as local_path:
            # loading data from a file-like object needs file format
            db_infos = mmengine.load(open(local_path, 'rb'), file_format='pkl')
zhangwenwei's avatar
zhangwenwei committed
129
130

        # filter database infos
131
132
        from mmengine.logging import MMLogger
        logger: MMLogger = MMLogger.get_current_instance()
zhangwenwei's avatar
zhangwenwei committed
133
        for k, v in db_infos.items():
134
            logger.info(f'load {len(v)} {k} database infos in DataBaseSampler')
zhangwenwei's avatar
zhangwenwei committed
135
136
137
138
        for prep_func, val in prepare.items():
            db_infos = getattr(self, prep_func)(db_infos, val)
        logger.info('After filter database:')
        for k, v in db_infos.items():
139
            logger.info(f'load {len(v)} {k} database infos in DataBaseSampler')
zhangwenwei's avatar
zhangwenwei committed
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161

        self.db_infos = db_infos

        # load sample groups
        # TODO: more elegant way to load sample groups
        self.sample_groups = []
        for name, num in sample_groups.items():
            self.sample_groups.append({name: int(num)})

        self.group_db_infos = self.db_infos  # just use db_infos
        self.sample_classes = []
        self.sample_max_nums = []
        for group_info in self.sample_groups:
            self.sample_classes += list(group_info.keys())
            self.sample_max_nums += list(group_info.values())

        self.sampler_dict = {}
        for k, v in self.group_db_infos.items():
            self.sampler_dict[k] = BatchSampler(v, k, shuffle=True)
        # TODO: No group_sampling currently

    @staticmethod
162
    def filter_by_difficulty(db_infos: dict, removed_difficulty: list) -> dict:
163
164
165
166
167
168
169
170
171
        """Filter ground truths by difficulties.

        Args:
            db_infos (dict): Info of groundtruth database.
            removed_difficulty (list): Difficulties that are not qualified.

        Returns:
            dict: Info of database after filtering.
        """
zhangwenwei's avatar
zhangwenwei committed
172
173
174
175
176
177
178
179
180
        new_db_infos = {}
        for key, dinfos in db_infos.items():
            new_db_infos[key] = [
                info for info in dinfos
                if info['difficulty'] not in removed_difficulty
            ]
        return new_db_infos

    @staticmethod
181
    def filter_by_min_points(db_infos: dict, min_gt_points_dict: dict) -> dict:
182
183
184
185
186
187
188
189
190
191
        """Filter ground truths by number of points in the bbox.

        Args:
            db_infos (dict): Info of groundtruth database.
            min_gt_points_dict (dict): Different number of minimum points
                needed for different categories of ground truths.

        Returns:
            dict: Info of database after filtering.
        """
zhangwenwei's avatar
zhangwenwei committed
192
193
194
195
196
197
198
199
200
201
        for name, min_num in min_gt_points_dict.items():
            min_num = int(min_num)
            if min_num > 0:
                filtered_infos = []
                for info in db_infos[name]:
                    if info['num_points_in_gt'] >= min_num:
                        filtered_infos.append(info)
                db_infos[name] = filtered_infos
        return db_infos

202
203
204
205
206
    def sample_all(self,
                   gt_bboxes: np.ndarray,
                   gt_labels: np.ndarray,
                   img: Optional[np.ndarray] = None,
                   ground_plane: Optional[np.ndarray] = None) -> dict:
207
208
209
210
        """Sampling all categories of bboxes.

        Args:
            gt_bboxes (np.ndarray): Ground truth bounding boxes.
liyinhao's avatar
liyinhao committed
211
            gt_labels (np.ndarray): Ground truth labels of boxes.
212
213
214
            img (np.ndarray, optional): Image array. Defaults to None.
            ground_plane (np.ndarray, optional): Ground plane information.
                Defaults to None.
215
216
217
218

        Returns:
            dict: Dict of sampled 'pseudo ground truths'.

219
                - gt_labels_3d (np.ndarray): ground truths labels
220
                  of sampled objects.
221
                - gt_bboxes_3d (:obj:`BaseInstance3DBoxes`):
222
                  sampled ground truth 3D bounding boxes
223
224
225
                - points (np.ndarray): sampled points
                - group_ids (np.ndarray): ids of sampled ground truths
        """
zhangwenwei's avatar
zhangwenwei committed
226
227
228
229
        sampled_num_dict = {}
        sample_num_per_class = []
        for class_name, max_sample_num in zip(self.sample_classes,
                                              self.sample_max_nums):
zhangwenwei's avatar
zhangwenwei committed
230
231
232
            class_label = self.cat2label[class_name]
            # sampled_num = int(max_sample_num -
            #                   np.sum([n == class_name for n in gt_names]))
zhangwenwei's avatar
zhangwenwei committed
233
            sampled_num = int(max_sample_num -
zhangwenwei's avatar
zhangwenwei committed
234
                              np.sum([n == class_label for n in gt_labels]))
zhangwenwei's avatar
zhangwenwei committed
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
            sampled_num = np.round(self.rate * sampled_num).astype(np.int64)
            sampled_num_dict[class_name] = sampled_num
            sample_num_per_class.append(sampled_num)

        sampled = []
        sampled_gt_bboxes = []
        avoid_coll_boxes = gt_bboxes

        for class_name, sampled_num in zip(self.sample_classes,
                                           sample_num_per_class):
            if sampled_num > 0:
                sampled_cls = self.sample_class_v2(class_name, sampled_num,
                                                   avoid_coll_boxes)

                sampled += sampled_cls
                if len(sampled_cls) > 0:
                    if len(sampled_cls) == 1:
                        sampled_gt_box = sampled_cls[0]['box3d_lidar'][
                            np.newaxis, ...]
                    else:
                        sampled_gt_box = np.stack(
                            [s['box3d_lidar'] for s in sampled_cls], axis=0)

                    sampled_gt_bboxes += [sampled_gt_box]
                    avoid_coll_boxes = np.concatenate(
                        [avoid_coll_boxes, sampled_gt_box], axis=0)

        ret = None
        if len(sampled) > 0:
            sampled_gt_bboxes = np.concatenate(sampled_gt_bboxes, axis=0)
            # center = sampled_gt_bboxes[:, 0:3]

zhangwenwei's avatar
zhangwenwei committed
267
            # num_sampled = len(sampled)
zhangwenwei's avatar
zhangwenwei committed
268
269
270
271
            s_points_list = []
            count = 0
            for info in sampled:
                file_path = os.path.join(
zhangwenwei's avatar
zhangwenwei committed
272
273
                    self.data_root,
                    info['path']) if self.data_root else info['path']
274
                results = dict(lidar_points=dict(lidar_path=file_path))
275
                s_points = self.points_loader(results)['points']
276
                s_points.translate(info['box3d_lidar'][:3])
zhangwenwei's avatar
zhangwenwei committed
277
278
279
280

                count += 1

                s_points_list.append(s_points)
281
282
283

            gt_labels = np.array([self.cat2label[s['name']] for s in sampled],
                                 dtype=np.long)
284
285
286
287
288
289
290
291
292

            if ground_plane is not None:
                xyz = sampled_gt_bboxes[:, :3]
                dz = (ground_plane[:3][None, :] *
                      xyz).sum(-1) + ground_plane[3]
                sampled_gt_bboxes[:, 2] -= dz
                for i, s_points in enumerate(s_points_list):
                    s_points.tensor[:, 2].sub_(dz[i])

zhangwenwei's avatar
zhangwenwei committed
293
            ret = {
zhangwenwei's avatar
zhangwenwei committed
294
295
                'gt_labels_3d':
                gt_labels,
zhangwenwei's avatar
zhangwenwei committed
296
297
298
                'gt_bboxes_3d':
                sampled_gt_bboxes,
                'points':
299
                s_points_list[0].cat(s_points_list),
zhangwenwei's avatar
zhangwenwei committed
300
301
302
303
304
305
306
                'group_ids':
                np.arange(gt_bboxes.shape[0],
                          gt_bboxes.shape[0] + len(sampled))
            }

        return ret

307
    def sample_class_v2(self, name: str, num: int,
308
                        gt_bboxes: np.ndarray) -> List[dict]:
309
310
311
312
313
314
315
316
317
318
        """Sampling specific categories of bounding boxes.

        Args:
            name (str): Class of objects to be sampled.
            num (int): Number of sampled bboxes.
            gt_bboxes (np.ndarray): Ground truth boxes.

        Returns:
            list[dict]: Valid samples after collision test.
        """
zhangwenwei's avatar
zhangwenwei committed
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
        sampled = self.sampler_dict[name].sample(num)
        sampled = copy.deepcopy(sampled)
        num_gt = gt_bboxes.shape[0]
        num_sampled = len(sampled)
        gt_bboxes_bv = box_np_ops.center_to_corner_box2d(
            gt_bboxes[:, 0:2], gt_bboxes[:, 3:5], gt_bboxes[:, 6])

        sp_boxes = np.stack([i['box3d_lidar'] for i in sampled], axis=0)
        boxes = np.concatenate([gt_bboxes, sp_boxes], axis=0).copy()

        sp_boxes_new = boxes[gt_bboxes.shape[0]:]
        sp_boxes_bv = box_np_ops.center_to_corner_box2d(
            sp_boxes_new[:, 0:2], sp_boxes_new[:, 3:5], sp_boxes_new[:, 6])

        total_bv = np.concatenate([gt_bboxes_bv, sp_boxes_bv], axis=0)
        coll_mat = data_augment_utils.box_collision_test(total_bv, total_bv)
        diag = np.arange(total_bv.shape[0])
        coll_mat[diag, diag] = False

        valid_samples = []
        for i in range(num_gt, num_gt + num_sampled):
            if coll_mat[i].any():
                coll_mat[i] = False
                coll_mat[:, i] = False
            else:
                valid_samples.append(sampled[i - num_gt])
        return valid_samples