Point Cloud Library (PCL)  1.14.1-dev
device.h
1 /*
2  * Software License Agreement (BSD License)
3  *
4  * Point Cloud Library (PCL) - www.pointclouds.org
5  * Copyright (c) 2010-2012, Willow Garage, Inc.
6  *
7  * All rights reserved.
8  *
9  * Redistribution and use in source and binary forms, with or without
10  * modification, are permitted provided that the following conditions
11  * are met:
12  *
13  * * Redistributions of source code must retain the above copyright
14  * notice, this list of conditions and the following disclaimer.
15  * * Redistributions in binary form must reproduce the above
16  * copyright notice, this list of conditions and the following
17  * disclaimer in the documentation and/or other materials provided
18  * with the distribution.
19  * * Neither the name of Willow Garage, Inc. nor the names of its
20  * contributors may be used to endorse or promote products derived
21  * from this software without specific prior written permission.
22  *
23  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
24  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
25  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
26  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
27  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
28  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
29  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
30  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
31  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
32  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
33  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
34  * POSSIBILITY OF SUCH DAMAGE.
35  *
36  * $Id: $
37  * @authors: Anatoly Baksheev
38  *
39  */
40 
41 #pragma once
42 
43 #include <cuda_runtime.h>
44 
45 namespace pcl
46 {
47  namespace device
48  {
49  template<typename Point>
50  __device__ __forceinline__ float sqnorm(const Point& p1, const Point& p2)
51  {
52  float dx = (p1.x - p2.x);
53  float dy = (p1.y - p2.y);
54  float dz = (p1.z - p2.z);
55  return dx * dx + dy * dy + dz * dz;
56  }
57 
58  __device__ __forceinline__ float3 computePoint(unsigned short depth, int x, int y, const Intr& intr)
59  {
60  float z = depth * 0.001f; // mm -> meters
61  float3 result;
62 
63  result.x = z * (x - intr.cx) / intr.fx;
64  result.y = z * (y - intr.cy) / intr.fy;
65  result.z = z;
66 
67  return result;
68  }
69 
70  __device__ __forceinline__ bool
71  isFinite(const float3& p)
72  {
73  return isfinite(p.x) && isfinite(p.y) && isfinite(p.z);
74  }
75  }
76 }
__device__ __forceinline__ float3 computePoint(unsigned short depth, int x, int y, const Intr &intr)
Definition: device.h:58
__device__ __forceinline__ float sqnorm(const Point &p1, const Point &p2)
Definition: device.h:50
__device__ __forceinline__ bool isFinite(const float3 &p)
Definition: device.h:71
Camera intrinsics structure.
Definition: internal.h:69