X-Git-Url: https://git.rohieb.name/hackover2013-badge-firmware.git/blobdiff_plain/3c932d305715878e01a77659a30a3e4d967fc244..113fbd0d57be3df9bc6ac56b44d8bd154cc90d38:/badge/util/rectangle.h

diff --git a/badge/util/rectangle.h b/badge/util/rectangle.h
new file mode 100644
index 0000000..8653e6b
--- /dev/null
+++ b/badge/util/rectangle.h
@@ -0,0 +1,52 @@
+#ifndef INCLUDED_RECTANGLE_H
+#define INCLUDED_RECTANGLE_H
+
+#include "fixed_point.h"
+
+typedef struct {
+  fixed_point x;
+  fixed_point y;
+} vec2d;
+
+static inline vec2d vec2d_add(vec2d v1, vec2d v2) {
+  vec2d r = {
+    fixed_point_add(v1.x, v2.x),
+    fixed_point_add(v1.y, v2.y)
+  };
+
+  return r;
+}
+
+typedef struct {
+  vec2d pos;
+  vec2d extent;
+} rectangle;
+
+static inline fixed_point rectangle_top   (rectangle const *r) { return r->pos.y; }
+static inline fixed_point rectangle_left  (rectangle const *r) { return r->pos.x; }
+static inline fixed_point rectangle_bottom(rectangle const *r) { return fixed_point_add(rectangle_top (r), r->extent.y); }
+static inline fixed_point rectangle_right (rectangle const *r) { return fixed_point_add(rectangle_left(r), r->extent.x); }
+
+static inline fixed_point rectangle_width (rectangle const *r) { return r->extent.x; }
+static inline fixed_point rectangle_height(rectangle const *r) { return r->extent.y; }
+
+static inline vec2d rectangle_mid(rectangle const *r) {
+  vec2d v = { fixed_point_add(r->pos.x, fixed_point_div(r->extent.x, FIXED_POINT(2, 0))),
+	      fixed_point_add(r->pos.y, fixed_point_div(r->extent.y, FIXED_POINT(2, 0)))
+  };
+  return v;
+}
+
+static inline void rectangle_move_to  (rectangle *r, vec2d new_pos) { r->pos = new_pos; }
+static inline void rectangle_move_to_x(rectangle *r, fixed_point    new_x  ) { r->pos.x = new_x; }
+static inline void rectangle_move_to_y(rectangle *r, fixed_point    new_y  ) { r->pos.x = new_y; }
+
+static inline bool rectangle_intersect(rectangle const *r1,
+				       rectangle const *r2) {
+  return (fixed_point_lt(rectangle_top   (r1), rectangle_bottom(r2)) &&
+	  fixed_point_gt(rectangle_bottom(r1), rectangle_top   (r2)) &&
+	  fixed_point_lt(rectangle_left  (r1), rectangle_right (r2)) &&
+	  fixed_point_gt(rectangle_right (r1), rectangle_left  (r2)));
+}
+
+#endif