PointCloudICP.h

Go to the documentation of this file.

// This code contains NVIDIA Confidential Information and is disclosed
// under the Mutual Non-Disclosure Agreement.
//
// Notice
// ALL NVIDIA DESIGN SPECIFICATIONS AND CODE ("MATERIALS") ARE PROVIDED "AS IS" NVIDIA MAKES
// NO REPRESENTATIONS, WARRANTIES, EXPRESSED, IMPLIED, STATUTORY, OR OTHERWISE WITH RESPECT TO
// THE MATERIALS, AND EXPRESSLY DISCLAIMS ANY IMPLIED WARRANTIES OF NONINFRINGEMENT,
// MERCHANTABILITY, OR FITNESS FOR A PARTICULAR PURPOSE.
//
// NVIDIA Corporation assumes no responsibility for the consequences of use of such
// information or for any infringement of patents or other rights of third parties that may
// result from its use. No license is granted by implication or otherwise under any patent
// or patent rights of NVIDIA Corporation. No third party distribution is allowed unless
// expressly authorized by NVIDIA.  Details are subject to change without notice.
// This code supersedes and replaces all information previously supplied.
// NVIDIA Corporation products are not authorized for use as critical
// components in life support devices or systems without express written approval of
// NVIDIA Corporation.
//
// Copyright (c) 2018-2020 NVIDIA Corporation. All rights reserved.
//
// NVIDIA Corporation and its licensors retain all intellectual property and proprietary
// rights in and to this software and related documentation and any modifications thereto.
// Any use, reproduction, disclosure or distribution of this software and related
// documentation without an express license agreement from NVIDIA Corporation is
// strictly prohibited.
//

#ifndef DW_POINTCLOUDPROCESSING_POINTCLOUDICP_H_
#define DW_POINTCLOUDPROCESSING_POINTCLOUDICP_H_
#include <dw/core/Context.h>
#include <dw/pointcloudprocessing/PointCloud.h>

#ifdef __cplusplus
extern "C" {
#endif

typedef struct dwPointCloudICPObject* dwPointCloudICPHandle_t;

typedef enum dwPointCloudICPType {
    DW_POINT_CLOUD_ICP_TYPE_DEPTH_MAP

} dwPointCloudICPType;

typedef struct dwPointCloudICPParams
{
    dwPointCloudICPType icpType;

    uint32_t maxPoints;

    dwVector2ui depthmapSize;

    float32_t angleConvergenceTol;

    float32_t distanceConvergenceTol;

    uint16_t maxIterations;

    bool usePriors;
} dwPointCloudICPParams;

typedef bool (*dwPointCloudICPConvergenceCheck)(const dwTransformation3f* prevSrc2Tgt, const dwTransformation3f* newSrc2Tgt, void* userData);

typedef struct dwPointCloudICPResultStats
{
    uint16_t actualNumIterations;
    float32_t rmsCost;
    float32_t inlierFraction;
    uint32_t numCorrespondences;

} dwPointCloudICPResultStats;

DW_API_PUBLIC
dwStatus dwPointCloudICP_initialize(dwPointCloudICPHandle_t* obj,
                                    const dwPointCloudICPParams* params,
                                    dwContextHandle_t ctx);
DW_API_PUBLIC
dwStatus dwPointCloudICP_reset(dwPointCloudICPHandle_t obj);

DW_API_PUBLIC
dwStatus dwPointCloudICP_release(dwPointCloudICPHandle_t obj);

DW_API_PUBLIC
dwStatus dwPointCloudICP_getDefaultParams(dwPointCloudICPParams* params);

DW_API_PUBLIC
dwStatus dwPointCloudICP_getCUDAStream(cudaStream_t* stream,
                                       dwPointCloudICPHandle_t obj);

DW_API_PUBLIC
dwStatus dwPointCloudICP_setCUDAStream(const cudaStream_t stream,
                                       dwPointCloudICPHandle_t obj);

DW_API_PUBLIC
dwStatus dwPointCloudICP_bindInput(const dwPointCloud* sourcePCD,
                                   const dwPointCloud* targetPCD,
                                   const dwTransformation3f* sourceToTarget,
                                   dwPointCloudICPHandle_t obj);

DW_API_PUBLIC
dwStatus dwPointCloudICP_bindOutput(dwTransformation3f* pose,
                                    dwPointCloudICPHandle_t obj);

DW_API_PUBLIC
dwStatus dwPointCloudICP_process(dwPointCloudICPHandle_t obj);

DW_API_PUBLIC
dwStatus dwPointCloudICP_setConvergenceCriteriaCallback(dwPointCloudICPConvergenceCheck callback, void* userData, dwPointCloudICPHandle_t obj);

DW_API_PUBLIC
dwStatus dwPointCloudICP_setConvergenceTolerance(float32_t angleTol, float32_t distanceTol, dwPointCloudICPHandle_t obj);

DW_API_PUBLIC
dwStatus dwPointCloudICP_setMaxIterations(uint16_t maxIterations, dwPointCloudICPHandle_t obj);

DW_API_PUBLIC
dwStatus dwPointCloudICP_getLastResultStats(dwPointCloudICPResultStats* resultStats, dwPointCloudICPHandle_t obj);

DW_API_PUBLIC
dwStatus dwPointCloudICP_getMaximumDepthMapSize(uint32_t* maxDepthMapSize);

#ifdef __cplusplus
}
#endif

#endif // DW_POINTCLOUDPROCESSING_POINTCLOUDICP_H_