toxiclibs 0.2-java → 0.5.0-java

data/src/toxi/physics3d/VerletConstrainedSpring3D.java

@@ -0,0 +1,88 @@
+/*
+ *   __               .__       .__  ._____.           
+ * _/  |_  _______  __|__| ____ |  | |__\_ |__   ______
+ * \   __\/  _ \  \/  /  |/ ___\|  | |  || __ \ /  ___/
+ *  |  | (  <_> >    <|  \  \___|  |_|  || \_\ \\___ \ 
+ *  |__|  \____/__/\_ \__|\___  >____/__||___  /____  >
+ *                   \/       \/             \/     \/ 
+ *
+ * Copyright (c) 2006-2011 Karsten Schmidt
+ * 
+ * This library is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU Lesser General Public
+ * License as published by the Free Software Foundation; either
+ * version 2.1 of the License, or (at your option) any later version.
+ * 
+ * http://creativecommons.org/licenses/LGPL/2.1/
+ * 
+ * This library is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * Lesser General Public License for more details.
+ * 
+ * You should have received a copy of the GNU Lesser General Public
+ * License along with this library; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
+ */
+
+package toxi.physics3d;
+
+import toxi.geom.Vec3D;
+
+/**
+ * Implements a spring whose maximum relaxation distance at every time step can
+ * be limited to achieve better (if physically incorrect) stability of the whole
+ * spring system.
+ */
+public class VerletConstrainedSpring3D extends VerletSpring3D {
+
+    /**
+     * Maximum relaxation distance for either end of the spring in world units
+     */
+    public float limit = Float.MAX_VALUE;
+
+    /**
+     * @param a
+     * @param b
+     * @param len
+     * @param str
+     */
+    public VerletConstrainedSpring3D(VerletParticle3D a, VerletParticle3D b,
+            float len, float str) {
+        super(a, b, len, str);
+    }
+
+    /**
+     * @param a
+     * @param b
+     * @param len
+     * @param str
+     * @param limit
+     */
+    public VerletConstrainedSpring3D(VerletParticle3D a, VerletParticle3D b,
+            float len, float str, float limit) {
+        super(a, b, len, str);
+        this.limit = limit;
+    }
+
+    @Override
+    protected void update(boolean applyConstraints) {
+        Vec3D delta = b.sub(a);
+        // add minute offset to avoid div-by-zero errors
+        float dist = delta.magnitude() + EPS;
+        float normDistStrength = (dist - restLength)
+                / (dist * (a.invWeight + b.invWeight)) * strength;
+        if (!a.isLocked && !isALocked) {
+            a.addSelf(delta.scale(normDistStrength * a.invWeight).limit(limit));
+            if (applyConstraints) {
+                a.applyConstraints();
+            }
+        }
+        if (!b.isLocked && !isBLocked) {
+            b.subSelf(delta.scale(normDistStrength * b.invWeight).limit(limit));
+            if (applyConstraints) {
+                b.applyConstraints();
+            }
+        }
+    }
+}

data/src/toxi/physics3d/VerletMinDistanceSpring3D.java

@@ -0,0 +1,56 @@
+/*
+ *   __               .__       .__  ._____.           
+ * _/  |_  _______  __|__| ____ |  | |__\_ |__   ______
+ * \   __\/  _ \  \/  /  |/ ___\|  | |  || __ \ /  ___/
+ *  |  | (  <_> >    <|  \  \___|  |_|  || \_\ \\___ \ 
+ *  |__|  \____/__/\_ \__|\___  >____/__||___  /____  >
+ *                   \/       \/             \/     \/ 
+ *
+ * Copyright (c) 2006-2011 Karsten Schmidt
+ * 
+ * This library is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU Lesser General Public
+ * License as published by the Free Software Foundation; either
+ * version 2.1 of the License, or (at your option) any later version.
+ * 
+ * http://creativecommons.org/licenses/LGPL/2.1/
+ * 
+ * This library is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * Lesser General Public License for more details.
+ * 
+ * You should have received a copy of the GNU Lesser General Public
+ * License along with this library; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
+ */
+
+package toxi.physics3d;
+
+/**
+ * Implements a string which will only enforce its rest length if the current
+ * distance is less than its rest length. This is handy if you just want to
+ * ensure objects are at least a certain distance from each other, but don't
+ * care if it's bigger than the enforced minimum.
+ */
+public class VerletMinDistanceSpring3D extends VerletSpring3D {
+
+    /**
+     *
+     * @param a
+     * @param b
+     * @param len
+     * @param str
+     */
+    public VerletMinDistanceSpring3D(VerletParticle3D a, VerletParticle3D b,
+            float len, float str) {
+        super(a, b, len, str);
+    }
+
+    @Override
+    public void update(boolean applyConstraints) {
+        if (b.distanceToSquared(a) < restLengthSquared) {
+            super.update(applyConstraints);
+        }
+    }
+}

