geo 0.1.2

data/ext/point.c

@@ -0,0 +1,265 @@
+
+#include "common.h"
+
+VALUE rb_point;
+
+const Point ORIGO = { 0.0, 0.0, 0 };
+
+Point*
+new_point(gdouble x, gdouble y) {
+  Point *rval = ALLOC(Point);
+  rval->x = x;
+  rval->y = y;
+  rval->rbPoint = 0;
+  return rval;
+}
+
+
+VALUE
+rb_point_alloc(VALUE class) {
+  Point *p = ALLOC(Point);
+  return RB_POINT(p, class);
+}
+
+VALUE
+rb_point_initialize(VALUE self, VALUE x, VALUE y) {
+  Point *p;
+  CHECK_NUMERICALITY(x);
+  CHECK_NUMERICALITY(y);
+  POINT(self, p);
+  p->x = NUM2DBL(x);
+  p->y = NUM2DBL(y);
+  return self;
+}
+
+VALUE
+rb_point_set_x(VALUE self, VALUE new_x) {
+  Point *p;
+  CHECK_NUMERICALITY(new_x);
+  POINT(self, p);
+  p->x = NUM2DBL(new_x);
+  return new_x;
+}
+
+VALUE
+rb_point_set_y(VALUE self, VALUE new_y) {
+  Point *p;
+  CHECK_NUMERICALITY(new_y);
+  POINT(self, p);
+  p->y = NUM2DBL(new_y);
+  return new_y;
+}
+
+VALUE
+rb_point_x(VALUE self) {
+  Point *p;
+  POINT(self, p);
+  return rb_float_new(p->x);
+}
+
+VALUE
+rb_point_y(VALUE self) {
+  Point *p;
+  POINT(self, p);
+  return rb_float_new(p->y);
+}
+
+VALUE
+rb_point_inspect(VALUE self) {
+  gchar rval[1024];
+  Point *p;
+  POINT(self, p);
+  snprintf(rval, 1023, "<%s:%p x=%f y=%f>", rb_obj_classname(self), p, p->x, p->y);
+  return rb_str_new2(rval);
+}
+
+
+VALUE
+rb_point_dot(VALUE self, VALUE o) {
+  Point *me;
+  Point *point;
+  CHECK_POINT(o);
+  POINT(self, me);
+  POINT(o, point);
+  return rb_float_new(POINT_DOT(me, point));
+}
+
+VALUE
+rb_point_abs(VALUE self) {
+  Point *me;
+  POINT(self, me);
+  return rb_float_new(DISTANCE(&ORIGO, me));
+}
+
+VALUE
+rb_point_equals(VALUE self, VALUE o) {
+  if (!POINT_P(o)) {
+    return Qfalse;
+  } else {
+    Point *me;
+    Point *other;
+    POINT(self, me);
+    POINT(o, other);
+    if (POINT_EQUALS(me, other)) {
+      return Qtrue;
+    } else {
+      return Qfalse;
+    }
+  }
+}
+
+gint
+point_cmp(Point *me, Point *other) {
+  gdouble my_length;
+  gdouble other_length;
+  my_length = LENGTH(me->x, me->y);
+  other_length = LENGTH(other->x, other->y);
+  if (my_length != other_length)
+    return CMP(my_length, other_length);
+  else if (me->x != other->x)
+    return CMP(me->x, other->x);
+  else
+    return CMP(me->y, other->y);
+}
+
+VALUE
+rb_point_cmp(VALUE self, VALUE o) {
+  if (!POINT_P(o)) {
+    return INT2NUM(CMP(CLASS(self), CLASS(o)));
+  } else {
+    Point *me;
+    Point *other;
+    POINT(self, me);
+    POINT(o, other);
+    return INT2NUM(point_cmp(me, other));
+  }
+}
+
+VALUE
+rb_point_set_angle(VALUE self, VALUE new_angle) {
+  Point *me;
+  gdouble length;
+  gdouble angle;
+  CHECK_NUMERICALITY(new_angle);
+  POINT(self, me);
+  angle = NUM2DBL(new_angle);
+  length = LENGTH(me->x, me->y);
+  while (angle > M_PI * 2)
+    angle -= M_PI * 2;
+  me->x = length * cos(angle);
+  me->y = length * sin(angle);
+  return rb_float_new(angle);
+}
+
+VALUE
+rb_point_angle(VALUE self) {
+  Point *me;
+  POINT(self, me);
+  ZERO_LENGTH_CHECK(me);
+  return rb_float_new(ANGLE(me->x, me->y));
+}
+
+VALUE
+rb_point_set_abs(VALUE self, VALUE new_abs) {
+  Point *me;
+  gdouble ratio;
+  CHECK_NUMERICALITY(new_abs);
+  POINT(self, me);
+  ZERO_LENGTH_CHECK(me);
+  ratio = NUM2DBL(new_abs) / LENGTH(me->x, me->y);
+  me->x = me->x * ratio;
+  me->y = me->y * ratio;
+  return new_abs;
+}
+
+VALUE
+rb_point_clone(VALUE self) {
+  Point *me;
+  Point *rval;
+  POINT(self, me);
+  rval = new_point(me->x, me->y);
+  return RB_POINT(rval, CLASS(self));
+}
+
+VALUE
+rb_point_to(int argc, VALUE *argv, VALUE self) {
+  Point *me;
+  Point *other_end;
+  Line *rval;
+  if (argc == 1) {
+    CHECK_POINT(argv[0]);
+    POINT(self, me);
+    POINT(argv[0], other_end);
+    rval = new_line_with_points(me, other_end);
+    return RB_LINE(rval, rb_line);
+  } else if (argc == 2) {
+    CHECK_NUMERICALITY(argv[0]);
+    CHECK_NUMERICALITY(argv[1]);
+    POINT(self, me);
+    other_end = new_point(NUM2DBL(argv[0]), NUM2DBL(argv[1]));
+    RB_POINT(other_end, CLASS(self));
+    rval = new_line_with_points(me, other_end);
+    return RB_LINE(rval, rb_line);
+  } else {
+    rb_raise(rb_eTypeError, "Arguments to %s#to has to be either a Grueserve::Map::Point or 2 numbers.", rb_obj_classname(self));
+  }
+}
+
+VALUE
+rb_point_on(VALUE self, VALUE l) {
+  Point *me;
+  Line *line;
+  gint side;
+  CHECK_LINE(l);
+  POINT(self,me);
+  LINE(l, line);
+  side = line_side(line, me);
+  if (side == 0) {
+    return Qtrue;
+  } else {
+    return Qfalse;
+  }
+}
+
+VALUE
+rb_point_in(VALUE self, VALUE t) {
+  Point *me;
+  Triangle *triangle;
+  CHECK_TRIANGLE(t);
+  POINT(self, me);
+  TRIANGLE(t, triangle);
+  if (triangle_contains(triangle, me)) {
+    return Qtrue;
+  } else {
+    return Qfalse;
+  }
+}
+
+VALUE
+rb_point_plus(VALUE self, VALUE p) {
+  Point *me;
+  Point *other;
+  Point *rval;
+  CHECK_POINT(p);
+  POINT(self, me);
+  POINT(p, other);
+  rval = ALLOC(Point);
+  rval->x = me->x + other->x;
+  rval->y = me->y + other->y;
+  return RB_POINT(rval, CLASS(self));
+}
+
+VALUE
+rb_point_minus(VALUE self, VALUE p) {
+  Point *me;
+  Point *other;
+  Point *rval;
+  CHECK_POINT(p);
+  POINT(self, me);
+  POINT(p, other);
+  rval = ALLOC(Point);
+  rval->x = me->x - other->x;
+  rval->y = me->y - other->y;
+  return RB_POINT(rval, CLASS(self));
+}
+

