]> git.cworth.org Git - akamaru/blobdiff - akamaru.c
Add new OffsetSpring force and implement a wobbly patch.
[akamaru] / akamaru.c
index b26adea7b176450d6c82b528b89d4f2382164313..2ee99ad17fe0b4f4e5da6061b10605a6b5cb239a 100644 (file)
--- a/akamaru.c
+++ b/akamaru.c
@@ -27,7 +27,7 @@
 #include <math.h>
 
 const double ground_level = 500;
-const double elasticity = 0.7;
+const double elasticity = 0.8;
 
 typedef struct _xy_pair Point;
 typedef struct _xy_pair Vector;
@@ -38,6 +38,8 @@ struct _xy_pair {
 typedef struct _Object Object;
 typedef struct _Stick Stick;
 typedef struct _String String;
+typedef struct _Spring Spring;
+typedef struct _OffsetSpring OffsetSpring;
 typedef struct _Polygon Polygon;
 typedef struct _Offset Offset;
 typedef struct _Model Model;
@@ -69,6 +71,16 @@ struct _Offset {
   int dx, dy;
 };
 
+struct _Spring {
+  Object *a, *b;
+  int length;
+};
+
+struct _OffsetSpring {
+  Object *a, *b;
+  int dx, dy;
+};
+
 struct _Polygon {
   int num_points;
   Point *points;
@@ -85,6 +97,10 @@ struct _Model {
   String *strings;
   int num_offsets;
   Offset *offsets;
+  int num_springs;
+  Spring *springs;
+  int num_offset_springs;
+  OffsetSpring *offset_springs;
   int num_polygons;
   Polygon *polygons;
   double k;
@@ -161,7 +177,6 @@ model_init_polygons (Model *model)
 
   polygon_init_rectangle (&model->polygons[4], 300, 320, 400, 350);
 
-
   model->num_polygons = num_polygons;
 }
 
@@ -184,6 +199,7 @@ model_init_snake (Model *model)
     model->objects[i].position.y = random() % 200 + 20;
     model->objects[i].previous_position.x = random() % 200 + 20;
     model->objects[i].previous_position.y = random() % 200 + 20;
+    model->objects[i].mass = 1;
 
     if (i + 1 < num_objects) {
       model->sticks[i * 2].a = &model->objects[i];
@@ -220,6 +236,7 @@ model_init_rope (Model *model)
     model->objects[i].position.y = 40 + i * stick_length;
     model->objects[i].previous_position.x = 200;
     model->objects[i].previous_position.y = 40 + i * stick_length;
+    model->objects[i].mass = 1;
 
     if (i + 1 < num_objects) {
       model->sticks[i].a = &model->objects[i];
@@ -266,6 +283,7 @@ model_init_curtain (Model *model)
       model->objects[index].position.y = y;
       model->objects[index].previous_position.x = x;
       model->objects[index].previous_position.y = y;
+      model->objects[i].mass = 1;
 
       if (j + 1 < num_rope_objects) {
        stick_index = i * (num_rope_objects - 1) + j;
@@ -284,13 +302,13 @@ model_init_curtain (Model *model)
 static void
 model_init_grid (Model *model)
 {
-  const int num_ropes = 10;
-  const int num_rope_objects = 10;
+  const int num_ropes = 4;
+  const int num_rope_objects = 4;
   const int num_objects = num_ropes * num_rope_objects;
   const int num_strings = num_ropes * (num_rope_objects - 1) +
     (num_ropes - 1) * num_rope_objects;
-  const int string_length = 10;
-  const int rope_offset = 10;
+  const int string_length = 20;
+  const int rope_offset = 20;
   double x, y;
   int i, j, index, string_index;
 
@@ -317,6 +335,7 @@ model_init_grid (Model *model)
       model->objects[index].position.y = y;
       model->objects[index].previous_position.x = x;
       model->objects[index].previous_position.y = y;
+      model->objects[index].mass = 1;
 
       if (i + 1 < num_ropes) {
        string_index = i * num_rope_objects + j;
@@ -340,6 +359,93 @@ model_init_grid (Model *model)
   model->anchor_object = NULL;
 }
 
+static void
+model_init_molecule (Model *model)
+{
+  const int num_objects = 8;
+  const int num_springs = num_objects * 2;
+  const int spring_length = 50;
+  int i;
+
+  memset (model, 0, sizeof *model);
+  model->objects = g_new (Object, num_objects);
+  model->num_objects = num_objects;
+  model->springs = g_new (Spring, num_springs);
+  model->num_springs = num_springs;
+  model->k = 0.2;
+
+  for (i = 0; i < num_objects; i++) {
+    model->objects[i].position.x = 200 + i * 20;
+    model->objects[i].position.y = 200;
+    model->objects[i].previous_position.x = 200 + i * 20;
+    model->objects[i].previous_position.y = 200;
+    model->objects[i].mass = 0;
+  }
+
+  for (i = 0; i < num_objects; i++) {
+    model->springs[i * 2].a = &model->objects[i];
+    model->springs[i * 2].b = &model->objects[(i + 1) % num_objects];
+    model->springs[i * 2].length = spring_length;
+    model->springs[i * 2 + 1].a = &model->objects[i];
+    model->springs[i * 2 + 1].b = &model->objects[(i + 2) % num_objects];
+    model->springs[i * 2 + 1].length = spring_length;
+  }
+}
+
+
+static void
+model_init_wobbly (Model *model)
+{
+  const int width = 6, height = 6;
+  const int num_objects = width * height;
+  const int num_offset_springs = (width - 1) * height + width * (height - 1);
+  const int distance = 30;
+  double x, y;
+  int i, j, object_index, spring_index;
+
+  memset (model, 0, sizeof *model);
+  model->objects = g_new (Object, num_objects);
+  model->num_objects = num_objects;
+  model->offset_springs = g_new (OffsetSpring, num_offset_springs);
+  model->num_offset_springs = num_offset_springs;
+  model->k = 0.6;
+
+  model_init_polygons (model);
+
+  object_index = 0;
+  spring_index = 0;
+  for (i = 0; i < width; i++) {
+    for (j = 0; j < height; j++) {
+      x = 200 + i * distance;
+      y = 40 + j * distance;
+      model->objects[object_index].position.x = x;
+      model->objects[object_index].position.y = y;
+      model->objects[object_index].previous_position.x = x;
+      model->objects[object_index].previous_position.y = y;
+      model->objects[object_index].mass = 0.3;
+
+      if (i + 1 < width) {
+       model->offset_springs[spring_index].a = &model->objects[object_index];
+       model->offset_springs[spring_index].b = &model->objects[object_index + height];
+       model->offset_springs[spring_index].dx = distance;
+       model->offset_springs[spring_index].dy = 0;
+       spring_index++;
+      }
+      
+      if (j + 1 < height) {
+       model->offset_springs[spring_index].a = &model->objects[object_index];
+       model->offset_springs[spring_index].b = &model->objects[object_index + 1];
+       model->offset_springs[spring_index].dx = 0;
+       model->offset_springs[spring_index].dy = distance;
+       spring_index++;
+      }
+
+      object_index++;
+    }
+  }
+}
+
+
 static void
 model_fini (Model *model)
 {
@@ -354,10 +460,48 @@ static void
 model_accumulate_forces (Model *model)
 {
   int i;
+  double x, y, dx, dy, distance, displacement;
+  Point middle;
+  Vector u;
 
   for (i = 0; i < model->num_objects; i++) {
     model->objects[i].force.x = 0;
-    model->objects[i].force.y = 3;
+    model->objects[i].force.y = 3 * model->objects[i].mass;
+  }
+
+  for (i = 0; i < model->num_springs; i++) {
+    x = model->springs[i].a->position.x;
+    y = model->springs[i].a->position.y;
+    dx = model->springs[i].b->position.x - x;
+    dy = model->springs[i].b->position.y - y;
+    distance = sqrt (dx * dx + dy * dy);
+    u.x = dx / distance;
+    u.y = dy / distance;
+    displacement = distance - model->springs[i].length;
+    model->springs[i].a->force.x += u.x * model->k * displacement;
+    model->springs[i].a->force.y += u.y * model->k * displacement;
+    model->springs[i].b->force.x -= u.x * model->k * displacement;
+    model->springs[i].b->force.y -= u.y * model->k * displacement;
+  }
+
+  for (i = 0; i < model->num_offset_springs; i++) {
+    middle.x = 
+      (model->offset_springs[i].a->position.x + 
+       model->offset_springs[i].b->position.x) / 2;
+    middle.y = 
+      (model->offset_springs[i].a->position.y + 
+       model->offset_springs[i].b->position.y) / 2;
+
+    x = middle.x - model->offset_springs[i].dx / 2;
+    y = middle.y - model->offset_springs[i].dy / 2;
+
+    dx = x - model->offset_springs[i].a->position.x;
+    dy = y - model->offset_springs[i].a->position.y;
+
+    model->offset_springs[i].a->force.x += dx * model->k;
+    model->offset_springs[i].a->force.y += dy * model->k;
+    model->offset_springs[i].b->force.x -= dx * model->k;
+    model->offset_springs[i].b->force.y -= dy * model->k;
   }
 }
 
@@ -548,7 +692,7 @@ model_step (Model *model, double delta_t)
   model_accumulate_forces (model);
   model_integrate (model, delta_t);
 
-  for (i = 0; i < 500; i++)
+  for (i = 0; i < 50; i++)
     model_constrain (model);
 
   model->theta += delta_t;
@@ -662,6 +806,56 @@ draw_offsets (cairo_t *cr,
 
 }
 
+static void
+draw_springs (cairo_t *cr,
+             Model   *model,
+             Color   *color)
+{
+  int i;
+
+  cairo_set_source_rgba (cr, color->red, color->green, color->blue, 0.4);
+  cairo_new_path (cr);
+  cairo_set_line_width (cr, 2);
+  cairo_set_line_join (cr, CAIRO_LINE_JOIN_ROUND);
+  cairo_set_line_cap (cr, CAIRO_LINE_CAP_ROUND);
+
+  for (i = 0; i < model->num_springs; i++) {
+    cairo_move_to (cr,
+                  model->springs[i].a->position.x,
+                  model->springs[i].a->position.y);
+    cairo_line_to (cr,
+                  model->springs[i].b->position.x,
+                  model->springs[i].b->position.y);
+  }
+
+  cairo_stroke (cr);
+}
+
+static void
+draw_offset_springs (cairo_t *cr,
+                    Model   *model,
+                    Color   *color)
+{
+  int i;
+
+  cairo_set_source_rgba (cr, color->red, color->green, color->blue, 0.4);
+  cairo_new_path (cr);
+  cairo_set_line_width (cr, 2);
+  cairo_set_line_join (cr, CAIRO_LINE_JOIN_ROUND);
+  cairo_set_line_cap (cr, CAIRO_LINE_CAP_ROUND);
+
+  for (i = 0; i < model->num_offset_springs; i++) {
+    cairo_move_to (cr,
+                  model->offset_springs[i].a->position.x,
+                  model->offset_springs[i].a->position.y);
+    cairo_line_to (cr,
+                  model->offset_springs[i].b->position.x,
+                  model->offset_springs[i].b->position.y);
+  }
+
+  cairo_stroke (cr);
+}
+
 static void
 draw_polygons (cairo_t *cr, Model *model, Color *color)
 {
@@ -686,7 +880,12 @@ draw_objects (cairo_t *cr, Model *model, Color *color)
 {
   int i;
 
+  cairo_set_source_rgba (cr, color->red, color->green, color->blue, 0.4);
   for (i = 0; i < model->num_objects; i++) {
+    cairo_arc (cr, model->objects[i].position.x,
+              model->objects[i].position.y,
+              3, 0, 2*M_PI);
+    cairo_fill (cr);
   }
 }
 
@@ -694,7 +893,6 @@ static Color blue = { 0, 0, 1 };
 static Color green = { 0, 1, 0 };
 static Color red = { 1, 0, 0 };
 static Color black = { 0, 0, 0 };
-static Color white = { 1, 1, 1 };
 
 typedef struct _Closure Closure;
 struct _Closure {
@@ -719,8 +917,10 @@ draw_model (GtkWidget *widget, Model *model)
   draw_polygons (cr, model, &blue);
   draw_sticks (cr, model, &black);
   draw_strings (cr, model, &green);
+  draw_springs (cr, model, &black);
   draw_offsets (cr, model, &blue);
-  draw_objects (cr, model, &white);
+  draw_offset_springs (cr, model, &blue);
+  draw_objects (cr, model, &red);
 
   cairo_destroy (cr);
 }
@@ -818,7 +1018,9 @@ create_model_store (void)
     { "Rope", model_init_rope },
     { "Snake", model_init_snake },
     { "Curtain", model_init_curtain },
-    { "Grid", model_init_grid }
+    { "Grid", model_init_grid },
+    { "Molecule", model_init_molecule },
+    { "Wobbly", model_init_wobbly }
   };
 
   GtkTreeIter iter;
@@ -994,7 +1196,7 @@ main (int argc, char *argv[])
   closure.model = &model;
   closure.frame_count = 0;
   gettimeofday (&closure.start, NULL);
-  g_timeout_add (100, timeout_callback, &closure);
+  g_timeout_add (40, timeout_callback, &closure);
   gtk_main ();
 
   return 0;