suzanne.soy/FreeCAD_assembly3
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

assembly: imporove initial placement of constraint multiply

Browse Source
This commit is contained in:
Zheng, Lei 2018-10-11 06:33:15 +08:00
parent 59b9b41628
commit 60638074b9
1 changed files with 36 additions and 19 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

45
assembly.py
View File

@ -1622,6 +1622,8 @@ class AsmConstraint(AsmGroup):
distances = [10]*count distances = [10]*count
distMap = [] distMap = []
finished = 0 finished = 0
refPla = None
for i,info0 in enumerate(infos0): for i,info0 in enumerate(infos0):
pos0 = info0.Placement.multVec( pos0 = info0.Placement.multVec(
utils.getElementPos(info0.Shape)-offset) utils.getElementPos(info0.Shape)-offset)
@ -1630,7 +1632,13 @@ class AsmConstraint(AsmGroup):
if used[i]<0 and not order[j] and \ if used[i]<0 and not order[j] and \
pos0.distanceToPoint(poses[j]) < 1e-7: pos0.distanceToPoint(poses[j]) < 1e-7:
distances[i] = 0 distances[i] = 0
elements[i]._refPla = (info0.Placement,poses[j]) if not elements[i]._refPla:
pla = infos[j].Placement.multiply(
utils.getElementPlacement(infos[j].Shape))
pla = pla.inverse().multiply(info.Placement)
elements[i]._refPla = pla
if not refPla:
refPla = pla
used[i] = j used[i] = j
order[j] = info0 order[j] = info0
finished += 1 finished += 1
@ -1640,8 +1648,14 @@ class AsmConstraint(AsmGroup):
continue continue
d = pos0.distanceToPoint(pos) d = pos0.distanceToPoint(pos)
if used[i]<0 and d < 1e-7: if used[i]<0 and d < 1e-7:
elements[i]._refPla = (info0.Placement,poses[j])
distances[i] = 0 distances[i] = 0
if not elements[i]._refPla:
pla = infos[j].Placement.multiply(
utils.getElementPlacement(infos[j].Shape))
pla = pla.inverse().multiply(info.Placement)
elements[i]._refPla = pla
if not refPla:
refPla = pla
used[i] = j used[i] = j
order[j] = info0 order[j] = info0
finished += 1 finished += 1
@ -1676,24 +1690,27 @@ class AsmConstraint(AsmGroup):
continue continue
j = used[i] j = used[i]
info = infos[j] info = infos[j]
ref = elements[i]._refPla
if ref: # check if the instance is too far off the pairing element
# if we have some already aligned instances, use it as reference
pla = ref[0].copy()
pla.Base += poses[j] - ref[1]
else:
# if not, then simply coincide those elements.
# TODO: we haven't count the potential angle offset yet
p0 = utils.getElementPlacement(info0.Shape) p0 = utils.getElementPlacement(info0.Shape)
p0.Base += offset p0.Base -= offset
pla0 = info0.Placement.multiply(p0) pla0 = info0.Placement.multiply(p0)
pla = info.Placement.multiply( pla = info.Placement.multiply(
utils.getElementPlacement(info.Shape)) utils.getElementPlacement(info.Shape))
if distances[i]>5 or \ if distances[i]<=5 and \
abs(utils.getElementsAngle(pla.Rotation,pla0.Rotation))>45: abs(utils.getElementsAngle(pla.Rotation,pla0.Rotation))<45:
# if not too far off, just show it and let solver align it
showPart(partGroup,info0.Part)
continue
ref = elements[i]._refPla
if not ref:
ref = refPla
if ref:
pla = pla.multiply(ref)
else:
pla = info0.Placement.multiply(pla.multiply(pla0.inverse())) pla = info0.Placement.multiply(pla.multiply(pla0.inverse()))
showPart(partGroup,info0.Part) showPart(partGroup,info0.Part)
info0.Placement.Rotation = pla.Rotation info0.Placement.Rotation = pla.Rotation
info0.Placement.Base = pla.Base info0.Placement.Base = pla.Base
setPlacement(info0.Part,pla,True) setPlacement(info0.Part,pla,True)