data/ext/point.h

@@ -0,0 +1,123 @@
+
+#ifndef POINT_H
+#define POINT_H
+
+#include "common.h"
+
+extern VALUE rb_point;
+
+#define RB_POINT(point_pointer,klass) ((point_pointer)->rbPoint = Data_Wrap_Struct(klass, NULL, free, (point_pointer)))
+#define POINT(rb_point,point_pointer) Data_Get_Struct((rb_point), Point, (point_pointer))
+
+#define M_PI           3.14159265358979323846  /* pi */
+#define M_PI_2         1.57079632679489661923  /* pi/2 */
+#define M_PI_4         0.78539816339744830962  /* pi/4 */
+#define LENGTH(dx,dy) (sqrt(pow((dx),2) + pow((dy),2)))
+#define DISTANCE(p1,p2) (LENGTH((p1)->x - (p2)->x, (p1)->y - (p2)->y))
+#define ANGLE(dx,dy) ((dy) > 0 ?					\
+		      ((dx) > 0 ?					\
+		       acos((dx) / LENGTH((dx),(dy)))			\
+		       :						\
+		       ((dx) < 0 ?					\
+			acos((dx) / LENGTH((dx),(dy)))			\
+			:						\
+			M_PI_2))					\
+		      :							\
+		      ((dy) < 0 ?					\
+		       ((dx) > 0 ?					\
+			(2 * M_PI - acos((dx) / LENGTH((dx),(dy))))	\
+			:						\
+			((dx) < 0 ?					\
+			 (2 * M_PI - acos((dx) / LENGTH((dx),(dy))))	\
+			 :						\
+			 M_PI_2 + M_PI))				\
+		       :						\
+		       ((dx) > 0 ?					\
+			0.0						\
+			:						\
+			M_PI)))
+
+#define POINT_EQUALS(p1,p2) (DBL_EQL((p1)->x, (p2)->x) && DBL_EQL((p1)->y, (p2)->y))
+#define POINT_DOT(p1,p2) ((p1)->x * (p2)->x + (p1)->y * (p2)->y)
+#define POINT_P(p) (!NIL_P((p)) && rb_is_a((p), rb_point))
+#define CHECK_POINT(p) if (!POINT_P((p))) rb_raise(rb_eTypeError, "Expected Grueserve::Map::Point!")
+#define ZERO_LENGTH_P(p) ((p)->x == 0 && (p)->y == 0)
+#define ZERO_LENGTH_CHECK(p) if (ZERO_LENGTH_P((p))) rb_raise(rb_eTypeError, "Expected something with length > 0!")
+#define ZERO_DISTANCE_P(p1,p2) ((p1)->x == (p2)->x && ((p1)->y == (p2)->y))
+#define ZERO_DISTANCE_CHECK(p1,p2) if (ZERO_DISTANCE_P((p1),(p2))) rb_raise(rb_eTypeError, "Expected something with distance > 0!")
+
+extern const Point ORIGO;
+
+
+Point*
+new_point(gdouble x, gdouble y);
+
+VALUE
+rb_point_alloc(VALUE class);
+
+VALUE
+rb_point_initialize(VALUE self, VALUE x, VALUE y);
+
+VALUE
+rb_point_set_x(VALUE self, VALUE new_x);
+
+VALUE
+rb_point_set_y(VALUE self, VALUE new_y);
+
+VALUE
+rb_point_x(VALUE self);
+
+VALUE
+rb_point_y(VALUE self);
+
+VALUE
+rb_point_inspect(VALUE self);
+
+VALUE
+rb_point_dot(VALUE self, VALUE o);
+
+VALUE
+rb_point_abs(VALUE self);
+
+VALUE
+rb_point_equals(VALUE self, VALUE o);
+
+VALUE
+rb_point_cmp(VALUE self, VALUE o);
+
+VALUE
+rb_point_set_angle(VALUE self, VALUE new_angle);
+
+VALUE
+rb_point_angle(VALUE self);
+
+VALUE
+rb_point_set_abs(VALUE self, VALUE new_abs);
+
+VALUE
+rb_point_clone(VALUE self);
+
+VALUE
+rb_point_to(int argc, VALUE *argv, VALUE self);
+
+VALUE
+rb_point_on(VALUE self, VALUE l);
+
+VALUE
+rb_point_in(VALUE self, VALUE t);
+
+VALUE
+rb_point_plus(VALUE self, VALUE p);
+
+VALUE
+rb_point_minus(VALUE self, VALUE p);
+
+gint
+point_cmp(Point *me, Point *other);
+
+
+
+
+
+#endif
+

