Path: first experiments with collision detect

src/Mod/Path/PathScripts/PathUtils.py

@@ -726,3 +726,44 @@ class depth_params:
             return depths.tolist()
         else:
             return [stop] + depths.tolist()
+
+class CollisionTester:
+
+    def compareBBSpace(self, bb1, bb2):
+        if ( bb1.XMin == bb2.XMin  and
+            bb1.XMax == bb2.XMax  and
+            bb1.YMin == bb2.YMin  and
+            bb1.YMax == bb2.YMax  and 
+            bb1.ZMin == bb2.ZMin  and
+            bb1.ZMax == bb2.ZMax ) :
+            return True
+        return False
+
+    def getCollisionSim(self, baseobject, cutterPath):
+
+        baseColor = (0.800000011920929, 0.800000011920929, 0.800000011920929, 00.0)
+        intersecColor = (1.0, 0.0, 0.0, 0.0)
+        cVol = baseobject.common(cutterPath)
+
+        if cVol.Volume > 1e-12:
+            colorassignment = []
+            gougedShape = baseobject.cut(cutterPath)
+            # gougeSim = FreeCAD.ActiveDocument.addObject("Part::Feature","Gouge")
+            # gougeSim.Shape = gougedShape
+
+            for idx, i in enumerate(gougedShape.Faces):
+                match = False
+                for jdx, j in enumerate(cVol.Faces):
+                    if self.compareBBSpace(i.BoundBox, j.BoundBox):
+                        match = True
+                if match is True:
+                    #print ("Need to highlight Face{}".format(idx+1))
+                    colorassignment.append(intersecColor)
+                else:
+                    colorassignment.append(baseColor)
+            collisionSim = FreeCAD.ActiveDocument.addObject("Part::Feature","Collision")
+            collisionSim.Shape = gougedShape
+            collisionSim.ViewObject.DiffuseColor=colorassignment
+            return collisionSim
+        else:
+            return None