Examples with RevoluteJoint spacegraph.space2d.phys.dynamics.joints.RevoluteJoint used on opensource projects

Example 1 with RevoluteJoint

use of spacegraph.space2d.phys.dynamics.joints.RevoluteJoint in project narchy by automenta.

the class Snake method attach.

/**
 * attach a body to center of one of the segments
 */
public void attach(Body2D b, int segment) {
    Dynamics2D world = world();
    world.invoke(() -> {
        RevoluteJoint w = (RevoluteJoint) b.W.addJoint(new RevoluteJointDef(bodies.get(segment), b));
        attachments.add(b);
        joints.add(w);
    });
}

Example 2 with RevoluteJoint

use of spacegraph.space2d.phys.dynamics.joints.RevoluteJoint in project narchy by automenta.

the class TensorGlow method main.

public static void main(String[] args) {
    PhyWall p = SpaceGraph.wall(1200, 1000);
    p.W.setGravity(new v2(0, -2.8f));
    staticBox(p.W, -5, -8, +5, 2f, false, true, true, true);
    for (int j = 0; j < 3; j++) {
        BodyDef bodyDef2 = new BodyDef();
        bodyDef2.type = BodyType.DYNAMIC;
        // otocenie
        bodyDef2.angle = -0.6f;
        // smer pohybu
        bodyDef2.linearVelocity = new v2(0.0f, 0.0f);
        // rotacia (rychlost rotacie)
        bodyDef2.angularVelocity = 0.0f;
        Body2D newBody = p.W.addBody(bodyDef2);
        PolygonShape shape2 = new PolygonShape();
        shape2.setAsBox(0.25f, 0.25f);
        Fixture f = newBody.addFixture(shape2, 1.0f);
        // trenie
        f.friction = 0.5f;
        // odrazivost
        f.restitution = 0.0f;
        f.material = new Uniform();
        f.material.m_rigidity = 1.0f;
    }
    // //ceiling rack
    // addBox(p.W, -1, +0.4f, 0, +0.65f, false, true, true, true);
    // new Pacman(p.W);
    {
        p.W.setContactListener(new Explosives.ExplosionContacts());
        TheoJansen t = new TheoJansen(p.W, 0.35f);
        PhyWall.PhyWindow pw = p.put(new Gridding(0.5f, new Port((float[] v) -> {
            // System.out.println(v);
            t.motorJoint.setMotorSpeed(v[0] * 2 - v[1] * 2);
            t.motorJoint.setMaxMotorTorque(v[2]);
            t.motorJoint.enableLimit(true);
            t.motorJoint.setLimits((float) (-v[3] * Math.PI), (float) (+v[4] * Math.PI));
            if (v[5] > 0.5f) {
                t.gun.fire();
            }
            t.turretJoint.setLimits((float) (+Math.PI / 2 + v[6] * Math.PI - 0.1f), (float) (+Math.PI / 2 + v[6] * Math.PI + 0.1f));
        })), 0.8f, 0.4f);
        p.W.addJoint(new RevoluteJoint(p.W, new RevoluteJointDef(pw.body, t.chassis)));
    }
    {
        p.W.setParticleRadius(0.05f);
        p.W.setParticleDamping(0.1f);
        CircleShape shape = new CircleShape();
        shape.center.set(0, 10);
        shape.radius = 2f;
        ParticleGroupDef pd = new ParticleGroupDef();
        pd.flags = ParticleType.b2_waterParticle;
        // b2_viscousParticle;
        // b2_elasticParticle;
        // b2_springParticle;
        // b2_powderParticle;
        pd.color = new ParticleColor(0.7f, 0.1f, 0.1f, 0.8f);
        pd.shape = shape;
        p.W.addParticles(pd);
    }
    HaiQae q = new HaiQae(8, 2);
    float[] in = new float[q.ae.inputs()];
    final Tensor randomVector = Tensor.randomVectorGauss(in.length, 0, 1, rng);
    final FloatRange lerpRate = new FloatRange(0.01f, 0, 1f);
    final TensorLERP lerpVector = new TensorLERP(randomVector, lerpRate);
    PhyWall.PhyWindow w = p.put(new Gridding(0.25f, new AutoUpdateMatrixView(lerpVector.data), new LabeledPane("lerp", new XYSlider().on((x, y) -> {
        lerpRate.set(x);
    })), new LabeledPane("out", new Port((x) -> {
    }) {

        @Override
        public void prePaint(int dtMS) {
            super.prePaint(dtMS);
            out(lerpVector.data);
        }
    })), 0.5f, 0.5f);
    p.put(new TogglePort(), 0.25f, 0.25f);
    PhyWall.PhyWindow qw = p.put(new Gridding(new Label("HaiQ"), new AutoSurface<>(q), new LabeledPane("input", new Port((float[] i) -> {
        System.arraycopy(i, 0, in, 0, i.length);
    })), new Gridding(VERTICAL, new AutoUpdateMatrixView(in), new AutoUpdateMatrixView(q.ae.x), new AutoUpdateMatrixView(q.ae.W), new AutoUpdateMatrixView(q.ae.y)), new Gridding(VERTICAL, new AutoUpdateMatrixView(q.q), new AutoUpdateMatrixView(q.et))), 1, 1);
    Loop.of(() -> {
        lerpVector.update();
        q.act((((float) Math.random()) - 0.5f) * 2, in);
    }).runFPS(25);
}

Example 3 with RevoluteJoint

use of spacegraph.space2d.phys.dynamics.joints.RevoluteJoint in project narchy by automenta.

the class Vehicle2D method onUpdate.

