1 /*
2  * Copyright (c) 2009-2010 jMonkeyEngine
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions are
7  * met:
8  *
9  * * Redistributions of source code must retain the above copyright
10  *   notice, this list of conditions and the following disclaimer.
11  *
12  * * Redistributions in binary form must reproduce the above copyright
13  *   notice, this list of conditions and the following disclaimer in the
14  *   documentation and/or other materials provided with the distribution.
15  *
16  * * Neither the name of 'jMonkeyEngine' nor the names of its contributors
17  *   may be used to endorse or promote products derived from this software
18  *   without specific prior written permission.
19  *
20  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
21  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
23  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
24  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
25  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
26  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
27  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
28  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
29  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
30  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31  */
32 
33 package com.jme3.math;
34 
35 import com.jme3.export.*;
36 import java.io.Externalizable;
37 import java.io.IOException;
38 import java.io.ObjectInput;
39 import java.io.ObjectOutput;
40 import java.util.logging.Logger;
41 
42 /**
43  * <code>Vector2f</code> defines a Vector for a two float value vector.
44  *
45  * @author Mark Powell
46  * @author Joshua Slack
47  */
48 public final class Vector2f implements Savable, Cloneable, java.io.Serializable {
49 
50     static final long serialVersionUID = 1;
51     private static final Logger logger = Logger.getLogger(Vector2f.class.getName());
52 
53     public static final Vector2f ZERO = new Vector2f(0f, 0f);
54     public static final Vector2f UNIT_XY = new Vector2f(1f, 1f);
55 
56     /**
57      * the x value of the vector.
58      */
59     public float x;
60     /**
61      * the y value of the vector.
62      */
63     public float y;
64 
65     /**
66      * Creates a Vector2f with the given initial x and y values.
67      *
68      * @param x
69      *            The x value of this Vector2f.
70      * @param y
71      *            The y value of this Vector2f.
72      */
Vector2f(float x, float y)73     public Vector2f(float x, float y) {
74         this.x = x;
75         this.y = y;
76     }
77 
78     /**
79      * Creates a Vector2f with x and y set to 0. Equivalent to Vector2f(0,0).
80      */
Vector2f()81     public Vector2f() {
82         x = y = 0;
83     }
84 
85     /**
86      * Creates a new Vector2f that contains the passed vector's information
87      *
88      * @param vector2f
89      *            The vector to copy
90      */
Vector2f(Vector2f vector2f)91     public Vector2f(Vector2f vector2f) {
92         this.x = vector2f.x;
93         this.y = vector2f.y;
94     }
95 
96     /**
97      * set the x and y values of the vector
98      *
99      * @param x
100      *            the x value of the vector.
101      * @param y
102      *            the y value of the vector.
103      * @return this vector
104      */
set(float x, float y)105     public Vector2f set(float x, float y) {
106         this.x = x;
107         this.y = y;
108         return this;
109     }
110 
111     /**
112      * set the x and y values of the vector from another vector
113      *
114      * @param vec
115      *            the vector to copy from
116      * @return this vector
117      */
set(Vector2f vec)118     public Vector2f set(Vector2f vec) {
119         this.x = vec.x;
120         this.y = vec.y;
121         return this;
122     }
123 
124     /**
125      * <code>add</code> adds a provided vector to this vector creating a
126      * resultant vector which is returned. If the provided vector is null, null
127      * is returned.
128      *
129      * @param vec
130      *            the vector to add to this.
131      * @return the resultant vector.
132      */
add(Vector2f vec)133     public Vector2f add(Vector2f vec) {
134         if (null == vec) {
135             logger.warning("Provided vector is null, null returned.");
136             return null;
137         }
138         return new Vector2f(x + vec.x, y + vec.y);
139     }
140 
141     /**
142      * <code>addLocal</code> adds a provided vector to this vector internally,
143      * and returns a handle to this vector for easy chaining of calls. If the
144      * provided vector is null, null is returned.
145      *
146      * @param vec
147      *            the vector to add to this vector.
148      * @return this
149      */
addLocal(Vector2f vec)150     public Vector2f addLocal(Vector2f vec) {
151         if (null == vec) {
152             logger.warning("Provided vector is null, null returned.");
153             return null;
154         }
155         x += vec.x;
156         y += vec.y;
157         return this;
158     }
159 
160     /**
161      * <code>addLocal</code> adds the provided values to this vector
162      * internally, and returns a handle to this vector for easy chaining of
163      * calls.
164      *
165      * @param addX
166      *            value to add to x
167      * @param addY
168      *            value to add to y
169      * @return this
170      */
addLocal(float addX, float addY)171     public Vector2f addLocal(float addX, float addY) {
172         x += addX;
173         y += addY;
174         return this;
175     }
176 
177     /**
178      * <code>add</code> adds this vector by <code>vec</code> and stores the
179      * result in <code>result</code>.
180      *
181      * @param vec
182      *            The vector to add.
183      * @param result
184      *            The vector to store the result in.
185      * @return The result vector, after adding.
186      */
add(Vector2f vec, Vector2f result)187     public Vector2f add(Vector2f vec, Vector2f result) {
188         if (null == vec) {
189             logger.warning("Provided vector is null, null returned.");
190             return null;
191         }
192         if (result == null)
193             result = new Vector2f();
194         result.x = x + vec.x;
195         result.y = y + vec.y;
196         return result;
197     }
198 
199     /**
200      * <code>dot</code> calculates the dot product of this vector with a
201      * provided vector. If the provided vector is null, 0 is returned.
202      *
203      * @param vec
204      *            the vector to dot with this vector.
205      * @return the resultant dot product of this vector and a given vector.
206      */
dot(Vector2f vec)207     public float dot(Vector2f vec) {
208         if (null == vec) {
209             logger.warning("Provided vector is null, 0 returned.");
210             return 0;
211         }
212         return x * vec.x + y * vec.y;
213     }
214 
215     /**
216      * <code>cross</code> calculates the cross product of this vector with a
217      * parameter vector v.
218      *
219      * @param v
220      *            the vector to take the cross product of with this.
221      * @return the cross product vector.
222      */
cross(Vector2f v)223     public Vector3f cross(Vector2f v) {
224         return new Vector3f(0, 0, determinant(v));
225     }
226 
determinant(Vector2f v)227     public float determinant(Vector2f v) {
228         return (x * v.y) - (y * v.x);
229     }
230 
231     /**
232      * Sets this vector to the interpolation by changeAmnt from this to the
233      * finalVec this=(1-changeAmnt)*this + changeAmnt * finalVec
234      *
235      * @param finalVec
236      *            The final vector to interpolate towards
237      * @param changeAmnt
238      *            An amount between 0.0 - 1.0 representing a percentage change
239      *            from this towards finalVec
240      */
interpolate(Vector2f finalVec, float changeAmnt)241     public Vector2f interpolate(Vector2f finalVec, float changeAmnt) {
242         this.x = (1 - changeAmnt) * this.x + changeAmnt * finalVec.x;
243         this.y = (1 - changeAmnt) * this.y + changeAmnt * finalVec.y;
244         return this;
245     }
246 
247     /**
248      * Sets this vector to the interpolation by changeAmnt from beginVec to
249      * finalVec this=(1-changeAmnt)*beginVec + changeAmnt * finalVec
250      *
251      * @param beginVec
252      *            The begining vector (delta=0)
253      * @param finalVec
254      *            The final vector to interpolate towards (delta=1)
255      * @param changeAmnt
256      *            An amount between 0.0 - 1.0 representing a precentage change
257      *            from beginVec towards finalVec
258      */
interpolate(Vector2f beginVec, Vector2f finalVec, float changeAmnt)259     public Vector2f interpolate(Vector2f beginVec, Vector2f finalVec,
260             float changeAmnt) {
261         this.x = (1 - changeAmnt) * beginVec.x + changeAmnt * finalVec.x;
262         this.y = (1 - changeAmnt) * beginVec.y + changeAmnt * finalVec.y;
263         return this;
264     }
265 
266     /**
267      * Check a vector... if it is null or its floats are NaN or infinite, return
268      * false. Else return true.
269      *
270      * @param vector
271      *            the vector to check
272      * @return true or false as stated above.
273      */
isValidVector(Vector2f vector)274     public static boolean isValidVector(Vector2f vector) {
275       if (vector == null) return false;
276       if (Float.isNaN(vector.x) ||
277           Float.isNaN(vector.y)) return false;
278       if (Float.isInfinite(vector.x) ||
279           Float.isInfinite(vector.y)) return false;
280       return true;
281     }
282 
283     /**
284      * <code>length</code> calculates the magnitude of this vector.
285      *
286      * @return the length or magnitude of the vector.
287      */
length()288     public float length() {
289         return FastMath.sqrt(lengthSquared());
290     }
291 
292     /**
293      * <code>lengthSquared</code> calculates the squared value of the
294      * magnitude of the vector.
295      *
296      * @return the magnitude squared of the vector.
297      */
lengthSquared()298     public float lengthSquared() {
299         return x * x + y * y;
300     }
301 
302     /**
303      * <code>distanceSquared</code> calculates the distance squared between
304      * this vector and vector v.
305      *
306      * @param v the second vector to determine the distance squared.
307      * @return the distance squared between the two vectors.
308      */
distanceSquared(Vector2f v)309     public float distanceSquared(Vector2f v) {
310         double dx = x - v.x;
311         double dy = y - v.y;
312         return (float) (dx * dx + dy * dy);
313     }
314 
315     /**
316      * <code>distanceSquared</code> calculates the distance squared between
317      * this vector and vector v.
318      *
319      * @param otherX The X coordinate of the v vector
320      * @param otherY The Y coordinate of the v vector
321      * @return the distance squared between the two vectors.
322      */
distanceSquared(float otherX, float otherY)323     public float distanceSquared(float otherX, float otherY) {
324         double dx = x - otherX;
325         double dy = y - otherY;
326         return (float) (dx * dx + dy * dy);
327     }
328 
329     /**
330      * <code>distance</code> calculates the distance between this vector and
331      * vector v.
332      *
333      * @param v the second vector to determine the distance.
334      * @return the distance between the two vectors.
335      */
distance(Vector2f v)336     public float distance(Vector2f v) {
337         return FastMath.sqrt(distanceSquared(v));
338     }
339 
340     /**
341      * <code>mult</code> multiplies this vector by a scalar. The resultant
342      * vector is returned.
343      *
344      * @param scalar
345      *            the value to multiply this vector by.
346      * @return the new vector.
347      */
mult(float scalar)348     public Vector2f mult(float scalar) {
349         return new Vector2f(x * scalar, y * scalar);
350     }
351 
352     /**
353      * <code>multLocal</code> multiplies this vector by a scalar internally,
354      * and returns a handle to this vector for easy chaining of calls.
355      *
356      * @param scalar
357      *            the value to multiply this vector by.
358      * @return this
359      */
multLocal(float scalar)360     public Vector2f multLocal(float scalar) {
361         x *= scalar;
362         y *= scalar;
363         return this;
364     }
365 
366     /**
367      * <code>multLocal</code> multiplies a provided vector to this vector
368      * internally, and returns a handle to this vector for easy chaining of
369      * calls. If the provided vector is null, null is returned.
370      *
371      * @param vec
372      *            the vector to mult to this vector.
373      * @return this
374      */
multLocal(Vector2f vec)375     public Vector2f multLocal(Vector2f vec) {
376         if (null == vec) {
377             logger.warning("Provided vector is null, null returned.");
378             return null;
379         }
380         x *= vec.x;
381         y *= vec.y;
382         return this;
383     }
384 
385     /**
386      * Multiplies this Vector2f's x and y by the scalar and stores the result in
387      * product. The result is returned for chaining. Similar to
388      * product=this*scalar;
389      *
390      * @param scalar
391      *            The scalar to multiply by.
392      * @param product
393      *            The vector2f to store the result in.
394      * @return product, after multiplication.
395      */
mult(float scalar, Vector2f product)396     public Vector2f mult(float scalar, Vector2f product) {
397         if (null == product) {
398             product = new Vector2f();
399         }
400 
401         product.x = x * scalar;
402         product.y = y * scalar;
403         return product;
404     }
405 
406     /**
407      * <code>divide</code> divides the values of this vector by a scalar and
408      * returns the result. The values of this vector remain untouched.
409      *
410      * @param scalar
411      *            the value to divide this vectors attributes by.
412      * @return the result <code>Vector</code>.
413      */
divide(float scalar)414     public Vector2f divide(float scalar) {
415         return new Vector2f(x / scalar, y / scalar);
416     }
417 
418     /**
419      * <code>divideLocal</code> divides this vector by a scalar internally,
420      * and returns a handle to this vector for easy chaining of calls. Dividing
421      * by zero will result in an exception.
422      *
423      * @param scalar
424      *            the value to divides this vector by.
425      * @return this
426      */
divideLocal(float scalar)427     public Vector2f divideLocal(float scalar) {
428         x /= scalar;
429         y /= scalar;
430         return this;
431     }
432 
433     /**
434      * <code>negate</code> returns the negative of this vector. All values are
435      * negated and set to a new vector.
436      *
437      * @return the negated vector.
438      */
negate()439     public Vector2f negate() {
440         return new Vector2f(-x, -y);
441     }
442 
443     /**
444      * <code>negateLocal</code> negates the internal values of this vector.
445      *
446      * @return this.
447      */
negateLocal()448     public Vector2f negateLocal() {
449         x = -x;
450         y = -y;
451         return this;
452     }
453 
454     /**
455      * <code>subtract</code> subtracts the values of a given vector from those
456      * of this vector creating a new vector object. If the provided vector is
457      * null, an exception is thrown.
458      *
459      * @param vec
460      *            the vector to subtract from this vector.
461      * @return the result vector.
462      */
subtract(Vector2f vec)463     public Vector2f subtract(Vector2f vec) {
464         return subtract(vec, null);
465     }
466 
467     /**
468      * <code>subtract</code> subtracts the values of a given vector from those
469      * of this vector storing the result in the given vector object. If the
470      * provided vector is null, an exception is thrown.
471      *
472      * @param vec
473      *            the vector to subtract from this vector.
474      * @param store
475      *            the vector to store the result in. It is safe for this to be
476      *            the same as vec. If null, a new vector is created.
477      * @return the result vector.
478      */
subtract(Vector2f vec, Vector2f store)479     public Vector2f subtract(Vector2f vec, Vector2f store) {
480         if (store == null)
481             store = new Vector2f();
482         store.x = x - vec.x;
483         store.y = y - vec.y;
484         return store;
485     }
486 
487     /**
488      * <code>subtract</code> subtracts the given x,y values from those of this
489      * vector creating a new vector object.
490      *
491      * @param valX
492      *            value to subtract from x
493      * @param valY
494      *            value to subtract from y
495      * @return this
496      */
subtract(float valX, float valY)497     public Vector2f subtract(float valX, float valY) {
498         return new Vector2f(x - valX, y - valY);
499     }
500 
501     /**
502      * <code>subtractLocal</code> subtracts a provided vector to this vector
503      * internally, and returns a handle to this vector for easy chaining of
504      * calls. If the provided vector is null, null is returned.
505      *
506      * @param vec
507      *            the vector to subtract
508      * @return this
509      */
subtractLocal(Vector2f vec)510     public Vector2f subtractLocal(Vector2f vec) {
511         if (null == vec) {
512             logger.warning("Provided vector is null, null returned.");
513             return null;
514         }
515         x -= vec.x;
516         y -= vec.y;
517         return this;
518     }
519 
520     /**
521      * <code>subtractLocal</code> subtracts the provided values from this
522      * vector internally, and returns a handle to this vector for easy chaining
523      * of calls.
524      *
525      * @param valX
526      *            value to subtract from x
527      * @param valY
528      *            value to subtract from y
529      * @return this
530      */
subtractLocal(float valX, float valY)531     public Vector2f subtractLocal(float valX, float valY) {
532         x -= valX;
533         y -= valY;
534         return this;
535     }
536 
537     /**
538      * <code>normalize</code> returns the unit vector of this vector.
539      *
540      * @return unit vector of this vector.
541      */
normalize()542     public Vector2f normalize() {
543         float length = length();
544         if (length != 0) {
545             return divide(length);
546         }
547 
548         return divide(1);
549     }
550 
551     /**
552      * <code>normalizeLocal</code> makes this vector into a unit vector of
553      * itself.
554      *
555      * @return this.
556      */
normalizeLocal()557     public Vector2f normalizeLocal() {
558         float length = length();
559         if (length != 0) {
560             return divideLocal(length);
561         }
562 
563         return divideLocal(1);
564     }
565 
566     /**
567      * <code>smallestAngleBetween</code> returns (in radians) the minimum
568      * angle between two vectors. It is assumed that both this vector and the
569      * given vector are unit vectors (iow, normalized).
570      *
571      * @param otherVector
572      *            a unit vector to find the angle against
573      * @return the angle in radians.
574      */
smallestAngleBetween(Vector2f otherVector)575     public float smallestAngleBetween(Vector2f otherVector) {
576         float dotProduct = dot(otherVector);
577         float angle = FastMath.acos(dotProduct);
578         return angle;
579     }
580 
581     /**
582      * <code>angleBetween</code> returns (in radians) the angle required to
583      * rotate a ray represented by this vector to lie colinear to a ray
584      * described by the given vector. It is assumed that both this vector and
585      * the given vector are unit vectors (iow, normalized).
586      *
587      * @param otherVector
588      *            the "destination" unit vector
589      * @return the angle in radians.
590      */
angleBetween(Vector2f otherVector)591     public float angleBetween(Vector2f otherVector) {
592         float angle = FastMath.atan2(otherVector.y, otherVector.x)
593                 - FastMath.atan2(y, x);
594         return angle;
595     }
596 
getX()597     public float getX() {
598         return x;
599     }
600 
setX(float x)601     public Vector2f setX(float x) {
602         this.x = x;
603         return this;
604     }
605 
getY()606     public float getY() {
607         return y;
608     }
609 
setY(float y)610     public Vector2f setY(float y) {
611         this.y = y;
612         return this;
613     }
614     /**
615      * <code>getAngle</code> returns (in radians) the angle represented by
616      * this Vector2f as expressed by a conversion from rectangular coordinates (<code>x</code>,&nbsp;<code>y</code>)
617      * to polar coordinates (r,&nbsp;<i>theta</i>).
618      *
619      * @return the angle in radians. [-pi, pi)
620      */
getAngle()621     public float getAngle() {
622         return FastMath.atan2(y, x);
623     }
624 
625     /**
626      * <code>zero</code> resets this vector's data to zero internally.
627      */
zero()628     public Vector2f zero() {
629         x = y = 0;
630         return this;
631     }
632 
633     /**
634      * <code>hashCode</code> returns a unique code for this vector object
635      * based on it's values. If two vectors are logically equivalent, they will
636      * return the same hash code value.
637      *
638      * @return the hash code value of this vector.
639      */
hashCode()640     public int hashCode() {
641         int hash = 37;
642         hash += 37 * hash + Float.floatToIntBits(x);
643         hash += 37 * hash + Float.floatToIntBits(y);
644         return hash;
645     }
646 
647     @Override
clone()648     public Vector2f clone() {
649         try {
650             return (Vector2f) super.clone();
651         } catch (CloneNotSupportedException e) {
652             throw new AssertionError(); // can not happen
653         }
654     }
655 
656     /**
657      * Saves this Vector2f into the given float[] object.
658      *
659      * @param floats
660      *            The float[] to take this Vector2f. If null, a new float[2] is
661      *            created.
662      * @return The array, with X, Y float values in that order
663      */
toArray(float[] floats)664     public float[] toArray(float[] floats) {
665         if (floats == null) {
666             floats = new float[2];
667         }
668         floats[0] = x;
669         floats[1] = y;
670         return floats;
671     }
672 
673     /**
674      * are these two vectors the same? they are is they both have the same x and
675      * y values.
676      *
677      * @param o
678      *            the object to compare for equality
679      * @return true if they are equal
680      */
equals(Object o)681     public boolean equals(Object o) {
682         if (!(o instanceof Vector2f)) {
683             return false;
684         }
685 
686         if (this == o) {
687             return true;
688         }
689 
690         Vector2f comp = (Vector2f) o;
691         if (Float.compare(x, comp.x) != 0)
692             return false;
693         if (Float.compare(y, comp.y) != 0)
694             return false;
695         return true;
696     }
697 
698     /**
699      * <code>toString</code> returns the string representation of this vector
700      * object. The format of the string is such: com.jme.math.Vector2f
701      * [X=XX.XXXX, Y=YY.YYYY]
702      *
703      * @return the string representation of this vector.
704      */
toString()705     public String toString() {
706         return "(" + x + ", " + y + ")";
707     }
708 
709     /**
710      * Used with serialization. Not to be called manually.
711      *
712      * @param in
713      *            ObjectInput
714      * @throws IOException
715      * @throws ClassNotFoundException
716      * @see java.io.Externalizable
717      */
readExternal(ObjectInput in)718     public void readExternal(ObjectInput in) throws IOException,
719             ClassNotFoundException {
720         x = in.readFloat();
721         y = in.readFloat();
722     }
723 
724     /**
725      * Used with serialization. Not to be called manually.
726      *
727      * @param out
728      *            ObjectOutput
729      * @throws IOException
730      * @see java.io.Externalizable
731      */
writeExternal(ObjectOutput out)732     public void writeExternal(ObjectOutput out) throws IOException {
733         out.writeFloat(x);
734         out.writeFloat(y);
735     }
736 
write(JmeExporter e)737     public void write(JmeExporter e) throws IOException {
738         OutputCapsule capsule = e.getCapsule(this);
739         capsule.write(x, "x", 0);
740         capsule.write(y, "y", 0);
741     }
742 
read(JmeImporter e)743     public void read(JmeImporter e) throws IOException {
744         InputCapsule capsule = e.getCapsule(this);
745         x = capsule.readFloat("x", 0);
746         y = capsule.readFloat("y", 0);
747     }
748 
rotateAroundOrigin(float angle, boolean cw)749     public void rotateAroundOrigin(float angle, boolean cw) {
750         if (cw)
751             angle = -angle;
752         float newX = FastMath.cos(angle) * x - FastMath.sin(angle) * y;
753         float newY = FastMath.sin(angle) * x + FastMath.cos(angle) * y;
754         x = newX;
755         y = newY;
756     }
757 }
758