-//\r
-// VECTOR.H - vector class definition\r
-//\r
-// by James L. Hammons\r
-// (C) 2004 Underground Software\r
-//\r
-// JLH = James L. Hammons <jlhamm@acm.org>\r
-//\r
-// Who When What\r
-// --- ---------- -------------------------------------------------------------\r
-// JLH ??/??/2003 Created original implementation\r
-// JLH 05/14/2004 Separated header from implementation, added operator-\r
-// function\r
-// JLH 05/15/2004 Added operator+ function\r
-//\r
-\r
-#include <math.h>\r
-#include "vector.h"\r
-\r
-vector::vector(double a1/*= 0.0*/, double b1/*= 0.0*/, double c1/*= 0.0*/,\r
- double a2/*= 0.0*/, double b2/*= 0.0*/, double c2/*= 0.0*/):\r
- x(a1 - a2), y(b1 - b2), z(c1 - c2)\r
-{\r
-}\r
-\r
-vector::vector(const vector &v1, const vector &v2):\r
- x(v1.x - v2.x), y(v1.y - v2.y), z(v1.z - v2.z)\r
-{\r
-}\r
-\r
-vector& vector::operator=(const vector &v)\r
-{\r
- x = v.x, y = v.y, z = v.z;\r
- return *this;\r
-}\r
-\r
-bool vector::operator==(const vector &v)\r
-{\r
- if ((x == v.x) && (y == v.y) && (z == v.z))\r
- return true;\r
-\r
- return false;\r
-}\r
-\r
-void vector::unitize(void)\r
-{\r
- double dist = sqrt(x*x + y*y + z*z);\r
-\r
- if (dist != 0.0)\r
- x /= dist, y /= dist, z /= dist;\r
-\r
- if (x == -0.0)\r
- x = +0.0;\r
-\r
- if (y == -0.0)\r
- y = +0.0;\r
-\r
- if (z == -0.0)\r
- z = +0.0;\r
-}\r
-\r
-vector vector::operator*(const vector &v) // Cross product: "this" x "v"\r
-{\r
- vector r;\r
-\r
- r.x = (y * v.z) - (v.y * z);\r
- r.y = -((x * v.z) - (v.x * z));\r
- r.z = (x * v.y) - (v.x * y);\r
-\r
- return r;\r
-}\r
-\r
-vector vector::operator+(const vector &v)\r
-{\r
- return vector(x + v.x, y + v.y, z + v.z);\r
-}\r
-\r
-vector vector::operator-(const vector &v)\r
-{\r
- return vector(x, y, z, v.x, v.y, v.z);\r
-}\r
-\r
-double vector::dot(const vector &v1, const vector &v2)\r
-{\r
- return v1.x * v2.x + v1.y * v2.y + v1.z * v2.z;\r
-}\r
-\r
-double vector::dot(const vector &v)\r
-{\r
- return x * v.x + y * v.y + z * v.z;\r
-}\r
-\r
-double vector::distance(const vector &v) // Pythagoras extended to 3 dimensions\r
-{\r
- double a = x - v.x, b = y - v.y, c = z - v.z;\r
-\r
- return sqrt(a * a + b * b + c * c);\r
-}\r
-\r
-double vector::length(void)\r
-{\r
- return sqrt(x * x + y * y + z * z);\r
-}\r
-\r
-void vector::operator*=(const double &d)\r
-{\r
- x *= d, y *= d, z *= d;\r
-}\r
-\r
-void vector::operator/=(const double &d)\r
-{\r
- if (d != 0.0)\r
- x /= d, y /= d, z /= d;\r
-}\r
-\r
-void vector::operator+=(const vector &v)\r
-{\r
- x += v.x, y += v.y, z += v.z;\r
-}\r
-\r
-void vector::operator-=(const vector &v)\r
-{\r
- x -= v.x, y -= v.y, z -= v.z;\r
-}\r
-\r
-vector vector::operator*(const double &d) // Scale vector by amount\r
-{\r
- return vector(x * d, y * d, z * d);\r
-}\r
-\r
-void vector::zero(const double epsilon)\r
-{\r
- if (fabs(x) < epsilon)\r
- x = 0.0;\r
-\r
- if (fabs(y) < epsilon)\r
- y = 0.0;\r
-\r
- if (fabs(z) < epsilon)\r
- z = 0.0;\r
-}\r
+//
+// VECTOR.H - vector class definition
+//
+// by James L. Hammons
+// (C) 2004 Underground Software
+//
+// JLH = James L. Hammons <jlhamm@acm.org>
+//
+// Who When What
+// --- ---------- -------------------------------------------------------------
+// JLH ??/??/2003 Created original implementation
+// JLH 05/14/2004 Separated header from implementation, added operator-
+// function
+// JLH 05/15/2004 Added operator+ function
+//
+
+#include <math.h>
+#include "vector.h"
+
+vector::vector(double a1/*= 0.0*/, double b1/*= 0.0*/, double c1/*= 0.0*/,
+ double a2/*= 0.0*/, double b2/*= 0.0*/, double c2/*= 0.0*/):
+ x(a1 - a2), y(b1 - b2), z(c1 - c2)
+{
+}
+
+vector::vector(const vector &v1, const vector &v2):
+ x(v1.x - v2.x), y(v1.y - v2.y), z(v1.z - v2.z)
+{
+}
+
+vector& vector::operator=(const vector &v)
+{
+ x = v.x, y = v.y, z = v.z;
+ return *this;
+}
+
+bool vector::operator==(const vector &v)
+{
+ if ((x == v.x) && (y == v.y) && (z == v.z))
+ return true;
+
+ return false;
+}
+
+void vector::unitize(void)
+{
+ double dist = sqrt(x*x + y*y + z*z);
+
+ if (dist != 0.0)
+ x /= dist, y /= dist, z /= dist;
+
+ if (x == -0.0)
+ x = +0.0;
+
+ if (y == -0.0)
+ y = +0.0;
+
+ if (z == -0.0)
+ z = +0.0;
+}
+
+vector vector::operator*(const vector &v) // Cross product: "this" x "v"
+{
+ vector r;
+
+ r.x = (y * v.z) - (v.y * z);
+ r.y = -((x * v.z) - (v.x * z));
+ r.z = (x * v.y) - (v.x * y);
+
+ return r;
+}
+
+vector vector::operator+(const vector &v)
+{
+ return vector(x + v.x, y + v.y, z + v.z);
+}
+
+vector vector::operator-(const vector &v)
+{
+ return vector(x, y, z, v.x, v.y, v.z);
+}
+
+double vector::dot(const vector &v1, const vector &v2)
+{
+ return v1.x * v2.x + v1.y * v2.y + v1.z * v2.z;
+}
+
+double vector::dot(const vector &v)
+{
+ return x * v.x + y * v.y + z * v.z;
+}
+
+double vector::distance(const vector &v) // Pythagoras extended to 3 dimensions
+{
+ double a = x - v.x, b = y - v.y, c = z - v.z;
+
+ return sqrt(a * a + b * b + c * c);
+}
+
+double vector::length(void)
+{
+ return sqrt(x * x + y * y + z * z);
+}
+
+void vector::operator*=(const double &d)
+{
+ x *= d, y *= d, z *= d;
+}
+
+void vector::operator/=(const double &d)
+{
+ if (d != 0.0)
+ x /= d, y /= d, z /= d;
+}
+
+void vector::operator+=(const vector &v)
+{
+ x += v.x, y += v.y, z += v.z;
+}
+
+void vector::operator-=(const vector &v)
+{
+ x -= v.x, y -= v.y, z -= v.z;
+}
+
+vector vector::operator*(const double &d) // Scale vector by amount
+{
+ return vector(x * d, y * d, z * d);
+}
+
+void vector::zero(const double epsilon/*= 1.0e-6*/)
+{
+ if (fabs(x) < epsilon)
+ x = 0.0;
+
+ if (fabs(y) < epsilon)
+ y = 0.0;
+
+ if (fabs(z) < epsilon)
+ z = 0.0;
+}
projects / ttedit / blobdiff