1
1
#include < gtest/gtest.h>
2
- #include < planning_ros_msgs /VoxelMap.h>
2
+ #include < kr_planning_msgs /VoxelMap.h>
3
3
#include < iostream>
4
4
#include < cmath>
5
5
#include " mpl_collision/map_util.h"
@@ -53,7 +53,7 @@ TEST(MapUtilTest, TestIsOutside) {
53
53
54
54
// Create a base map for the MapUtil object with val_free as the default value
55
55
std::vector<signed char > base_map (dim (0 ) * dim (1 ) * dim (2 ),
56
- planning_ros_msgs ::VoxelMap::val_free);
56
+ kr_planning_msgs ::VoxelMap::val_free);
57
57
58
58
// Initialize the MapUtil object with the previously created map
59
59
test_map.setMap (origin, dim, base_map, resolution);
@@ -101,7 +101,7 @@ TEST(MapUtilTest, TestIsFree) {
101
101
102
102
// Create a base map for the MapUtil object with val_free as the default value
103
103
std::vector<signed char > base_map (dim (0 ) * dim (1 ) * dim (2 ),
104
- planning_ros_msgs ::VoxelMap::val_free);
104
+ kr_planning_msgs ::VoxelMap::val_free);
105
105
106
106
vec_Vec3i non_free_voxels;
107
107
non_free_voxels.push_back (Vec3i (176 , 91 , 6 ));
@@ -111,7 +111,7 @@ TEST(MapUtilTest, TestIsFree) {
111
111
non_free_voxels.push_back (Vec3i (123 , 158 , 16 ));
112
112
for (auto &vox : non_free_voxels) {
113
113
int idx = vox (0 ) + dim (0 ) * vox (1 ) + dim (0 ) * dim (1 ) * vox (2 );
114
- base_map[idx] = planning_ros_msgs ::VoxelMap::val_occ;
114
+ base_map[idx] = kr_planning_msgs ::VoxelMap::val_occ;
115
115
}
116
116
117
117
// Initialize the MapUtil object with the previously created map
@@ -166,7 +166,7 @@ TEST(MapUtilTest, TestIsOccupied) {
166
166
167
167
// Create a base map for the MapUtil object with val_occ as the default value
168
168
std::vector<signed char > base_map (dim (0 ) * dim (1 ) * dim (2 ),
169
- planning_ros_msgs ::VoxelMap::val_occ);
169
+ kr_planning_msgs ::VoxelMap::val_occ);
170
170
171
171
vec_Vec3i non_occ_voxels;
172
172
non_occ_voxels.push_back (Vec3i (176 , 91 , 6 ));
@@ -176,7 +176,7 @@ TEST(MapUtilTest, TestIsOccupied) {
176
176
non_occ_voxels.push_back (Vec3i (123 , 158 , 16 ));
177
177
for (auto &vox : non_occ_voxels) {
178
178
int idx = vox (0 ) + dim (0 ) * vox (1 ) + dim (0 ) * dim (1 ) * vox (2 );
179
- base_map[idx] = planning_ros_msgs ::VoxelMap::val_free;
179
+ base_map[idx] = kr_planning_msgs ::VoxelMap::val_free;
180
180
}
181
181
182
182
// Initialize the MapUtil object with the previously created map
@@ -232,7 +232,7 @@ TEST(MapUtilTest, TestIsUnknown) {
232
232
// Create a base map for the MapUtil object with val_unknown as the
233
233
// default value
234
234
std::vector<signed char > base_map (dim (0 ) * dim (1 ) * dim (2 ),
235
- planning_ros_msgs ::VoxelMap::val_unknown);
235
+ kr_planning_msgs ::VoxelMap::val_unknown);
236
236
237
237
vec_Vec3i non_unknown_voxels;
238
238
non_unknown_voxels.push_back (Vec3i (176 , 91 , 6 ));
@@ -242,7 +242,7 @@ TEST(MapUtilTest, TestIsUnknown) {
242
242
non_unknown_voxels.push_back (Vec3i (123 , 158 , 16 ));
243
243
for (auto &vox : non_unknown_voxels) {
244
244
int idx = vox (0 ) + dim (0 ) * vox (1 ) + dim (0 ) * dim (1 ) * vox (2 );
245
- base_map[idx] = planning_ros_msgs ::VoxelMap::val_occ;
245
+ base_map[idx] = kr_planning_msgs ::VoxelMap::val_occ;
246
246
}
247
247
248
248
// Initialize the MapUtil object with the previously created map
@@ -379,7 +379,7 @@ TEST(MapUtilTest, TestGetCloud) {
379
379
380
380
// Create a base map for the MapUtil object with val_free as the default value
381
381
std::vector<signed char > base_map (dim (0 ) * dim (1 ) * dim (2 ),
382
- planning_ros_msgs ::VoxelMap::val_free);
382
+ kr_planning_msgs ::VoxelMap::val_free);
383
383
384
384
vec_Vec3i occ_voxels;
385
385
vec_Vec3f occ_cloud;
@@ -399,7 +399,7 @@ TEST(MapUtilTest, TestGetCloud) {
399
399
occ_cloud.push_back (Vec3f (26.75 , -31.25 , -2.75 ));
400
400
for (auto &vox : occ_voxels) {
401
401
int idx = vox (0 ) + dim (0 ) * vox (1 ) + dim (0 ) * dim (1 ) * vox (2 );
402
- base_map[idx] = planning_ros_msgs ::VoxelMap::val_occ;
402
+ base_map[idx] = kr_planning_msgs ::VoxelMap::val_occ;
403
403
}
404
404
405
405
// Initialize the MapUtil object with the previously created map
@@ -434,7 +434,7 @@ TEST(MapUtilTest, TestGetFreeCloud) {
434
434
435
435
// Create a base map for the MapUtil object with val_occ as the default value
436
436
std::vector<signed char > base_map (dim (0 ) * dim (1 ) * dim (2 ),
437
- planning_ros_msgs ::VoxelMap::val_occ);
437
+ kr_planning_msgs ::VoxelMap::val_occ);
438
438
439
439
vec_Vec3i free_voxels;
440
440
vec_Vec3f free_cloud;
@@ -454,7 +454,7 @@ TEST(MapUtilTest, TestGetFreeCloud) {
454
454
free_cloud.push_back (Vec3f (26.75 , -31.25 , -2.75 ));
455
455
for (auto &vox : free_voxels) {
456
456
int idx = vox (0 ) + dim (0 ) * vox (1 ) + dim (0 ) * dim (1 ) * vox (2 );
457
- base_map[idx] = planning_ros_msgs ::VoxelMap::val_free;
457
+ base_map[idx] = kr_planning_msgs ::VoxelMap::val_free;
458
458
}
459
459
460
460
// Initialize the MapUtil object with the previously created map
@@ -489,7 +489,7 @@ TEST(MapUtilTest, TestGetUnkwownCloud) {
489
489
490
490
// Create a base map for the MapUtil object with val_free as the default value
491
491
std::vector<signed char > base_map (dim (0 ) * dim (1 ) * dim (2 ),
492
- planning_ros_msgs ::VoxelMap::val_free);
492
+ kr_planning_msgs ::VoxelMap::val_free);
493
493
494
494
vec_Vec3i unknown_voxels;
495
495
vec_Vec3f unknown_cloud;
@@ -509,7 +509,7 @@ TEST(MapUtilTest, TestGetUnkwownCloud) {
509
509
unknown_cloud.push_back (Vec3f (26.75 , -31.25 , -2.75 ));
510
510
for (auto &vox : unknown_voxels) {
511
511
int idx = vox (0 ) + dim (0 ) * vox (1 ) + dim (0 ) * dim (1 ) * vox (2 );
512
- base_map[idx] = planning_ros_msgs ::VoxelMap::val_unknown;
512
+ base_map[idx] = kr_planning_msgs ::VoxelMap::val_unknown;
513
513
}
514
514
515
515
// Initialize the MapUtil object with the previously created map
0 commit comments