159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta/* 259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * Copyright (c) 2009-2010 jMonkeyEngine 359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * All rights reserved. 459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * 559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * Redistribution and use in source and binary forms, with or without 659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * modification, are permitted provided that the following conditions are 759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * met: 859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * 959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * * Redistributions of source code must retain the above copyright 1059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * notice, this list of conditions and the following disclaimer. 1159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * 1259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * * Redistributions in binary form must reproduce the above copyright 1359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * notice, this list of conditions and the following disclaimer in the 1459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * documentation and/or other materials provided with the distribution. 1559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * 1659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * * Neither the name of 'jMonkeyEngine' nor the names of its contributors 1759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * may be used to endorse or promote products derived from this software 1859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * without specific prior written permission. 1959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * 2059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 2159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 2259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 2359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR 2459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 2559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 2659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR 2759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF 2859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 2959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 3059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 3159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta */ 3259b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartapackage com.jme3.bullet.joints; 3359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 3459b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.bullet.objects.PhysicsRigidBody; 3559b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.export.InputCapsule; 3659b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.export.JmeExporter; 3759b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.export.JmeImporter; 3859b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.export.OutputCapsule; 3959b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.math.Matrix3f; 4059b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.math.Vector3f; 4159b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport java.io.IOException; 4259b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport java.util.logging.Level; 4359b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport java.util.logging.Logger; 4459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 4559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta/** 4659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * <i>From bullet manual:</i><br> 4759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * To create ragdolls, the conve twist constraint is very useful for limbs like the upper arm. 4859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * It is a special point to point constraint that adds cone and twist axis limits. 4959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * The x-axis serves as twist axis. 5059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * @author normenhansen 5159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta */ 5259b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartapublic class ConeJoint extends PhysicsJoint { 5359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 5459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected Matrix3f rotA, rotB; 5559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected float swingSpan1 = 1e30f; 5659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected float swingSpan2 = 1e30f; 5759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected float twistSpan = 1e30f; 5859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected boolean angularOnly = false; 5959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 6059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public ConeJoint() { 6159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 6259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 6359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta /** 6459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * @param pivotA local translation of the joint connection point in node A 6559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * @param pivotB local translation of the joint connection point in node B 6659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta */ 6759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public ConeJoint(PhysicsRigidBody nodeA, PhysicsRigidBody nodeB, Vector3f pivotA, Vector3f pivotB) { 6859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta super(nodeA, nodeB, pivotA, pivotB); 6959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.rotA = new Matrix3f(); 7059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.rotB = new Matrix3f(); 7159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta createJoint(); 7259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 7359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 7459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta /** 7559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * @param pivotA local translation of the joint connection point in node A 7659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * @param pivotB local translation of the joint connection point in node B 7759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta */ 7859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public ConeJoint(PhysicsRigidBody nodeA, PhysicsRigidBody nodeB, Vector3f pivotA, Vector3f pivotB, Matrix3f rotA, Matrix3f rotB) { 7959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta super(nodeA, nodeB, pivotA, pivotB); 8059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.rotA = rotA; 8159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.rotB = rotB; 8259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta createJoint(); 8359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 8459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 8559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public void setLimit(float swingSpan1, float swingSpan2, float twistSpan) { 8659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.swingSpan1 = swingSpan1; 8759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.swingSpan2 = swingSpan2; 8859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.twistSpan = twistSpan; 8959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta setLimit(objectId, swingSpan1, swingSpan2, twistSpan); 9059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 9159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 9259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta private native void setLimit(long objectId, float swingSpan1, float swingSpan2, float twistSpan); 9359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 9459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public void setAngularOnly(boolean value) { 9559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta angularOnly = value; 9659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta setAngularOnly(objectId, value); 9759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 9859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 9959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta private native void setAngularOnly(long objectId, boolean value); 10059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 10159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta @Override 10259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public void write(JmeExporter ex) throws IOException { 10359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta super.write(ex); 10459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta OutputCapsule capsule = ex.getCapsule(this); 10559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(rotA, "rotA", new Matrix3f()); 10659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(rotB, "rotB", new Matrix3f()); 10759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 10859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(angularOnly, "angularOnly", false); 10959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(swingSpan1, "swingSpan1", 1e30f); 11059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(swingSpan2, "swingSpan2", 1e30f); 11159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(twistSpan, "twistSpan", 1e30f); 11259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 11359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 11459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta @Override 11559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public void read(JmeImporter im) throws IOException { 11659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta super.read(im); 11759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta InputCapsule capsule = im.getCapsule(this); 11859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.rotA = (Matrix3f) capsule.readSavable("rotA", new Matrix3f()); 11959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.rotB = (Matrix3f) capsule.readSavable("rotB", new Matrix3f()); 12059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 12159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.angularOnly = capsule.readBoolean("angularOnly", false); 12259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.swingSpan1 = capsule.readFloat("swingSpan1", 1e30f); 12359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.swingSpan2 = capsule.readFloat("swingSpan2", 1e30f); 12459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.twistSpan = capsule.readFloat("twistSpan", 1e30f); 12559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta createJoint(); 12659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 12759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 12859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected void createJoint() { 12959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta objectId = createJoint(nodeA.getObjectId(), nodeB.getObjectId(), pivotA, rotA, pivotB, rotB); 13059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta Logger.getLogger(this.getClass().getName()).log(Level.INFO, "Created Joint {0}", Long.toHexString(objectId)); 13159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta setLimit(objectId, swingSpan1, swingSpan2, twistSpan); 13259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta setAngularOnly(objectId, angularOnly); 13359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 13459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 13559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta private native long createJoint(long objectIdA, long objectIdB, Vector3f pivotA, Matrix3f rotA, Vector3f pivotB, Matrix3f rotB); 13659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta} 137