[2798] | 1 | /* -*- mode: c++; c-basic-offset: 4; indent-tabs-mode: nil -*- */ |
---|
[911] | 2 | /* |
---|
| 3 | * ---------------------------------------------------------------------- |
---|
| 4 | * Vector3.h : Vector class with 3 components |
---|
| 5 | * |
---|
| 6 | * ====================================================================== |
---|
| 7 | * AUTHOR: Wei Qiao <qiaow@purdue.edu> |
---|
| 8 | * Purdue Rendering and Perceptualization Lab (PURPL) |
---|
| 9 | * |
---|
[3177] | 10 | * Copyright (c) 2004-2012 HUBzero Foundation, LLC |
---|
[911] | 11 | * |
---|
| 12 | * See the file "license.terms" for information on usage and |
---|
| 13 | * redistribution of this file, and for a DISCLAIMER OF ALL WARRANTIES. |
---|
| 14 | * ====================================================================== |
---|
| 15 | */ |
---|
[2827] | 16 | #ifndef VECTOR3_H |
---|
| 17 | #define VECTOR3_H |
---|
[911] | 18 | |
---|
[2827] | 19 | #include <math.h> |
---|
| 20 | |
---|
| 21 | #include <vector> |
---|
| 22 | |
---|
[1028] | 23 | #include "Mat4x4.h" |
---|
[911] | 24 | |
---|
[2822] | 25 | class Vector3 |
---|
| 26 | { |
---|
[911] | 27 | public: |
---|
[2822] | 28 | Vector3() |
---|
| 29 | {} |
---|
| 30 | |
---|
| 31 | Vector3(float x_val, float y_val, float z_val) |
---|
| 32 | { |
---|
| 33 | set(x_val, y_val, z_val); |
---|
[1028] | 34 | } |
---|
[2822] | 35 | |
---|
| 36 | void set(float x_val, float y_val, float z_val) |
---|
| 37 | { |
---|
| 38 | x = x_val, y = y_val, z = z_val; |
---|
[1028] | 39 | } |
---|
[2822] | 40 | |
---|
| 41 | void print() const |
---|
| 42 | { |
---|
| 43 | TRACE("(x:%f, y:%f, z:%f)\n", x, y, z); |
---|
[1028] | 44 | } |
---|
[2822] | 45 | |
---|
[3362] | 46 | bool operator==(const Vector3& op2) const |
---|
| 47 | { |
---|
| 48 | return (x == op2.x && y == op2.y && z == op2.z); |
---|
| 49 | } |
---|
| 50 | |
---|
[2877] | 51 | Vector3 operator -() const |
---|
| 52 | { |
---|
| 53 | return Vector3(-x, -y, -z); |
---|
| 54 | } |
---|
| 55 | |
---|
[2822] | 56 | Vector3 operator +(float scalar) const |
---|
| 57 | { |
---|
| 58 | return Vector3(x + scalar, y + scalar, z + scalar); |
---|
[1028] | 59 | } |
---|
[2822] | 60 | |
---|
| 61 | Vector3 operator -(float scalar) const |
---|
| 62 | { |
---|
| 63 | return Vector3(x - scalar, y - scalar, z - scalar); |
---|
[1028] | 64 | } |
---|
[2822] | 65 | |
---|
| 66 | Vector3 operator *(float scalar) const |
---|
| 67 | { |
---|
| 68 | return Vector3(x * scalar, y * scalar, z * scalar); |
---|
[1028] | 69 | } |
---|
[2822] | 70 | |
---|
| 71 | Vector3 operator /(float scalar) const |
---|
| 72 | { |
---|
| 73 | return Vector3(x / scalar, y / scalar, z / scalar); |
---|
[1028] | 74 | } |
---|
[2822] | 75 | |
---|
| 76 | Vector3 operator +(const Vector3& op2) const |
---|
| 77 | { |
---|
| 78 | return Vector3(x + op2.x, y + op2.y, z + op2.z); |
---|
[1028] | 79 | } |
---|
[2822] | 80 | |
---|
| 81 | Vector3 operator -(const Vector3& op2) const |
---|
| 82 | { |
---|
| 83 | return Vector3(x - op2.x, y - op2.y, z - op2.z); |
---|
[1028] | 84 | } |
---|
[2822] | 85 | |
---|
| 86 | float dot(const Vector3& op2) const |
---|
| 87 | { |
---|
| 88 | return x*op2.x + y*op2.y + z*op2.z; |
---|
[1028] | 89 | } |
---|
[2822] | 90 | |
---|
| 91 | float operator *(const Vector3& op2) const |
---|
| 92 | { |
---|
| 93 | return dot(op2); |
---|
[1028] | 94 | } |
---|
[2822] | 95 | |
---|
| 96 | Vector3 cross(const Vector3& op2) const |
---|
| 97 | { |
---|
| 98 | return Vector3(y*op2.z - z*op2.y, z*op2.x - x*op2.z, x*op2.y - y*op2.x); |
---|
[1028] | 99 | } |
---|
[2822] | 100 | |
---|
| 101 | Vector3 operator ^(const Vector3& op2) const |
---|
| 102 | { |
---|
| 103 | return cross(op2); |
---|
[1028] | 104 | } |
---|
[2822] | 105 | |
---|
| 106 | Vector3 normalize() const |
---|
| 107 | { |
---|
| 108 | float len = length(); |
---|
[2877] | 109 | if (len > 1.0e-6) { |
---|
| 110 | return Vector3(x / len, y / len, z / len); |
---|
| 111 | } else { |
---|
| 112 | return *this; |
---|
| 113 | } |
---|
[1028] | 114 | } |
---|
[2822] | 115 | |
---|
[2902] | 116 | Vector3 rotX(float degree) const |
---|
[2822] | 117 | { |
---|
| 118 | float rad = radians(degree); |
---|
| 119 | return Vector3(x, |
---|
| 120 | y*cos(rad) - z*sin(rad), |
---|
| 121 | y*sin(rad) + z*cos(rad)); |
---|
[1028] | 122 | } |
---|
[2822] | 123 | |
---|
[2902] | 124 | Vector3 rotY(float degree) const |
---|
[2822] | 125 | { |
---|
| 126 | float rad = radians(degree); |
---|
| 127 | return Vector3(x*cos(rad) + z*sin(rad), |
---|
| 128 | y, |
---|
| 129 | -x*sin(rad) + z*cos(rad)); |
---|
[1028] | 130 | } |
---|
[2822] | 131 | |
---|
[2902] | 132 | Vector3 rotZ(float degree) const |
---|
[2822] | 133 | { |
---|
| 134 | float rad = radians(degree); |
---|
| 135 | return Vector3(x*cos(rad) - y*sin(rad), |
---|
| 136 | x*sin(rad) + y*cos(rad), |
---|
| 137 | z); |
---|
[1028] | 138 | } |
---|
[2822] | 139 | |
---|
| 140 | float distance(const Vector3& v) const |
---|
| 141 | { |
---|
| 142 | return sqrtf(distanceSquare(v)); |
---|
[1028] | 143 | } |
---|
[2822] | 144 | |
---|
| 145 | float distanceSquare(const Vector3& v) const |
---|
| 146 | { |
---|
| 147 | return (x-v.x)*(x-v.x) + (y-v.y)*(y-v.y) + (z-v.z)*(z-v.z); |
---|
[1028] | 148 | } |
---|
[2822] | 149 | |
---|
| 150 | float distanceSquare(float vx, float vy, float vz) const |
---|
| 151 | { |
---|
| 152 | return (x-vx)*(x-vx) + (y-vy)*(y-vy) + (z-vz)*(z-vz); |
---|
[1028] | 153 | } |
---|
[2822] | 154 | |
---|
| 155 | void transform(const Vector3& v, const Mat4x4& mat) |
---|
| 156 | { |
---|
[2827] | 157 | const float *m = mat.m; |
---|
[1028] | 158 | x = m[0] * v.x + m[4] * v.y + m[8] * v.z + m[12]; |
---|
| 159 | y = m[1] * v.x + m[5] * v.y + m[9] * v.z + m[13]; |
---|
| 160 | z = m[2] * v.x + m[6] * v.y + m[10] * v.z + m[14]; |
---|
| 161 | } |
---|
[2822] | 162 | |
---|
| 163 | float length() const |
---|
| 164 | { |
---|
| 165 | return sqrt(x*x + y*y + z*z); |
---|
[1028] | 166 | } |
---|
[1484] | 167 | |
---|
[2822] | 168 | Vector3 scale(const Vector3& scale) const |
---|
[1484] | 169 | { |
---|
| 170 | Vector3 v; |
---|
| 171 | v.x = x * scale.x; |
---|
| 172 | v.y = y * scale.y; |
---|
| 173 | v.z = z * scale.z; |
---|
| 174 | return v; |
---|
| 175 | } |
---|
| 176 | |
---|
[3362] | 177 | float x, y, z; |
---|
| 178 | |
---|
[2822] | 179 | private: |
---|
| 180 | float radians(float degree) const |
---|
| 181 | { |
---|
| 182 | return (M_PI * degree) / 180.0; |
---|
| 183 | } |
---|
[911] | 184 | }; |
---|
| 185 | |
---|
[2827] | 186 | typedef std::vector<Vector3> Vector3Array; |
---|
| 187 | |
---|
[3362] | 188 | /** |
---|
| 189 | * \brief Linear interpolation of 2 vectors |
---|
| 190 | */ |
---|
| 191 | inline Vector3 vlerp(const Vector3& v1, const Vector3& v2, double t) |
---|
| 192 | { |
---|
| 193 | return Vector3(v1.x * (1.0-t) + v2.x * t, |
---|
| 194 | v1.y * (1.0-t) + v2.y * t, |
---|
| 195 | v1.z * (1.0-t) + v2.z * t); |
---|
| 196 | } |
---|
| 197 | |
---|
[911] | 198 | #endif |
---|