X-Git-Url: http://git.mutantstargoat.com/user/nuclear/?p=bootcensus;a=blobdiff_plain;f=src%2Fcensus%2Flogo.c;fp=src%2Fcensus%2Flogo.c;h=c10454b91c955276b80e421bdc5033b9ded92a15;hp=0000000000000000000000000000000000000000;hb=f9194c22d8073b69b3e64fc26b9e245b6b54d009;hpb=78e3e75fc7b5838d0261c876d00e1b8c3e0bcfe0

diff --git a/src/census/logo.c b/src/census/logo.c
new file mode 100644
index 0000000..c10454b
--- /dev/null
+++ b/src/census/logo.c
@@ -0,0 +1,72 @@
+#include <math.h>
+#include "cgmath/cgmath.h"
+#include "logo.h"
+#include "logodata.h"
+
+struct cpnode {
+	cgm_vec2 p;
+	struct cpnode *next;
+};
+
+#define CPLERP(res, a, b, t) \
+	do { \
+		(res).x = (a).x + ((b).x - (a).x) * (t); \
+		(res).y = (a).y + ((b).y - (a).y) * (t); \
+	} while(0)
+
+static cgm_vec2 *cp;
+static int numcp;
+
+int init_logo(const char *fname)
+{
+	cp = logocp;
+	numcp = LOGO_NUM_CP;
+	return 0;
+}
+
+static void eval_seg(float *res, int a, int b, float t)
+{
+	int prev, next;
+
+	if(numcp == 2) {
+		res[0] = cp[a].x + (cp[b].x - cp[a].x) * t;
+		res[1] = cp[a].y + (cp[b].y - cp[a].y) * t;
+		return;
+	}
+
+	prev = a <= 0 ? a : a - 1;
+	next = b >= numcp - 1 ? b : b + 1;
+
+	res[0] = cgm_bspline(cp[prev].x, cp[a].x, cp[b].x, cp[next].x, t);
+	res[1] = cgm_bspline(cp[prev].y, cp[a].y, cp[b].y, cp[next].y, t);
+}
+
+void eval_logo(float *res, float t)
+{
+	int idx0, idx1;
+	float t0, t1, dt;
+
+	if(!cp || numcp <= 0) {
+		res[0] = res[1] = 0;
+		return;
+	}
+	if(numcp == 1) {
+		res[0] = cp[0].x;
+		res[1] = cp[0].y;
+		return;
+	}
+
+	if(t < 0.0f) t = 0.0f;
+	if(t > 1.0f) t = 1.0f;
+
+	idx0 = (int)(t * (numcp - 1));
+	if(idx0 > numcp - 2) idx0 = numcp - 2;
+	idx1 = idx0 + 1;
+
+	dt = 1.0f / (float)(numcp - 1);
+	t0 = (float)idx0 * dt;
+	t1 = (float)idx1 * dt;
+	t = (t - t0) / (t1 - t0);
+
+	eval_seg(res, idx0, idx1, t);
+}