def ddd_problem(): problem = GeometricProblem(dimension=2) problem.add_point('v1', vector([random.random() for i in [1,2]])) problem.add_point('v2', vector([random.random() for i in [1,2]])) problem.add_point('v3', vector([random.random() for i in [1,2]])) problem.add_constraint(DistanceConstraint('v1','v2',distance_2p(problem.get_point('v1'), problem.get_point('v2')))) problem.add_constraint(DistanceConstraint('v1','v3',distance_2p(problem.get_point('v1'), problem.get_point('v3')))) problem.add_constraint(DistanceConstraint('v2','v3',distance_2p(problem.get_point('v2'), problem.get_point('v3')))) return problem
def solve_shape(self, layers): for layer in layers: print("Solving shape ", layer.id) pt0 = layer.named_pairs[0][0] pt1 = layer.named_pairs[1][0] pt2 = layer.named_pairs[2][0] for i, point in enumerate(layer.named_pairs): # Add initial points self.problem.add_variable(point[0], vector([point[1], point[2], 0])) # Lock them together if i > 0: self.problem.add_constraint( DistanceConstraint( pt0, point[0], distance_2p(self.problem.get_point(pt0), self.problem.get_point(point[0])))) if i > 1: self.problem.add_constraint( AngleConstraint( pt0, pt1, point[0], angle_3p(self.problem.get_point(pt0), self.problem.get_point(pt1), self.problem.get_point(point[0])))) if i > 2: self.problem.add_constraint( AngleConstraint( pt0, pt2, point[0], angle_3p(self.problem.get_point(pt0), self.problem.get_point(pt2), self.problem.get_point(point[0]))))
def add_random_constraint(problem, ratio): """add a random constraint to a problem, with a given ratio angles/distances""" if random.random() < ratio: # add angle pointvars = list(problem.cg.variables()) random.shuffle(pointvars) v1 = pointvars[0] v2 = pointvars[1] v3 = pointvars[2] p1 = problem.get_point(v1) p2 = problem.get_point(v2) p3 = problem.get_point(v3) angle = angle_3p(p1, p2, p3) con = AngleConstraint(v1, v2, v3, angle) diag_print("**Add constraint:" + str(con), "drplan") problem.add_constraint(con) else: # add distance pointvars = list(problem.cg.variables()) random.shuffle(pointvars) v1 = pointvars[0] v2 = pointvars[1] p1 = problem.get_point(v1) p2 = problem.get_point(v2) dist = distance_2p(p1, p2) con = DistanceConstraint(v1, v2, dist) diag_print("**Add constraint:" + str(con), "drplan") problem.add_constraint(con) return
def satisfied(self, mapping): """return True iff mapping from variable names to points satisfies constraint""" a = mapping[self._variables[0]] b = mapping[self._variables[1]] result = tol_eq(distance_2p(a, b), self._value) return result
def propagation_problem(): problem = GeometricProblem(dimension=2) problem.add_point('v1', vector([random.random() for i in [1, 2]])) problem.add_point('v2', vector([random.random() for i in [1, 2]])) problem.add_point('v3', vector([random.random() for i in [1, 2]])) problem.add_point('v4', vector([random.random() for i in [1, 2]])) problem.add_point('v5', vector([random.random() for i in [1, 2]])) problem.add_constraint( DistanceConstraint( 'v1', 'v2', distance_2p(problem.get_point('v1'), problem.get_point('v2')))) problem.add_constraint( DistanceConstraint( 'v1', 'v3', distance_2p(problem.get_point('v1'), problem.get_point('v3')))) problem.add_constraint( DistanceConstraint( 'v2', 'v3', distance_2p(problem.get_point('v2'), problem.get_point('v3')))) problem.add_constraint( DistanceConstraint( 'v2', 'v4', distance_2p(problem.get_point('v2'), problem.get_point('v4')))) problem.add_constraint( DistanceConstraint( 'v1', 'v5', distance_2p(problem.get_point('v1'), problem.get_point('v5')))) problem.add_constraint( AngleConstraint( 'v3', 'v1', 'v4', angle_3p(problem.get_point('v3'), problem.get_point('v1'), problem.get_point('v4')))) problem.add_constraint( AngleConstraint( 'v3', 'v2', 'v5', angle_3p(problem.get_point('v3'), problem.get_point('v2'), problem.get_point('v5')))) return problem
def random_distance_problem_3D(npoints, radius, roundoff): """creates a 3D problem with random distances""" problem = GeometricProblem(dimension=3) for i in range(npoints): # add point newvar = 'v' + str(i) newpoint = vector([ _round(random.uniform(-radius, radius), roundoff), _round(random.uniform(-radius, radius), roundoff), _round(random.uniform(-radius, radius), roundoff) ]) sellist = list(problem.cg.variables()) problem.add_point(newvar, newpoint) # add distance constraints for j in range(min(3, len(sellist))): index = random.randint(0, len(sellist) - 1) var = sellist.pop(index) point = problem.get_point(var) dist = distance_2p(point, newpoint) problem.add_constraint(DistanceConstraint(var, newvar, dist)) return problem
def _constraint_group(problem, group, dependend, angleratio): """Add constraints to problem to constrain given group of points. Group may be optionally dependend on pair of points. Creates angle constraints with a given chance.""" diag_print( "_constraint_group(group=" + str(group.keys()) + ",dep=" + str(dependend) + ")", "geometric._constraint_group") if len(group) == 2: if dependend == None: v1 = group.keys()[0] v2 = group.keys()[1] p1 = group[v1] p2 = group[v2] dist = distance_2p(p1, p2) con = DistanceConstraint(v1, v2, dist) diag_print("**Add constraint:" + str(con), "geometric._constraint_group") problem.add_constraint(con) elif len(group) >= 3: # pick three points keys = group.keys() if dependend == None: v1 = random.choice(keys) else: v1 = dependend[0] keys.remove(v1) if dependend == None: v2 = random.choice(keys) else: v2 = dependend[1] keys.remove(v2) v3 = random.choice(keys) keys.remove(v3) # create three groups g = [{}, {}, {}] g[0][v1] = group[v1] g[0][v2] = group[v2] g[1][v1] = group[v1] g[1][v3] = group[v3] g[2][v2] = group[v2] g[2][v3] = group[v3] # distribute remaining points over groups while (len(keys) > 0): k = keys.pop() if dependend == None: i = random.randint(0, 2) else: i = random.randint(1, 2) g[i][k] = group[k] # compute facts from prototype p1 = group[v1] p2 = group[v2] p3 = group[v3] # group 0: if independend, add at least one independent group if dependend == None: _constraint_group(problem, g[0], None, angleratio) # group 1: random: angle constraint or independend group if random.random() > angleratio: _constraint_group(problem, g[1], None, angleratio) else: angle = angle_3p(p1, p2, p3) con = AngleConstraint(v1, v2, v3, angle) diag_print("**Add constraint:" + str(con), "geometric._constraint_group") problem.add_constraint(con) _constraint_group(problem, g[1], [v1, v3], angleratio) # group 2: random: angle constraint, two configuratins, or independend group if random.random() > angleratio: _constraint_group(problem, g[2], None, angleratio) elif random.random() < 0.5: angle = angle_3p(p2, p1, p3) con = AngleConstraint(v2, v1, v3, angle) diag_print("**Add constraint:" + str(con), "geometric._constraint_group") problem.add_constraint(con) _constraint_group(problem, g[2], [v2, v3], angleratio) else: angle = angle_3p(p2, p3, p1) con = AngleConstraint(v2, v3, v1, angle) diag_print("**Add constraint:" + str(con), "geometric._constraint_group") problem.add_constraint(con) _constraint_group(problem, g[2], [v2, v3], angleratio)