Routines to support line rendering

include/CVector2f.hpp

@@ -255,6 +255,11 @@ public:
         return *this * mag;
     }
 
+    inline CVector2f perpendicularVector() const
+    {
+        return {-y, x};
+    }
+
     inline float cross(const CVector2f& rhs) const
     {
         return (x * rhs.y) - (y * rhs.x);

include/CVector3f.hpp

@@ -91,6 +91,15 @@ public:
         v[3] = 0.0f;
     }
 
+    inline CVector2f toVec2f() const
+    {
+#if __SSE__
+        return CVector2f(mVec128);
+#else
+        return CVector2f(x, y);
+#endif
+    }
+
     inline bool operator ==(const CVector3f& rhs) const
     {return (x == rhs.x && y == rhs.y && z == rhs.z);}
     inline bool operator !=(const CVector3f& rhs) const

src/Math.cpp

@@ -134,7 +134,6 @@ double sqrtD(double val)
     p.v *= (1.5f - (x * p.v * p.v));
     p.v *= (1.5f - (x * p.v * p.v));
     q = p.v;
-#endif
 
     static const double half = 0.5;
     static const double three = 3.0;
@@ -155,6 +154,7 @@ double sqrtD(double val)
     sq = -((val * three) - sq);
     sq = q * sq;
     q = val * sq;
+#endif
     return q;
 }