PointCloud.h

Go to the documentation of this file.

// ----------------------------------------------------------------------------
// -                        Open3D: www.open3d.org                            -
// ----------------------------------------------------------------------------
// The MIT License (MIT)
//
// Copyright (c) 2018 www.open3d.org
//
// Permission is hereby granted, free of charge, to any person obtaining a copy
// of this software and associated documentation files (the "Software"), to deal
// in the Software without restriction, including without limitation the rights
// to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
// copies of the Software, and to permit persons to whom the Software is
// furnished to do so, subject to the following conditions:
//
// The above copyright notice and this permission notice shall be included in
// all copies or substantial portions of the Software.
//
// THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
// IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
// FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
// AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
// LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
// FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
// IN THE SOFTWARE.
// ----------------------------------------------------------------------------

#pragma once

#include <string>
#include <unordered_map>
#include <unordered_set>

#include "open3d/core/Tensor.h"
#include "open3d/core/hashmap/Hashmap.h"
#include "open3d/geometry/PointCloud.h"
#include "open3d/t/geometry/Geometry.h"
#include "open3d/t/geometry/Image.h"
#include "open3d/t/geometry/RGBDImage.h"
#include "open3d/t/geometry/TensorMap.h"
#include "open3d/utility/Console.h"

namespace open3d {
namespace t {
namespace geometry {

class PointCloud : public Geometry {
public:
    PointCloud(const core::Device &device = core::Device("CPU:0"));

    PointCloud(const core::Tensor &points);

    PointCloud(const std::unordered_map<std::string, core::Tensor>
                       &map_keys_to_tensors);

    virtual ~PointCloud() override {}

    std::string ToString() const;

    const TensorMap &GetPointAttr() const { return point_attr_; }

    core::Tensor &GetPointAttr(const std::string &key) {
        return point_attr_.at(key);
    }

    core::Tensor &GetPoints() { return GetPointAttr("points"); }

    core::Tensor &GetPointColors() { return GetPointAttr("colors"); }

    core::Tensor &GetPointNormals() { return GetPointAttr("normals"); }

    const core::Tensor &GetPointAttr(const std::string &key) const {
        return point_attr_.at(key);
    }

    const core::Tensor &GetPoints() const { return GetPointAttr("points"); }

    const core::Tensor &GetPointColors() const {
        return GetPointAttr("colors");
    }

    const core::Tensor &GetPointNormals() const {
        return GetPointAttr("normals");
    }

    void SetPointAttr(const std::string &key, const core::Tensor &value) {
        if (value.GetDevice() != device_) {
            utility::LogError("Attribute device {} != Pointcloud's device {}.",
                              value.GetDevice().ToString(), device_.ToString());
        }
        point_attr_[key] = value;
    }

    void SetPoints(const core::Tensor &value) {
        value.AssertShapeCompatible({utility::nullopt, 3});
        SetPointAttr("points", value);
    }

    void SetPointColors(const core::Tensor &value) {
        value.AssertShapeCompatible({utility::nullopt, 3});
        SetPointAttr("colors", value);
    }

    void SetPointNormals(const core::Tensor &value) {
        value.AssertShapeCompatible({utility::nullopt, 3});
        SetPointAttr("normals", value);
    }

    bool HasPointAttr(const std::string &key) const {
        return point_attr_.Contains(key) && GetPointAttr(key).GetLength() > 0 &&
               GetPointAttr(key).GetLength() == GetPoints().GetLength();
    }

    void RemovePointAttr(const std::string &key) { point_attr_.Erase(key); }

    bool HasPoints() const { return HasPointAttr("points"); }

    bool HasPointColors() const { return HasPointAttr("colors"); }

    bool HasPointNormals() const { return HasPointAttr("normals"); }

public:
    PointCloud To(const core::Device &device, bool copy = false) const;

    PointCloud Clone() const;

    PointCloud CPU() const { return To(core::Device("CPU:0")); };

    PointCloud CUDA(int device_id = 0) const {
        return To(core::Device(core::Device::DeviceType::CUDA, device_id));
    };

    PointCloud &Clear() override {
        point_attr_.clear();
        return *this;
    }

    bool IsEmpty() const override { return !HasPoints(); }

    core::Tensor GetMinBound() const;

    core::Tensor GetMaxBound() const;

    core::Tensor GetCenter() const;

    PointCloud Append(const PointCloud &other) const;

    PointCloud operator+(const PointCloud &other) const {
        return Append(other);
    }

    PointCloud &Transform(const core::Tensor &transformation);

    PointCloud &Translate(const core::Tensor &translation,
                          bool relative = true);

    PointCloud &Scale(double scale, const core::Tensor &center);

    PointCloud &Rotate(const core::Tensor &R, const core::Tensor &center);

    PointCloud VoxelDownSample(double voxel_size,
                               const core::HashmapBackend &backend =
                                       core::HashmapBackend::Default) const;

    core::Device GetDevice() const { return device_; }

    static PointCloud CreateFromDepthImage(
            const Image &depth,
            const core::Tensor &intrinsics,
            const core::Tensor &extrinsics = core::Tensor::Eye(
                    4, core::Dtype::Float32, core::Device("CPU:0")),
            float depth_scale = 1000.0f,
            float depth_max = 3.0f,
            int stride = 1,
            bool with_normals = false);

    static PointCloud CreateFromRGBDImage(
            const RGBDImage &rgbd_image,
            const core::Tensor &intrinsics,
            const core::Tensor &extrinsics = core::Tensor::Eye(
                    4, core::Dtype::Float32, core::Device("CPU:0")),
            float depth_scale = 1000.0f,
            float depth_max = 3.0f,
            int stride = 1,
            bool with_normals = false);

    static PointCloud FromLegacyPointCloud(
            const open3d::geometry::PointCloud &pcd_legacy,
            core::Dtype dtype = core::Dtype::Float32,
            const core::Device &device = core::Device("CPU:0"));

    open3d::geometry::PointCloud ToLegacyPointCloud() const;

    geometry::Image ProjectToDepthImage(
            int width,
            int height,
            const core::Tensor &intrinsics,
            const core::Tensor &extrinsics = core::Tensor::Eye(
                    4, core::Dtype::Float32, core::Device("CPU:0")),
            float depth_scale = 1000.0f,
            float depth_max = 3.0f);

    geometry::RGBDImage ProjectToRGBDImage(
            int width,
            int height,
            const core::Tensor &intrinsics,
            const core::Tensor &extrinsics = core::Tensor::Eye(
                    4, core::Dtype::Float32, core::Device("CPU:0")),
            float depth_scale = 1000.0f,
            float depth_max = 3.0f);

protected:
    core::Device device_ = core::Device("CPU:0");
    TensorMap point_attr_;
};

}  // namespace geometry
}  // namespace t
}  // namespace open3d