44 const Point3Vector OsvrHdkLedLocations_SENSOR0 = {
45 cv::Point3f{-84.93f, 2.65f, 23.59f},
46 cv::Point3f{-83.27f, -14.33f, 13.89f},
47 cv::Point3f{-47.00f, 51.00f, 24.09f},
48 cv::Point3f{ 47.00f, 51.00f, 24.09f},
49 cv::Point3f{ 84.93f, 2.65f, 23.59f},
50 cv::Point3f{ 83.27f, -14.33f, 13.89f},
51 cv::Point3f{ 84.10f, 19.76f, 13.89f},
52 cv::Point3f{ 21.00f, 51.00f, 24.09f},
53 cv::Point3f{-21.00f, 51.00f, 24.09f},
54 cv::Point3f{-84.10f, 19.76f, 13.89f},
55 cv::Point3f{-60.41f, 47.55f, 44.60f},
56 cv::Point3f{-80.42f, 20.48f, 42.90f},
57 cv::Point3f{-82.01f, 2.74f, 42.40f},
58 cv::Point3f{-80.42f, -14.99f, 42.90f},
59 cv::Point3f{-60.41f, -10.25f, 48.10f},
60 cv::Point3f{-60.41f, 15.75f, 48.10f},
61 cv::Point3f{-30.41f, 32.75f, 50.50f},
62 cv::Point3f{-31.41f, 47.34f, 47.00f},
63 cv::Point3f{ -0.41f, -15.25f, 51.30f},
64 cv::Point3f{-30.41f, -27.25f, 50.50f},
65 cv::Point3f{-60.44f, -41.65f, 45.10f},
66 cv::Point3f{-22.41f, -41.65f, 47.80f},
67 cv::Point3f{ 21.59f, -41.65f, 47.80f},
68 cv::Point3f{ 59.59f, -41.65f, 45.10f},
69 cv::Point3f{ 79.63f, -14.98f, 42.90f},
70 cv::Point3f{ 29.59f, -27.25f, 50.50f},
71 cv::Point3f{ 81.19f, 2.74f, 42.40f},
72 cv::Point3f{ 79.61f, 20.48f, 42.90f},
73 cv::Point3f{ 59.59f, 47.55f, 44.60f},
74 cv::Point3f{ 30.59f, 47.55f, 47.00f},
75 cv::Point3f{ 29.59f, 32.75f, 50.50f},
76 cv::Point3f{ -0.41f, 20.75f, 51.30f},
77 cv::Point3f{ 59.59f, 15.75f, 48.10f},
78 cv::Point3f{ 59.59f, -10.25f, 48.10f}
84 const Point3Vector OsvrHdkLedLocations_SENSOR1 = {
85 cv::Point3f{ 1.00f, 23.80f, 0.00f},
86 cv::Point3f{ 11.00f, 5.80f, 0.00f},
87 cv::Point3f{ 9.00f, -23.80f, 0.00f},
88 cv::Point3f{ 0.00f, -8.80f, 0.00f},
89 cv::Point3f{ -9.00f, -23.80f, 0.00f},
90 cv::Point3f{-12.00f, 5.80f, 0.00f}
95 const Point3Vector OsvrHdk2LedLocations_SENSOR0 = {
96 cv::Point3f{-86.62f, 0.00f, 24.10f},
97 cv::Point3f{-85.52f, -17.23f, 13.90f},
98 cv::Point3f{-47.00f, 48.23f, 24.10f},
99 cv::Point3f{ 47.00f, 48.23f, 24.10f},
100 cv::Point3f{ 84.82f, 0.00f, 23.60f},
101 cv::Point3f{ 83.24f, -17.23f, 13.90f},
102 cv::Point3f{ 84.12f, 17.11f, 13.90f},
103 cv::Point3f{ 21.00f, 48.23f, 24.15f},
104 cv::Point3f{-21.00f, 48.23f, 24.15f},
105 cv::Point3f{-85.22f, 17.06f, 13.90f},
106 cv::Point3f{-60.04f, 44.91f, 43.74f},
107 cv::Point3f{-80.42f, 20.48f, 42.90f},
108 cv::Point3f{-82.01f, 2.74f, 42.40f},
109 cv::Point3f{-80.42f, -14.99f, 42.90f},
110 cv::Point3f{-60.19f, -14.35f, 47.80f},
111 cv::Point3f{-60.17f, 11.65f, 47.70f},
112 cv::Point3f{-30.09f, 28.65f, 50.04f},
113 cv::Point3f{-31.33f, 44.81f, 46.03f},
114 cv::Point3f{ 0.00f, -19.35f, 50.81f},
115 cv::Point3f{-30.12f, -31.35f, 50.06f},
116 cv::Point3f{-60.08f, -47.00f, 44.32f},
117 cv::Point3f{-22.00f, -47.11f, 46.89f},
118 cv::Point3f{ 22.06f, -47.06f, 47.06f},
119 cv::Point3f{ 60.08f, -47.20f, 44.13f},
120 cv::Point3f{ 79.63f, -14.98f, 42.90f},
121 cv::Point3f{ 30.10f, -31.35f, 50.01f},
122 cv::Point3f{ 81.19f, 2.74f, 42.40f},
123 cv::Point3f{ 79.61f, 20.48f, 42.90f},
124 cv::Point3f{ 60.31f, 45.05f, 43.53f},
125 cv::Point3f{ 31.05f, 44.89f, 45.99f},
126 cv::Point3f{ 30.13f, 28.65f, 50.04f},
127 cv::Point3f{ 0.00f, 16.65f, 50.81f},
128 cv::Point3f{ 60.19f, 11.65f, 47.72f},
129 cv::Point3f{ 60.20f, -14.35f, 47.71f}
131 const Point3Vector OsvrHdk2LedLocations_SENSOR1 = {
132 cv::Point3f{ 1.00f, 23.80f, 0.00f},
133 cv::Point3f{ 11.00f, 5.80f, 0.00f},
134 cv::Point3f{ 9.00f, -23.80f, 0.00f},
135 cv::Point3f{ 0.00f, -8.80f, 0.00f},
136 cv::Point3f{ -9.00f, -23.80f, 0.00f},
137 cv::Point3f{-12.00f, 5.80f, 0.00f}
141 const Vec3Vector OsvrHdkLedDirections_SENSOR0 = {
152 cv::Vec3d{0, 0.7071067812, 0.7071067812},
153 cv::Vec3d{-0.7071067812, 0, 0.7071067812},
154 cv::Vec3d{-0.7071067812, 0, 0.7071067812},
155 cv::Vec3d{-0.7071067812, 0, 0.7071067812},
156 cv::Vec3d{-0.7071067812, 0, 0.7071067812},
159 cv::Vec3d{0, 0.7071067812, 0.7071067812},
162 cv::Vec3d{0, -0.7071067812, 0.7071067812},
163 cv::Vec3d{0, -0.7071067812, 0.7071067812},
164 cv::Vec3d{0, -0.7071067812, 0.7071067812},
165 cv::Vec3d{0, -0.7071067812, 0.7071067812},
166 cv::Vec3d{0.7071067812, 0, 0.7071067812},
168 cv::Vec3d{0.7071067812, 0, 0.7071067812},
169 cv::Vec3d{0.7071067812, 0, 0.7071067812},
170 cv::Vec3d{0, 0.7071067812, 0.7071067812},
171 cv::Vec3d{0, 0.7071067812, 0.7071067812},
177 const Vec3Vector OsvrHdkLedDirections_SENSOR1 = {
178 cv::Vec3d{0, 0, 1}, cv::Vec3d{0, 0, 1}, cv::Vec3d{0, 0, 1},
179 cv::Vec3d{0, 0, 1}, cv::Vec3d{0, 0, 1}, cv::Vec3d{0, 0, 1}};
182 const std::vector<double> OsvrHdkLedVariances_SENSOR0 = {
183 5.0, 5.0, 5.0, 5.0, 5.0, 5.0, 5.0, 5.0, 5.0, 5.0, 3.0, 8.0,
184 8.0, 8.0, 8.0, 3.0, 3.0, 8.0, 3.0, 3.0, 8.0, 8.0, 8.0, 8.0,
185 8.0, 3.0, 8.0, 8.0, 8.0, 8.0, 3.0, 3.0, 3.0, 3.0};
187 static const std::initializer_list<std::size_t> HDK2_Missing_Beacons = {
188 12, 13, 14, 25, 26, 28};
189 std::initializer_list<std::size_t> getOneBasedIDsOfMissingBeaconsHDK2() {
190 return HDK2_Missing_Beacons;