minor changes to floorplan

fixed some compile issues
worked on nav-meshes
added some tests

math/speed.h

@@ -0,0 +1,63 @@
+#ifndef SPEED_H
+#define SPEED_H
+
+#include <cmath>
+
+class Speed {
+
+public:
+
+#define PI_FLOAT     3.14159265f
+#define PIBY2_FLOAT  1.5707963f
+
+
+	static inline float atan2(float y, float x) {
+
+		//http://pubs.opengroup.org/onlinepubs/009695399/functions/atan2.html
+		//Volkan SALMA
+
+		const float ONEQTR_PI = M_PI / 4.0;
+		const float THRQTR_PI = 3.0 * M_PI / 4.0;
+		float r, angle;
+		float abs_y = fabs(y) + 1e-10f;      // kludge to prevent 0/0 condition
+		if ( x < 0.0f ) {
+			r = (x + abs_y) / (abs_y - x);
+			angle = THRQTR_PI;
+		} else {
+			r = (x - abs_y) / (x + abs_y);
+			angle = ONEQTR_PI;
+		}
+		angle += (0.1963f * r * r - 0.9817f) * r;
+		if ( y < 0.0f )
+			return( -angle );     // negate if in quad III or IV
+		else
+			return( angle );
+
+	}
+
+//	// https://gist.github.com/volkansalma/2972237
+//	static inline float atan2(const float y, const float x) {
+//		if ( x == 0.0f ) {
+//			if ( y > 0.0f ) return PIBY2_FLOAT;
+//			if ( y == 0.0f ) return 0.0f;
+//			return -PIBY2_FLOAT;
+//		}
+//		float atan;
+//		float z = y/x;
+//		if ( fabs( z ) < 1.0f ) {
+//			atan = z/(1.0f + 0.28f*z*z);
+//			if ( x < 0.0f ) {
+//				if ( y < 0.0f ) return atan - PI_FLOAT;
+//				return atan + PI_FLOAT;
+//			}
+//		} else {
+//			atan = PIBY2_FLOAT - z/(z*z + 0.28f);
+//			if ( y < 0.0f ) return atan - PI_FLOAT;
+//		}
+//		return atan;
+//	}
+
+
+};
+
+#endif // SPEED_H