data/ext/point_set.c

@@ -0,0 +1,93 @@
+
+#include "common.h"
+
+VALUE rb_point_set;
+
+
+static void
+g_hash_table_mark_point(gpointer key, gpointer value, gpointer user_data) {
+  rb_gc_mark( ( (Point *) key )->rbPoint);
+}
+
+void
+point_set_mark(GeoSet *set) {
+  g_hash_table_foreach(set->table, g_hash_table_mark_point, NULL);
+}
+
+
+VALUE
+rb_point_set_alloc(VALUE class) {
+  GeoSet *set = new_geo_set();
+  return RB_POINT_SET(set, class);
+}
+
+VALUE
+rb_point_set_insert(VALUE self, VALUE p) {
+  Point *point;
+  GeoSet *me;
+  CHECK_POINT(p);
+  GEO_SET(self, me);
+  POINT(p, point);
+  geo_set_insert(me, (gpointer ) point);
+  return self;
+}
+
+VALUE
+rb_point_set_include(VALUE self, VALUE point) {
+  GeoSet *me;
+  Point *t;
+  CHECK_POINT(point);
+  POINT(point, t);
+  GEO_SET(self, me);
+  return GBOOL2RB(g_hash_table_lookup_extended(me->table, (gpointer) t, NULL, NULL));
+}
+
+VALUE
+rb_point_set_delete(VALUE self, VALUE point) {
+  GeoSet *me;
+  Point *t;
+  CHECK_POINT(point);
+  GEO_SET(self, me);
+  POINT(point, t);
+  return geo_set_delete(me, (gpointer) t, point);
+}
+
+static void
+g_hash_table_yield_point(gpointer key, gpointer value, gpointer user_data) {
+  rb_yield(( (Point *) key )->rbPoint);
+}
+
+VALUE
+rb_point_set_each(VALUE self) {
+  GeoSet *set;
+  GEO_SET(self, set);
+  geo_set_foreach(set, g_hash_table_yield_point);
+  return self;
+}
+
+VALUE
+rb_point_set_clone(VALUE self) {
+  GeoSet *me;
+  GEO_SET(self, me);
+  return RB_POINT_SET(geo_set_clone(me), CLASS(self));
+}
+
+gpointer
+geo_set_each_structure_having_common_segment_id_with_point_until(GeoSet *set, 
+								 Point *point, 
+								 geo_set_structure_handler handler, 
+								 gpointer user_data) {
+  GHashTable *seen_structures = g_hash_table_new(g_direct_hash, g_direct_equal);
+  gpointer args[3] = { seen_structures, handler, user_data };
+  GHashTable *seen_segment_ids = g_hash_table_new(g_direct_hash, g_direct_equal);
+  gpointer rval = NULL;
+  rval = geo_set_each_segment_id_for_point_until(set, 
+						 point, 
+						 seen_segment_ids, 
+						 geo_set_each_structure_in_segment_id_until, 
+						 args);
+  g_hash_table_destroy(seen_segment_ids);
+  g_hash_table_destroy(seen_structures);
+  return rval;
+}
+

