[65] | 1 | package pl.vorg.mowa.core.graphics;
|
---|
| 2 |
|
---|
| 3 | /**
|
---|
| 4 | * A vector in 3d space.
|
---|
| 5 | *
|
---|
| 6 | * @author vorg
|
---|
| 7 | */
|
---|
| 8 | public class Vec3 {
|
---|
| 9 | private float[] v = {0,0,0};
|
---|
| 10 |
|
---|
| 11 | public Vec3() {
|
---|
| 12 |
|
---|
| 13 | }
|
---|
| 14 |
|
---|
| 15 | public Vec3(float x, float y, float z) {
|
---|
| 16 | v[0] = x;
|
---|
| 17 | v[1] = y;
|
---|
| 18 | v[2] = z;
|
---|
| 19 | }
|
---|
| 20 |
|
---|
| 21 | public Vec3(Vec3 vec) {
|
---|
| 22 | float[] w = vec.getVector();
|
---|
| 23 | v[0] = w[0];
|
---|
| 24 | v[1] = w[1];
|
---|
| 25 | v[2] = w[2];
|
---|
| 26 | }
|
---|
| 27 |
|
---|
| 28 | public Vec3(float[] vec) {
|
---|
| 29 | v[0] = vec[0];
|
---|
| 30 | v[1] = vec[1];
|
---|
| 31 | v[2] = vec[2];
|
---|
| 32 | }
|
---|
| 33 |
|
---|
| 34 | @Override
|
---|
| 35 | public boolean equals(java.lang.Object obj) {
|
---|
| 36 | float[] w = ((Vec3)obj).getVector();
|
---|
| 37 | return (v[0] == w[0]) && (v[1] == w[1]) && (v[2] == w[2]);
|
---|
| 38 | }
|
---|
| 39 |
|
---|
| 40 | public float getX() {
|
---|
| 41 | return v[0];
|
---|
| 42 | }
|
---|
| 43 |
|
---|
| 44 | public float getY() {
|
---|
| 45 | return v[1];
|
---|
| 46 | }
|
---|
| 47 |
|
---|
| 48 | public float getZ() {
|
---|
| 49 | return v[2];
|
---|
| 50 | }
|
---|
| 51 |
|
---|
| 52 | public void setX(float x) {
|
---|
| 53 | v[0] = x;
|
---|
| 54 | }
|
---|
| 55 |
|
---|
| 56 | public void setY(float y) {
|
---|
| 57 | v[1] = y;
|
---|
| 58 | }
|
---|
| 59 |
|
---|
| 60 | public void setZ(float z) {
|
---|
| 61 | v[2] = z;
|
---|
| 62 | }
|
---|
| 63 |
|
---|
| 64 |
|
---|
| 65 | public float[] getVector() {
|
---|
| 66 | return v;
|
---|
| 67 | }
|
---|
| 68 |
|
---|
| 69 | public void normalize() {
|
---|
| 70 | float length = length();
|
---|
| 71 | if (length > 0) {
|
---|
| 72 | v[0] /= length;
|
---|
| 73 | v[1] /= length;
|
---|
| 74 | v[2] /= length;
|
---|
| 75 | }
|
---|
| 76 | }
|
---|
| 77 |
|
---|
| 78 | public float length() {
|
---|
| 79 | return (float)Math.sqrt(v[0]*v[0]+v[1]*v[1]+v[2]*v[2]);
|
---|
| 80 | }
|
---|
| 81 |
|
---|
| 82 | public void add(Vec3 a) {
|
---|
| 83 | v[0] += a.getX();
|
---|
| 84 | v[1] += a.getY();
|
---|
| 85 | v[2] += a.getZ();
|
---|
| 86 | }
|
---|
| 87 |
|
---|
| 88 | public static Vec3 add(Vec3 a, Vec3 b) {
|
---|
| 89 | return new Vec3(
|
---|
| 90 | a.getX() + b.getX(),
|
---|
| 91 | a.getY() + b.getY(),
|
---|
| 92 | a.getZ() + b.getZ()
|
---|
| 93 | );
|
---|
| 94 | }
|
---|
| 95 |
|
---|
| 96 | public void sub(Vec3 a) {
|
---|
| 97 | v[0] -= a.getX();
|
---|
| 98 | v[1] -= a.getY();
|
---|
| 99 | v[2] -= a.getZ();
|
---|
| 100 | }
|
---|
| 101 |
|
---|
| 102 | public static Vec3 sub(Vec3 a, Vec3 b) {
|
---|
| 103 | return new Vec3(
|
---|
| 104 | a.getX() - b.getX(),
|
---|
| 105 | a.getY() - b.getY(),
|
---|
| 106 | a.getZ() - b.getZ()
|
---|
| 107 | );
|
---|
| 108 | }
|
---|
| 109 |
|
---|
| 110 | public void mul(float f) {
|
---|
| 111 | v[0] *= f;
|
---|
| 112 | v[1] *= f;
|
---|
| 113 | v[2] *= f;
|
---|
| 114 | }
|
---|
| 115 |
|
---|
| 116 | public static Vec3 mul(float f, Vec3 a) {
|
---|
| 117 | return new Vec3(
|
---|
| 118 | a.getX() * f,
|
---|
| 119 | a.getY() * f,
|
---|
| 120 | a.getZ() * f
|
---|
| 121 | );
|
---|
| 122 | }
|
---|
| 123 |
|
---|
| 124 | public static Vec3 cross(Vec3 a, Vec3 b) {
|
---|
| 125 | float[] va = a.getVector();
|
---|
| 126 | float[] vb = b.getVector();
|
---|
| 127 | return new Vec3(
|
---|
| 128 | va[1]*vb[2] - va[2]*vb[1],
|
---|
| 129 | va[2]*vb[0] - va[0]*vb[2],
|
---|
| 130 | va[0]*vb[1] - va[1]*vb[0]
|
---|
| 131 | );
|
---|
| 132 | }
|
---|
| 133 |
|
---|
| 134 | public float dot(Vec3 a) {
|
---|
| 135 | float[] va = a.getVector();
|
---|
| 136 | return v[0]*va[0] + v[1]*va[1] + v[2]*va[2];
|
---|
| 137 | }
|
---|
| 138 |
|
---|
| 139 | public static float dot(Vec3 a, Vec3 b) {
|
---|
| 140 | float[] va = a.getVector();
|
---|
| 141 | float[] vb = b.getVector();
|
---|
| 142 | return va[0]*vb[0] + va[1]*vb[1] + va[2]*vb[2];
|
---|
| 143 | }
|
---|
| 144 |
|
---|
| 145 | public float angle(Vec3 a) {
|
---|
| 146 | float len = length();
|
---|
| 147 | float alen = a.length();
|
---|
| 148 | if ((len == 0) || (alen == 0)) {
|
---|
| 149 | return 0;
|
---|
| 150 | }
|
---|
| 151 | return (float)Math.acos(this.dot(a)/(len*alen));
|
---|
| 152 | }
|
---|
| 153 |
|
---|
| 154 | public static Vec3 normalized(Vec3 a) {
|
---|
| 155 | Vec3 na = new Vec3(a);
|
---|
| 156 | na.normalize();
|
---|
| 157 | return na;
|
---|
| 158 | }
|
---|
| 159 |
|
---|
| 160 | public static Vec3 neg(Vec3 a) {
|
---|
| 161 | return new Vec3(-a.getX(), -a.getY(), -a.getZ());
|
---|
| 162 | }
|
---|
| 163 | }
|
---|