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.bulletphysics.dynamics.constraintsolver.HingeConstraint; 3559b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.bullet.objects.PhysicsRigidBody; 3659b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.bullet.util.Converter; 3759b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.export.InputCapsule; 3859b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.export.JmeExporter; 3959b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.export.JmeImporter; 4059b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.export.OutputCapsule; 4159b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport com.jme3.math.Vector3f; 4259b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartaimport java.io.IOException; 4359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 4459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta/** 4559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * <i>From bullet manual:</i><br> 4659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * Hinge constraint, or revolute joint restricts two additional angular degrees of freedom, 4759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * so the body can only rotate around one axis, the hinge axis. 4859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * This can be useful to represent doors or wheels rotating around one axis. 4959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * The user can specify limits and motor for the hinge. 5059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * @author normenhansen 5159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta */ 5259b2e6871c65f58fdad78cd7229c292f6a177578Scott Bartapublic class HingeJoint extends PhysicsJoint { 5359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 5459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected Vector3f axisA; 5559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected Vector3f axisB; 5659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected boolean angularOnly = false; 5759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected float biasFactor = 0.3f; 5859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected float relaxationFactor = 1.0f; 5959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected float limitSoftness = 0.9f; 6059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 6159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public HingeJoint() { 6259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 6359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 6459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta /** 6559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * Creates a new HingeJoint 6659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * @param pivotA local translation of the joint connection point in node A 6759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta * @param pivotB local translation of the joint connection point in node B 6859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta */ 6959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public HingeJoint(PhysicsRigidBody nodeA, PhysicsRigidBody nodeB, Vector3f pivotA, Vector3f pivotB, Vector3f axisA, Vector3f axisB) { 7059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta super(nodeA, nodeB, pivotA, pivotB); 7159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.axisA = axisA; 7259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.axisB = axisB; 7359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta createJoint(); 7459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 7559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 7659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public void enableMotor(boolean enable, float targetVelocity, float maxMotorImpulse) { 7759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta ((HingeConstraint) constraint).enableAngularMotor(enable, targetVelocity, maxMotorImpulse); 7859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 7959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 8059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public void setLimit(float low, float high) { 8159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta ((HingeConstraint) constraint).setLimit(low, high); 8259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 8359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 8459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public void setLimit(float low, float high, float _softness, float _biasFactor, float _relaxationFactor) { 8559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta biasFactor = _biasFactor; 8659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta relaxationFactor = _relaxationFactor; 8759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta limitSoftness = _softness; 8859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta ((HingeConstraint) constraint).setLimit(low, high, _softness, _biasFactor, _relaxationFactor); 8959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 9059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 9159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public float getUpperLimit(){ 9259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta return ((HingeConstraint) constraint).getUpperLimit(); 9359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 9459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 9559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public float getLowerLimit(){ 9659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta return ((HingeConstraint) constraint).getLowerLimit(); 9759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 9859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 9959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public void setAngularOnly(boolean angularOnly) { 10059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.angularOnly = angularOnly; 10159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta ((HingeConstraint) constraint).setAngularOnly(angularOnly); 10259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 10359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 10459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public float getHingeAngle() { 10559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta return ((HingeConstraint) constraint).getHingeAngle(); 10659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 10759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 10859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public void write(JmeExporter ex) throws IOException { 10959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta super.write(ex); 11059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta OutputCapsule capsule = ex.getCapsule(this); 11159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(axisA, "axisA", new Vector3f()); 11259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(axisB, "axisB", new Vector3f()); 11359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 11459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(angularOnly, "angularOnly", false); 11559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 11659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(((HingeConstraint) constraint).getLowerLimit(), "lowerLimit", 1e30f); 11759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(((HingeConstraint) constraint).getUpperLimit(), "upperLimit", -1e30f); 11859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 11959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(biasFactor, "biasFactor", 0.3f); 12059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(relaxationFactor, "relaxationFactor", 1f); 12159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(limitSoftness, "limitSoftness", 0.9f); 12259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 12359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(((HingeConstraint) constraint).getEnableAngularMotor(), "enableAngularMotor", false); 12459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(((HingeConstraint) constraint).getMotorTargetVelosity(), "targetVelocity", 0.0f); 12559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta capsule.write(((HingeConstraint) constraint).getMaxMotorImpulse(), "maxMotorImpulse", 0.0f); 12659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 12759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 12859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta public void read(JmeImporter im) throws IOException { 12959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta super.read(im); 13059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta InputCapsule capsule = im.getCapsule(this); 13159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.axisA = (Vector3f) capsule.readSavable("axisA", new Vector3f()); 13259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.axisB = (Vector3f) capsule.readSavable("axisB", new Vector3f()); 13359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 13459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.angularOnly = capsule.readBoolean("angularOnly", false); 13559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta float lowerLimit = capsule.readFloat("lowerLimit", 1e30f); 13659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta float upperLimit = capsule.readFloat("upperLimit", -1e30f); 13759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 13859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.biasFactor = capsule.readFloat("biasFactor", 0.3f); 13959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.relaxationFactor = capsule.readFloat("relaxationFactor", 1f); 14059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta this.limitSoftness = capsule.readFloat("limitSoftness", 0.9f); 14159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 14259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta boolean enableAngularMotor=capsule.readBoolean("enableAngularMotor", false); 14359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta float targetVelocity=capsule.readFloat("targetVelocity", 0.0f); 14459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta float maxMotorImpulse=capsule.readFloat("maxMotorImpulse", 0.0f); 14559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 14659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta createJoint(); 14759b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta enableMotor(enableAngularMotor, targetVelocity, maxMotorImpulse); 14859b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta ((HingeConstraint) constraint).setLimit(lowerLimit, upperLimit, limitSoftness, biasFactor, relaxationFactor); 14959b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 15059b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta 15159b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta protected void createJoint() { 15259b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta constraint = new HingeConstraint(nodeA.getObjectId(), nodeB.getObjectId(), 15359b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta Converter.convert(pivotA), Converter.convert(pivotB), 15459b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta Converter.convert(axisA), Converter.convert(axisB)); 15559b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta } 15659b2e6871c65f58fdad78cd7229c292f6a177578Scott Barta} 157