Hiep update

include/robot_costmap_2d/voxel_grid.h

@@ -0,0 +1,32 @@
+// Header header
+// uint32[] data
+// geometry_msgs/Point32 origin
+// geometry_msgs/Vector3 resolutions
+// uint32 size_x
+// uint32 size_y
+// uint32 size_z
+
+#ifndef VOXEL_GRID_ROBOT_COSTMAP_2D_H
+#define VOXEL_GRID_ROBOT_COSTMAP_2D_H
+
+#include <vector>
+#include <robot_std_msgs/Header.h>
+#include <robot_geometry_msgs/Point32.h>
+#include <robot_geometry_msgs/Vector3.h>
+
+namespace robot_costmap_2d
+{
+    struct VoxelGrid
+    {
+        robot_std_msgs::Header header;
+        std::vector<uint32_t> data;
+        robot_geometry_msgs::Point32 origin;
+        robot_geometry_msgs::Vector3 resolutions;
+        uint32_t size_x;
+        uint32_t size_y;
+        uint32_t size_z;
+    };
+    
+}
+
+#endif // VOXEL_GRID_ROBOT_COSTMAP_2D_H