data/ext/point_set.h

@@ -0,0 +1,44 @@
+
+#ifndef POINT_SET_H
+#define POINT_SET_H
+
+#include "common.h"
+
+extern VALUE rb_point_set;
+
+#define RB_POINT_SET(point_set_pointer,klass) Data_Wrap_Struct(klass, point_set_mark, geo_set_free, (point_set_pointer))
+
+#define POINT_SET_P(pl) (!NIL_P((pl)) && rb_is_a((pl), rb_point_set))
+#define CHECK_POINT_SET(pl) if (!POINT_SET_P((pl))) rb_raise(rb_eTypeError, "Expected Grueserve::Map::PointSet!")
+
+void
+point_set_mark(GeoSet *set);
+
+VALUE
+rb_point_set_alloc(VALUE class);
+
+VALUE
+rb_point_set_insert(VALUE self, VALUE p);
+
+VALUE
+rb_point_set_include(VALUE self, VALUE point);
+
+VALUE
+rb_point_set_delete(VALUE self, VALUE point);
+
+VALUE
+rb_point_set_each(VALUE self);
+
+VALUE
+rb_point_set_clone(VALUE self);
+
+gpointer
+geo_set_each_structure_having_common_segment_id_with_point_until(GeoSet *set, 
+								 Point *point, 
+								 geo_set_structure_handler handler, 
+								 gpointer user_data);
+
+
+
+
+#endif