initial version

grid/factory/GridFactory.h

@@ -0,0 +1,55 @@
+#ifndef GRIDFACTORY_H
+#define GRIDFACTORY_H
+
+#include <string>
+#include "../../floorplan/Floor.h"
+#include "../../geo/Units.h"
+#include "../GridNodeBBox.h"
+#include "../Grid.h"
+
+template <int gridSize_cm, typename T> class GridFactory {
+
+private:
+
+	Grid<gridSize_cm, T>& grid;
+
+
+public:
+
+	/** ctor with the grid to fill */
+	GridFactory(Grid<gridSize_cm, T>& grid) : grid(grid) {;}
+
+	/** add the given floor at the provided height (in cm) */
+	void addFloor(const Floor& floor, const float z_cm) {
+
+		for(int x_cm = 0; x_cm < floor.getWidth_cm(); x_cm += gridSize_cm) {
+			for (int y_cm = 0; y_cm < floor.getDepth_cm(); y_cm += gridSize_cm) {
+
+				// check intersection with the floorplan
+				GridNodeBBox bbox(GridPoint(x_cm, y_cm, z_cm), gridSize_cm);
+				if (intersects(bbox, floor)) {continue;}
+
+				// add to the grid
+				grid.add(T(x_cm, y_cm, z_cm));
+
+			}
+		}
+
+		int i = 0;
+
+	}
+
+private:
+
+	/** does the bbox intersect with any of the floor's walls? */
+	bool intersects(const GridNodeBBox& bbox, const Floor& floor) {
+		for (const Line2D l : floor.getObstacles()) {
+			if (bbox.intersects(l)) {return true;}
+		}
+		return false;
+	}
+
+
+};
+
+#endif // GRIDFACTORY_H