data/src/toxi/physics3d/VerletParticle3D.java

@@ -0,0 +1,385 @@
+/*
+ *   __               .__       .__  ._____.           
+ * _/  |_  _______  __|__| ____ |  | |__\_ |__   ______
+ * \   __\/  _ \  \/  /  |/ ___\|  | |  || __ \ /  ___/
+ *  |  | (  <_> >    <|  \  \___|  |_|  || \_\ \\___ \ 
+ *  |__|  \____/__/\_ \__|\___  >____/__||___  /____  >
+ *                   \/       \/             \/     \/ 
+ *
+ * Copyright (c) 2006-2011 Karsten Schmidt
+ * 
+ * This library is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU Lesser General Public
+ * License as published by the Free Software Foundation; either
+ * version 2.1 of the License, or (at your option) any later version.
+ * 
+ * http://creativecommons.org/licenses/LGPL/2.1/
+ * 
+ * This library is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * Lesser General Public License for more details.
+ * 
+ * You should have received a copy of the GNU Lesser General Public
+ * License along with this library; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
+ */
+
+package toxi.physics3d;
+
+import java.util.ArrayList;
+import java.util.List;
+
+import toxi.geom.AABB;
+import toxi.geom.ReadonlyVec3D;
+import toxi.geom.Vec3D;
+import toxi.physics3d.behaviors.ParticleBehavior3D;
+import toxi.physics3d.constraints.ParticleConstraint3D;
+
+/**
+ * An individual 3D particle for use by the VerletPhysics and VerletSpring
+ * classes. A particle has weight, can be locked in space and its position
+ * constrained inside an (optional) axis-aligned bounding box.
+ */
+public class VerletParticle3D extends Vec3D {
+
+    protected Vec3D prev,
+
+    /**
+     *
+     */
+
+    /**
+     *
+     */
+    temp;
+
+    /**
+     *
+     */
+    protected boolean isLocked;
+
+    /**
+     * Bounding box, by default set to null to disable
+     */
+    public AABB bounds;
+
+    /**
+     * An optional particle constraints, called immediately after a particle is
+     * updated (and only used if particle is unlocked (default)
+     */
+    public List<ParticleConstraint3D> constraints;
+
+    /**
+     *
+     */
+    public List<ParticleBehavior3D> behaviors;
+
+    /**
+     * Particle weight, default = 1
+     */
+    protected float weight, invWeight;
+
+    /**
+     *
+     */
+    protected Vec3D force = new Vec3D();
+
+    /**
+     * Creates particle at position xyz
+     * 
+     * @param x
+     * @param y
+     * @param z
+     */
+    public VerletParticle3D(float x, float y, float z) {
+        this(x, y, z, 1);
+    }
+
+    /**
+     * Creates particle at position xyz with weight w
+     * 
+     * @param x
+     * @param y
+     * @param z
+     * @param w
+     */
+    public VerletParticle3D(float x, float y, float z, float w) {
+        super(x, y, z);
+        prev = new Vec3D(this);
+        temp = new Vec3D();
+        setWeight(w);
+    }
+
+    /**
+     * Creates particle at the position of the passed in vector
+     * 
+     * @param v
+     *            position
+     */
+    public VerletParticle3D(ReadonlyVec3D v) {
+        this(v.x(), v.y(), v.z(), 1);
+    }
+
+    /**
+     * Creates particle with weight w at the position of the passed in vector
+     * 
+     * @param v
+     *            position
+     * @param w
+     *            weight
+     */
+    public VerletParticle3D(ReadonlyVec3D v, float w) {
+        this(v.x(), v.y(), v.z(), w);
+    }
+
+    /**
+     * Creates a copy of the passed in particle
+     * 
+     * @param p
+     */
+    public VerletParticle3D(VerletParticle3D p) {
+        this(p.x, p.y, p.z, p.weight);
+        isLocked = p.isLocked;
+    }
+
+    /**
+     *
+     * @param behavior
+     * @return
+     */
+    public VerletParticle3D addBehavior(ParticleBehavior3D behavior) {
+        return addBehavior(behavior, 1);
+    }
+
+    /**
+     *
+     * @param behavior
+     * @param timeStep
+     * @return
+     */
+    public VerletParticle3D addBehavior(ParticleBehavior3D behavior, float timeStep) {
+        if (behaviors == null) {
+            behaviors = new ArrayList<ParticleBehavior3D>(1);
+        }
+        behavior.configure(timeStep);
+        behaviors.add(behavior);
+        return this;
+    }
+
+    /**
+     * Adds the given constraint implementation to the list of constraints
+     * applied to this particle at each time step.
+     * 
+     * @param c
+     *            constraint instance
+     * @return itself
+     */
+    public VerletParticle3D addConstraint(ParticleConstraint3D c) {
+        if (constraints == null) {
+            constraints = new ArrayList<ParticleConstraint3D>(1);
+        }
+        constraints.add(c);
+        return this;
+    }
+
+    /**
+     *
+     * @param f
+     * @return
+     */
+    public VerletParticle3D addForce(Vec3D f) {
+        force.addSelf(f);
+        return this;
+    }
+
+    /**
+     *
+     * @param v
+     * @return
+     */
+    public VerletParticle3D addVelocity(Vec3D v) {
+        prev.subSelf(v);
+        return this;
+    }
+
+    /**
+     *
+     */
+    public void applyBehaviors() {
+        if (behaviors != null) {
+            for (ParticleBehavior3D b : behaviors) {
+                b.apply(this);
+            }
+        }
+    }
+
+    /**
+     *
+     */
+    public void applyConstraints() {
+        if (constraints != null) {
+            for (ParticleConstraint3D pc : constraints) {
+                pc.apply(this);
+            }
+        }
+    }
+
+    /**
+     *
+     */
+    protected void applyForce() {
+        temp.set(this);
+        addSelf(sub(prev).addSelf(force.scale(weight)));
+        prev.set(temp);
+        force.clear();
+    }
+
+    /**
+     * Removes any currently applied constraints from this particle.
+     * 
+     * @return itself
+     */
+    public VerletParticle3D clearConstraints() {
+        constraints.clear();
+        return this;
+    }
+
+    /**
+     *
+     * @return
+     */
+    public VerletParticle3D clearForce() {
+        force.clear();
+        return this;
+    }
+
+    /**
+     *
+     * @return
+     */
+    public VerletParticle3D clearVelocity() {
+        prev.set(this);
+        return this;
+    }
+
+    /**
+     * @return the inverse weight (1/weight)
+     */
+    public final float getInvWeight() {
+        return invWeight;
+    }
+
+    /**
+     * Returns the particle's position at the most recent time step.
+     * 
+     * @return previous position
+     */
+    public Vec3D getPreviousPosition() {
+        return prev;
+    }
+
+    /**
+     *
+     * @return
+     */
+    public Vec3D getVelocity() {
+        return sub(prev);
+    }
+
+    /**
+     * @return the weight
+     */
+    public final float getWeight() {
+        return weight;
+    }
+
+    /**
+     * @return true, if particle is locked
+     */
+    public final boolean isLocked() {
+        return isLocked;
+    }
+
+    /**
+     * Locks/immobilizes particle in space
+     * 
+     * @return itself
+     */
+    public VerletParticle3D lock() {
+        isLocked = true;
+        return this;
+    }
+
+    /**
+     *
+     * @param b
+     * @return
+     */
+    public boolean removeBehavior(ParticleBehavior3D b) {
+        return behaviors.remove(b);
+    }
+
+    /**
+     * Attempts to remove the given constraint instance from the list of active
+     * constraints.
+     * 
+     * @param c
+     *            constraint to remove
+     * @return true, if successfully removed
+     */
+    public boolean removeConstraint(ParticleConstraint3D c) {
+        return constraints.remove(c);
+    }
+
+    /**
+     *
+     * @param scl
+     * @return
+     */
+    public VerletParticle3D scaleVelocity(float scl) {
+        prev.interpolateToSelf(this, 1f - scl);
+        return this;
+    }
+
+    /**
+     *
+     * @param p
+     * @return
+     */
+    public VerletParticle3D setPreviousPosition(Vec3D p) {
+        prev.set(p);
+        return this;
+    }
+
+    /**
+     *
+     * @param w
+     */
+    public void setWeight(float w) {
+        weight = w;
+        invWeight = 1f / w;
+    }
+
+    /**
+     * Unlocks particle again
+     * 
+     * @return itself
+     */
+    public VerletParticle3D unlock() {
+        clearVelocity();
+        isLocked = false;
+        return this;
+    }
+
+    /**
+     *
+     */
+    public void update() {
+        if (!isLocked) {
+            applyBehaviors();
+            applyForce();
+            applyConstraints();
+        }
+    }
+}