public void onUpdate(final float pSecondsElapsed) {
    // Driving
    updateDrive();
    // control steering
    float lockAngle = 35f * DEGTORAD;
    // from lock to lock in 0.5 sec
    float turnSpeedPerSec = 160f * DEGTORAD;
    float turnPerTimeStep = turnSpeedPerSec / 60.0f;
    float desiredAngle = 0f;
    switch(steer) {
        case STEER_LEFT:
            desiredAngle = -lockAngle;
            break;
        case STEER_RIGHT:
            desiredAngle = lockAngle;
            break;
        default:
            // nothing
            ;
    }
    RevoluteJoint leftJoint = (RevoluteJoint) leftFront.getJoint();
    RevoluteJoint rightJoint = (RevoluteJoint) rightFront.getJoint();
    float angleNow = leftJoint.getJointAngle();
    float angleToTurn = desiredAngle - angleNow;
    angleToTurn = b2Clamp(angleToTurn, -turnPerTimeStep, turnPerTimeStep);
    float newAngle = angleNow + angleToTurn;
    leftJoint.setLimits(newAngle, newAngle);
    rightJoint.setLimits(newAngle, newAngle);
}

Example 4 with RevoluteJoint

use of spacegraph.space2d.phys.dynamics.joints.RevoluteJoint in project narchy by automenta.

the class TheoJansenTest method init.

// @Override
// public Long getTag(Body2D argBody) {
// if (argBody2D == m_chassis) {
// return CHASSIS_TAG;
// } else if (argBody2D == m_wheel) {
// return WHEEL_TAG;
// }
// return null;
// }
// 
// @Override
// public Long getTag(Joint argJoint) {
// if (argJoint == m_motorJoint) {
// return MOTOR_TAG;
// }
// return null;
// }
// @Override
// public void processBody(Body2D argBody, Long argTag) {
// if (argTag == CHASSIS_TAG) {
// m_chassis = argBody;
// } else if (argTag == WHEEL_TAG) {
// m_wheel = argBody;
// }
// }
// 
// @Override
// public void processJoint(Joint argJoint, Long argTag) {
// if (argTag == MOTOR_TAG) {
// m_motorJoint = (RevoluteJoint) argJoint;
// m_motorOn = m_motorJoint.isMotorEnabled();
// }
// }
@Override
public void init(Dynamics2D w) {
    this.w = w;
    m_offset.set(0.0f, 8.0f);
    m_motorSpeed = 2.0f;
    m_motorOn = true;
    v2 pivot = new v2(0.0f, 0.8f);
    // Ground
    {
        BodyDef bd = new BodyDef();
        Body2D ground = w.addBody(bd);
        EdgeShape shape = new EdgeShape();
        shape.set(new v2(-50.0f, 0.0f), new v2(50.0f, 0.0f));
        ground.addFixture(shape, 0.0f);
        shape.set(new v2(-50.0f, 0.0f), new v2(-50.0f, 10.0f));
        ground.addFixture(shape, 0.0f);
        shape.set(new v2(50.0f, 0.0f), new v2(50.0f, 10.0f));
        ground.addFixture(shape, 0.0f);
    }
    // Balls
    for (int i = 0; i < 40; ++i) {
        CircleShape shape = new CircleShape();
        shape.radius = 0.25f;
        BodyDef bd = new BodyDef();
        bd.type = BodyType.DYNAMIC;
        bd.position.set(-40.0f + 2.0f * i, 0.5f);
        Body2D body = w.addBody(bd);
        body.addFixture(shape, 1.0f);
    }
    // Chassis
    {
        PolygonShape shape = new PolygonShape();
        shape.setAsBox(2.5f, 1.0f);
        FixtureDef sd = new FixtureDef();
        sd.density = 1.0f;
        sd.shape = shape;
        sd.filter.groupIndex = -1;
        BodyDef bd = new BodyDef();
        bd.type = BodyType.DYNAMIC;
        bd.position.set(pivot).added(m_offset);
        m_chassis = w.addBody(bd);
        m_chassis.addFixture(sd);
    }
    {
        CircleShape shape = new CircleShape();
        shape.radius = 1.6f;
        FixtureDef sd = new FixtureDef();
        sd.density = 1.0f;
        sd.shape = shape;
        sd.filter.groupIndex = -1;
        BodyDef bd = new BodyDef();
        bd.type = BodyType.DYNAMIC;
        bd.position.set(pivot).added(m_offset);
        m_wheel = w.addBody(bd);
        m_wheel.addFixture(sd);
    }
    {
        RevoluteJointDef jd = new RevoluteJointDef();
        jd.initialize(m_wheel, m_chassis, pivot.add(m_offset));
        jd.collideConnected = false;
        jd.motorSpeed = m_motorSpeed;
        jd.maxMotorTorque = 400.0f;
        jd.enableMotor = m_motorOn;
        m_motorJoint = (RevoluteJoint) w.addJoint(jd);
    }
    v2 wheelAnchor;
    wheelAnchor = pivot.add(new v2(0.0f, -0.8f));
    createLeg(-1.0f, wheelAnchor);
    createLeg(1.0f, wheelAnchor);
    m_wheel.setTransform(m_wheel.getPosition(), 120.0f * MathUtils.PI / 180.0f);
    createLeg(-1.0f, wheelAnchor);
    createLeg(1.0f, wheelAnchor);
    m_wheel.setTransform(m_wheel.getPosition(), -120.0f * MathUtils.PI / 180.0f);
    createLeg(-1.0f, wheelAnchor);
    createLeg(1.0f, wheelAnchor);
}