/** \file
 * Generate an OpenSCAD with connectors for each face.
 *
 */
#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <stdarg.h>
#include <unistd.h>
#include <math.h>
#include <err.h>
#include <assert.h>
#include "v3.h"
#include "stl_3d.h"


int
main(void)
{
	stl_3d_t * const stl = stl_3d_parse(STDIN_FILENO);
	if (!stl)
		return EXIT_FAILURE;
	const double thickness = 3;
	const double inset_dist = 2;
	const double hole_dist = 4;
	const double hole_rad = 3.0/2;
	const double hole_height = 40;

	// for each vertex, find the coplanar triangles
	// \todo: do coplanar bits
	const stl_vertex_t ** const vertex_list = calloc(sizeof(**vertex_list), stl->num_vertex);

	for(int i = 0 ; i < stl->num_vertex ; i++)
	{
		const stl_vertex_t * const v = &stl->vertex[i];
		const v3_t origin = v->p;

		printf("// vertex %d\n"
			"translate([%f,%f,%f])\n"
			"render() difference()\n"
			"{\n"
			"sphere(r=15);\n",
			i, origin.p[0], origin.p[1], origin.p[2]);
		
		int * const face_used = calloc(sizeof(*face_used), stl->num_face);

		for (int j = 0 ; j < v->num_face; j++)
		{
			// generate the polygon face for this vertex
			const stl_face_t * const f = v->face[j];
			if (face_used[f - stl->face])
				continue;
			const int start_vertex = v->face_num[j];
			const int vertex_count = stl_trace_face(
				stl,
				f,
				vertex_list,
				face_used,
				start_vertex
			);

			refframe_t ref;
			refframe_init(&ref,
				f->vertex[(start_vertex+0) % 3]->p,
				f->vertex[(start_vertex+1) % 3]->p,
				f->vertex[(start_vertex+2) % 3]->p
			);

			// use the transpose of the rotation matrix,
			// which will rotate from (x,y) to the correct
			// orientation relative to this connector node.
			printf("multmatrix(m=[[%f,%f,%f,0],[%f,%f,%f,0],[%f,%f,%f,0],[0,0,0,1]]) {\n",
				ref.x.p[0],
				ref.y.p[0],
				ref.z.p[0],
				ref.x.p[1],
				ref.y.p[1],
				ref.z.p[1],
				ref.x.p[2],
				ref.y.p[2],
				ref.z.p[2]
			);

			// generate the polygon plane
			printf("translate([0,0,%f]) linear_extrude(height=%f) polygon(points=[\n",
				-thickness/2,
				thickness
			);

			for(int k=0 ; k < vertex_count ; k++)
			{
				double x, y;
				refframe_inset(&ref, inset_dist, &x, &y,
					vertex_list[(k+0) % vertex_count]->p,
					vertex_list[(k+1) % vertex_count]->p,
					vertex_list[(k+2) % vertex_count]->p
				);
				printf("[%f,%f],", x, y);
			}
			printf("\n]);\n");

			// generate the mounting holes
			for(int k=0 ; k < vertex_count ; k++)
			{
				double x, y;
				refframe_inset(&ref, inset_dist+hole_dist, &x, &y,
					vertex_list[(k+0) % vertex_count]->p,
					vertex_list[(k+1) % vertex_count]->p,
					vertex_list[(k+2) % vertex_count]->p
				);
				printf("translate([%f,%f,0]) cylinder(r=%f,h=%f, center=true);\n",
					x, y,
					hole_rad,
					hole_height
				);
			}

			printf("}\n");
		}

		free(face_used);

		printf("}\n");
		//if (i == 2) break; // only do one right now
	}

	return 0;
}