def is_reached(self, ob):
    import torch
    if isinstance(ob, torch.Tensor):
        ob = ob.cpu()
    dist = np.linalg.norm((ob[(- 3):] - ob[3:6]))
    return float((dist < self.distance_threshold))
def is_reached(self, ob):
    import torch
    if isinstance(ob, torch.Tensor):
        ob = ob.cpu()
    dist = np.linalg.norm((ob[(- 3):] - ob[3:6]))
    return float((dist < self.distance_threshold))