3 #include "cgmath/cgmath.h"
9 static struct mobject *mobj_create(int num);
10 static void swstate(struct mobject *mobj, int st);
11 static void update(struct mobject *mobj, float tsec);
12 static float eval(struct mobject *mobj, cgm_vec3 *pos);
14 static void upd_sflake_ball(struct mobject *mobj, struct mball *ball, float tsec, float t);
15 static int calc_num_balls(int depth);
16 static int gen_sflake(cgm_vec4 *sarr, int num, int depth, float x, float y, float z, float rad);
18 static void upd_sgi_caps(struct mobject *mobj, struct mcapsule *caps, float tsec, float t);
20 static float capsule_distsq(struct mcapsule *c, cgm_vec3 *pos);
21 static float easein(float x);
22 static float easeout(float x);
25 static struct mobject *mobj_create(int num)
30 mobj = calloc_nf(1, sizeof *mobj);
32 mobj->idlepos = malloc_nf(num * sizeof *mobj->idlepos);
33 mobj->mot = malloc_nf(num * sizeof *mobj->mot);
35 for(i=0; i<num; i++) {
36 mobj->mot[i].x = 2.0f * ((float)rand() / (float)RAND_MAX) - 1.0f;
37 mobj->mot[i].y = 2.0f * ((float)rand() / (float)RAND_MAX) - 1.0f;
38 mobj->mot[i].z = 2.0f * ((float)rand() / (float)RAND_MAX) - 1.0f;
42 mobj->swstate = swstate;
43 mobj->update = update;
47 swstate(mobj, MOBJ_IDLE);
51 static void swstate(struct mobject *mobj, int st)
53 if(st == mobj->state) return;
54 if(st == MOBJ_GRABING && mobj->state != MOBJ_IDLE) return;
55 if(st == MOBJ_DROPPING && mobj->state != MOBJ_HELD && mobj->state != MOBJ_GRABING) {
61 if(mobj->state != MOBJ_IDLE) return;
65 if(mobj->state != MOBJ_HELD && mobj->state != MOBJ_GRABING) {
71 mobj->pos.x = mobj->pos.z = 0.0f;
72 mobj->pos.y = -BBOX_YSZ * 0.5f;
77 mobj->tstart = (float)time_msec / 1000.0f;
80 static void update(struct mobject *mobj, float tsec)
84 struct mcapsule *caps;
89 count = mobj->num_balls + mobj->num_caps;
91 if(mobj->state != MOBJ_IDLE) {
92 cgm_midentity(mobj->xform);
93 cgm_mrotate_x(mobj->xform, tsec);
94 cgm_mrotate_y(mobj->xform, tsec);
95 cgm_mtranslate(mobj->xform, mobj->pos.x, mobj->pos.y, mobj->pos.z);
97 if(mobj->state != MOBJ_HELD) {
98 for(i=0; i<count; i++) {
99 mobj->idlepos[i].x = sin(tsec * mobj->mot[i].x + mobj->mot[i].y) * mobj->mot[i].z * 4.0f;
100 mobj->idlepos[i].z = cos(tsec * mobj->mot[i].z + mobj->mot[i].y) * mobj->mot[i].x * 4.0f;
101 mobj->idlepos[i].y = -BBOX_YSZ * 0.45f;
105 idleptr = mobj->idlepos;
110 switch(mobj->state) {
113 for(i=0; i<mobj->num_balls; i++) {
114 ball->pos = idleptr[i];
115 ball->energy = motptr[i].w;
118 idleptr += mobj->num_balls;
119 motptr += mobj->num_balls;
122 for(i=0; i<mobj->num_caps; i++) {
123 caps->end[0] = caps->end[1] = idleptr[i];
124 caps->energy = motptr[i].w;
131 t = easeout((tsec - mobj->tstart) / TRANSDUR);
132 if(t >= 1.0f) mobj->swstate(mobj, MOBJ_HELD);
135 t = easein((tsec - mobj->tstart) / TRANSDUR);
136 if(t >= 1.0f) mobj->swstate(mobj, MOBJ_IDLE);
138 for(i=0; i<mobj->num_balls; i++) {
139 mobj->upd_ball(mobj, ball++, tsec, t);
141 for(i=0; i<mobj->num_caps; i++) {
142 mobj->upd_caps(mobj, caps++, tsec, t);
147 for(i=0; i<mobj->num_balls; i++) {
148 mobj->upd_ball(mobj, ball++, tsec, 0);
150 for(i=0; i<mobj->num_caps; i++) {
151 mobj->upd_caps(mobj, caps++, tsec, 0);
157 static float eval(struct mobject *mobj, cgm_vec3 *pos)
160 float dsq, energy = 0.0f;
161 struct mball *ball = mobj->balls;
162 struct mcapsule *caps = mobj->caps;
164 for(i=0; i<mobj->num_balls; i++) {
165 dsq = cgm_vdist_sq(&ball->pos, pos);
166 energy += ball->energy / dsq;
170 for(i=0; i<mobj->num_caps; i++) {
171 dsq = capsule_distsq(mobj->caps + i, pos);
172 energy += caps->energy / dsq;
178 /* ---- sphereflake ---- */
179 #define SF_MAX_DEPTH 2
180 static cgm_vec4 *sfsph;
182 struct mobject *metaobj_sflake(void)
185 struct mobject *mobj;
187 num_balls = calc_num_balls(SF_MAX_DEPTH);
189 mobj = mobj_create(num_balls);
191 mobj->num_balls = num_balls;
192 mobj->balls = malloc_nf(num_balls * sizeof *mobj->balls);
193 sfsph = malloc_nf(num_balls * sizeof *sfsph);
195 gen_sflake(sfsph, 0, SF_MAX_DEPTH, 0, 0, 0, 20);
197 mobj->upd_ball = upd_sflake_ball;
201 static void upd_sflake_ball(struct mobject *mobj, struct mball *ball, float tsec, float t)
203 int idx = ball - mobj->balls;
206 switch(mobj->state) {
210 cgm_vcons(&pos, sfsph[idx].x, sfsph[idx].y, sfsph[idx].z);
211 cgm_vmul_m4v3(&pos, mobj->xform);
212 cgm_vlerp(&ball->pos, mobj->idlepos + idx, &pos, t);
213 ball->energy = cgm_lerp(mobj->mot[idx].w, sfsph[idx].w, t);
217 cgm_vcons(&ball->pos, sfsph[idx].x, sfsph[idx].y, sfsph[idx].z);
218 cgm_vmul_m4v3(&ball->pos, mobj->xform);
219 ball->energy = sfsph[idx].w;
224 static int calc_num_balls(int depth)
227 return calc_num_balls(depth - 1) * 6 + 1;
230 static int gen_sflake(cgm_vec4 *sarr, int num, int depth, float x, float y, float z, float rad)
247 subnum += gen_sflake(sarr, num + subnum, depth - 1, x + offs, y, z, subrad);
248 subnum += gen_sflake(sarr, num + subnum, depth - 1, x - offs, y, z, subrad);
249 subnum += gen_sflake(sarr, num + subnum, depth - 1, x, y + offs, z, subrad);
250 subnum += gen_sflake(sarr, num + subnum, depth - 1, x, y - offs, z, subrad);
251 subnum += gen_sflake(sarr, num + subnum, depth - 1, x, y, z + offs, subrad);
252 subnum += gen_sflake(sarr, num + subnum, depth - 1, x, y, z - offs, subrad);
256 /* ---- SGI logo ---- */
258 static const cgm_vec3 sgiv[] = {
259 {2.794170, 4.254175, 2.738066},
260 {2.794170, 4.254174, -4.358471},
261 {-2.173414, 4.254174, -4.358471},
262 {-2.173414, -2.842363, -4.358470},
263 {4.923134, -2.842363, -4.358471},
264 {4.923134, 2.125212, -4.358471},
265 {4.923134, 2.125212, 2.738066},
266 {4.923134, -4.971326, 2.738067},
267 {4.923134, -4.971326, -2.229511},
268 {-2.173413, -4.971326, -2.229511},
269 {-2.173413, -4.971325, 4.867042},
270 {2.794170, -4.971325, 4.867042},
271 {2.794170, 2.125213, 4.867042},
272 {-4.302382, 2.125213, 4.867042},
273 {-4.302383, -2.842362, 4.867042},
274 {-4.302382, -2.842363, -2.229511},
275 {-4.302382, 4.254175, -2.229512},
276 {-4.302383, 4.254175, 2.738066}
278 #define NUM_SGI_VERTS (sizeof sgiv / sizeof *sgiv)
279 static float sgimat[16];
281 struct mobject *metaobj_sgi(void)
284 struct mobject *mobj;
286 cgm_midentity(sgimat);
287 cgm_mrotate_y(sgimat, -M_PI / 4.0f);
288 cgm_mrotate_x(sgimat, M_PI / 4.0f);
289 cgm_mtranslate(sgimat, 0, -4, 0);
291 mobj = mobj_create(NUM_SGI_VERTS);
293 mobj->num_caps = NUM_SGI_VERTS;
294 mobj->caps = calloc_nf(mobj->num_caps, sizeof *mobj->caps);
296 for(i=0; i<mobj->num_caps; i++) {
297 mobj->caps[i].energy = 0.7;
300 mobj->swstate = swstate;
301 mobj->upd_caps = upd_sgi_caps;
305 #define LOGOSCALE 0.55f
306 static void upd_sgi_caps(struct mobject *mobj, struct mcapsule *caps, float tsec, float t)
310 static cgm_vec3 prev_pos;
312 idx0 = caps - mobj->caps;
313 idx1 = idx0 >= mobj->num_caps - 1 ? 0 : idx0 + 1;
315 switch(mobj->state) {
321 cgm_vscale(pos, LOGOSCALE);
322 cgm_vmul_m4v3(pos, mobj->xform);
323 cgm_vlerp(caps->end, mobj->idlepos + idx0, pos, t);
325 caps->end[0] = prev_pos;
328 cgm_vscale(pos + 1, LOGOSCALE);
329 cgm_vmul_m4v3(pos + 1, mobj->xform);
330 cgm_vlerp(caps->end + 1, mobj->idlepos + idx1, pos + 1, t);
331 prev_pos = caps->end[1];
332 /*caps->energy = cgm_lerp(mobj->mot[idx].w, sfsph[idx].w, t);*/
338 cgm_vscale(pos, LOGOSCALE);
339 cgm_vmul_m4v3(pos, mobj->xform);
340 caps->end[0] = pos[0];
342 caps->end[0] = prev_pos;
345 cgm_vscale(pos + 1, LOGOSCALE);
346 cgm_vmul_m4v3(pos + 1, mobj->xform);
347 prev_pos = caps->end[1] = pos[1];
350 caps->len = cgm_vdist(caps->end, caps->end + 1);
353 static float capsule_distsq(struct mcapsule *c, cgm_vec3 *pos)
356 cgm_vec3 pp, dir, pdir;
358 dir = c->end[1]; cgm_vsub(&dir, c->end);
360 float s = 1.0f / c->len;
365 pdir = *pos; cgm_vsub(&pdir, c->end);
366 t = cgm_vdot(&dir, &pdir);
369 return cgm_vdist_sq(c->end, pos);
372 return cgm_vdist_sq(c->end + 1, pos);
376 cgm_vadd_scaled(&pp, &dir, t);
377 return cgm_vdist_sq(&pp, pos);
380 static float easein(float x)
385 static float easeout(float x)
387 return 1.0f - pow(1.0f - x, 3.0f);