Try to make main solve again, fail

1 files changed, 123 insertions, 0 deletions

diff --git a/test/solve.c b/test/solve.c
index ae54597..6213540 100644
--- a/test/solve.c
+++ b/test/solve.c
@@ -1,7 +1,31 @@
 #include "cad/solve.h"
+#include "cad/debug.h"
 #include <assert.h>
+#include <math.h>
 #include <string.h>
 
+static double point_line_distance_abs(struct point p, struct line l) {
+	return fabs((glm_vec2_dot(l.norm, p.pos) + l.C) / glm_vec2_norm(l.norm));
+}
+
+static double point_point_distance(struct point p1, struct point p2) {
+	vec2 between;
+	glm_vec2_sub(p1.pos, p2.pos, between);
+	return glm_vec2_norm(between);
+}
+
+static double line_line_angle_abs(struct line l1, struct line l2) {
+	double dot = glm_vec2_dot(l1.norm, l2.norm);
+	double mag = glm_vec2_norm(l1.norm) * glm_vec2_norm(l2.norm);
+	double c = fabs(dot / mag);
+	c = fmin(1.0, fmax(-1.0, c));
+	return acos(c);
+}
+
+static void assert_near(double actual, double expected) {
+	assert(fabs(actual - expected) < 1e-6);
+}
+
 int main(int argc, char *argv[]) {
 	struct subassembly assemblies[16] = {};
 	size_t assemblies_num;
@@ -69,6 +93,105 @@ int main(int argc, char *argv[]) {
 
 	memset(assemblies, 0, sizeof(assemblies));
 	{
+		printf("Corner by point-on-line root\n");
+		struct constraints constraints = {};
+
+		struct component base = {.type = COM_LINE};
+		struct component side = {.type = COM_LINE};
+		struct component corner = {.type = COM_POINT};
+		struct component tip = {.type = COM_POINT};
+
+		add_constraint(&constraints, (struct constraint[]){
+			POINT_ON_LINE(&corner, &base),
+			POINT_ON_LINE(&corner, &side),
+			LL_ANGLE(&base, &side, DEG(90)),
+			PL_DISTANCE(&tip, &base, 10),
+			PL_DISTANCE(&tip, &side, -20),
+			CEND(),
+		});
+
+		struct drawing drawing = {};
+		bool solved = solve_constraints(&constraints, &drawing, assemblies, &assemblies_num);
+
+		assert(solved);
+		assert(assemblies_num == 1);
+		assert(drawing.root != NULL);
+
+		double *params = malloc(sizeof(double) * constraints.length);
+		for(size_t i = 0; i < constraints.length; i++) {
+			params[i] = constraints.elements[i].v;
+		}
+		place_points(&drawing, params);
+		free(params);
+
+		assert(corner.e != NULL);
+		assert(tip.e != NULL);
+		assert(base.e != NULL);
+		assert(side.e != NULL);
+
+		print_subassemblies(&constraints, assemblies, assemblies_num);
+
+		assert_near(point_line_distance_abs(corner.e->point, base.e->line), 0.0);
+		assert_near(point_line_distance_abs(corner.e->point, side.e->line), 0.0);
+		assert_near(line_line_angle_abs(base.e->line, side.e->line), DEG(90));
+		assert_near(point_line_distance_abs(tip.e->point, base.e->line), 10.0);
+		assert_near(point_line_distance_abs(tip.e->point, side.e->line), 20.0);
+
+		free_drawing(&drawing);
+		free_constraints(&constraints);
+	}
+
+	memset(assemblies, 0, sizeof(assemblies));
+	{
+		printf("Corner by offset point-line root\n");
+		struct constraints constraints = {};
+
+		struct component base = {.type = COM_LINE};
+		struct component side = {.type = COM_LINE};
+		struct component corner = {.type = COM_POINT};
+		struct component tip = {.type = COM_POINT};
+
+		add_constraint(&constraints, (struct constraint[]){
+			PL_DISTANCE(&corner, &base, 5),
+			POINT_ON_LINE(&corner, &side),
+			LL_ANGLE(&base, &side, DEG(90)),
+			PL_DISTANCE(&tip, &base, 10),
+			PL_DISTANCE(&tip, &side, -20),
+			CEND(),
+		});
+
+		struct drawing drawing = {};
+		bool solved = solve_constraints(&constraints, &drawing, assemblies, &assemblies_num);
+
+		assert(solved);
+		assert(assemblies_num == 1);
+		assert(drawing.root != NULL);
+
+		double *params = malloc(sizeof(double) * constraints.length);
+		for(size_t i = 0; i < constraints.length; i++) {
+			params[i] = constraints.elements[i].v;
+		}
+		place_points(&drawing, params);
+		free(params);
+
+		assert(corner.e != NULL);
+		assert(tip.e != NULL);
+		assert(base.e != NULL);
+		assert(side.e != NULL);
+
+		assert_near(point_line_distance_abs(corner.e->point, base.e->line), 5.0);
+		assert_near(point_line_distance_abs(corner.e->point, side.e->line), 0.0);
+		assert_near(line_line_angle_abs(base.e->line, side.e->line), DEG(90));
+		assert_near(point_line_distance_abs(tip.e->point, base.e->line), 10.0);
+		assert_near(point_line_distance_abs(tip.e->point, side.e->line), 20.0);
+		assert_near(point_point_distance(corner.e->point, tip.e->point), sqrt(425.0));
+
+		free_drawing(&drawing);
+		free_constraints(&constraints);
+	}
+
+	memset(assemblies, 0, sizeof(assemblies));
+	{
 		printf("Two triangles sharing a point one defined by angles\n");
 		struct constraints constraints = {};