only add the floor when all the items are above 0 or empty

CommonWealthRobotics · May 29, 2024 · 4553f7a · 4553f7a
1 parent 30cc2d9
commit 4553f7a
Showing 1 changed file with 9 additions and 1 deletion.
diff --git a/src/main/java/com/neuronrobotics/bowlerstudio/physics/MuJoCoPhysicsManager.java b/src/main/java/com/neuronrobotics/bowlerstudio/physics/MuJoCoPhysicsManager.java
@@ -382,8 +382,16 @@ public void initializeModel(String name) {
 		contacts = builder.addContact();
 		if (fixedObjects == null) {
 			fixedObjects = new ArrayList<>();
-			fixedObjects.add(floor);
 		}
+		boolean hasFloor=false;
+		for(CSG item:fixedObjects) {
+			if(item.getMaxZ()>0)
+				continue;
+			hasFloor=true;
+		}
+		if(hasFloor)
+			fixedObjects.add(floor);
+
 
 	}