FrictionJoint.smali
.class public Lorg/jbox2d/dynamics/joints/FrictionJoint;
.super Lorg/jbox2d/dynamics/joints/Joint;
.source "FrictionJoint.java"
# static fields
.field static final synthetic $assertionsDisabled:Z
# instance fields
.field private m_angularImpulse:F
.field private m_angularMass:F
.field private m_indexA:I
.field private m_indexB:I
.field private m_invIA:F
.field private m_invIB:F
.field private m_invMassA:F
.field private m_invMassB:F
.field private final m_linearImpulse:Lorg/jbox2d/common/Vec2;
.field private final m_linearMass:Lorg/jbox2d/common/Mat22;
.field private final m_localAnchorA:Lorg/jbox2d/common/Vec2;
.field private final m_localAnchorB:Lorg/jbox2d/common/Vec2;
.field private final m_localCenterA:Lorg/jbox2d/common/Vec2;
.field private final m_localCenterB:Lorg/jbox2d/common/Vec2;
.field private m_maxForce:F
.field private m_maxTorque:F
.field private final m_rA:Lorg/jbox2d/common/Vec2;
.field private final m_rB:Lorg/jbox2d/common/Vec2;
# direct methods
.method static constructor <clinit>()V
.registers 1
.prologue
.line 39
const-class v0, Lorg/jbox2d/dynamics/joints/FrictionJoint;
invoke-virtual {v0}, Ljava/lang/Class;->desiredAssertionStatus()Z
move-result v0
if-nez v0, :cond_c
const/4 v0, 0x1
:goto_9
sput-boolean v0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->$assertionsDisabled:Z
return-void
:cond_c
const/4 v0, 0x0
goto :goto_9
.end method
.method protected constructor <init>(Lorg/jbox2d/pooling/IWorldPool;Lorg/jbox2d/dynamics/joints/FrictionJointDef;)V
.registers 5
.prologue
.line 65
invoke-direct {p0, p1, p2}, Lorg/jbox2d/dynamics/joints/Joint;-><init>(Lorg/jbox2d/pooling/IWorldPool;Lorg/jbox2d/dynamics/joints/JointDef;)V
.line 53
new-instance v0, Lorg/jbox2d/common/Vec2;
invoke-direct {v0}, Lorg/jbox2d/common/Vec2;-><init>()V
iput-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rA:Lorg/jbox2d/common/Vec2;
.line 54
new-instance v0, Lorg/jbox2d/common/Vec2;
invoke-direct {v0}, Lorg/jbox2d/common/Vec2;-><init>()V
iput-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rB:Lorg/jbox2d/common/Vec2;
.line 55
new-instance v0, Lorg/jbox2d/common/Vec2;
invoke-direct {v0}, Lorg/jbox2d/common/Vec2;-><init>()V
iput-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localCenterA:Lorg/jbox2d/common/Vec2;
.line 56
new-instance v0, Lorg/jbox2d/common/Vec2;
invoke-direct {v0}, Lorg/jbox2d/common/Vec2;-><init>()V
iput-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localCenterB:Lorg/jbox2d/common/Vec2;
.line 61
new-instance v0, Lorg/jbox2d/common/Mat22;
invoke-direct {v0}, Lorg/jbox2d/common/Mat22;-><init>()V
iput-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearMass:Lorg/jbox2d/common/Mat22;
.line 66
new-instance v0, Lorg/jbox2d/common/Vec2;
iget-object v1, p2, Lorg/jbox2d/dynamics/joints/FrictionJointDef;->localAnchorA:Lorg/jbox2d/common/Vec2;
invoke-direct {v0, v1}, Lorg/jbox2d/common/Vec2;-><init>(Lorg/jbox2d/common/Vec2;)V
iput-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localAnchorA:Lorg/jbox2d/common/Vec2;
.line 67
new-instance v0, Lorg/jbox2d/common/Vec2;
iget-object v1, p2, Lorg/jbox2d/dynamics/joints/FrictionJointDef;->localAnchorB:Lorg/jbox2d/common/Vec2;
invoke-direct {v0, v1}, Lorg/jbox2d/common/Vec2;-><init>(Lorg/jbox2d/common/Vec2;)V
iput-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localAnchorB:Lorg/jbox2d/common/Vec2;
.line 69
new-instance v0, Lorg/jbox2d/common/Vec2;
invoke-direct {v0}, Lorg/jbox2d/common/Vec2;-><init>()V
iput-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearImpulse:Lorg/jbox2d/common/Vec2;
.line 70
const/4 v0, 0x0
iput v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularImpulse:F
.line 72
iget v0, p2, Lorg/jbox2d/dynamics/joints/FrictionJointDef;->maxForce:F
iput v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_maxForce:F
.line 73
iget v0, p2, Lorg/jbox2d/dynamics/joints/FrictionJointDef;->maxTorque:F
iput v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_maxTorque:F
.line 74
return-void
.end method
# virtual methods
.method public getAnchorA(Lorg/jbox2d/common/Vec2;)V
.registers 4
.prologue
.line 86
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_bodyA:Lorg/jbox2d/dynamics/Body;
iget-object v1, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localAnchorA:Lorg/jbox2d/common/Vec2;
invoke-virtual {v0, v1, p1}, Lorg/jbox2d/dynamics/Body;->getWorldPointToOut(Lorg/jbox2d/common/Vec2;Lorg/jbox2d/common/Vec2;)V
.line 87
return-void
.end method
.method public getAnchorB(Lorg/jbox2d/common/Vec2;)V
.registers 4
.prologue
.line 91
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_bodyB:Lorg/jbox2d/dynamics/Body;
iget-object v1, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localAnchorB:Lorg/jbox2d/common/Vec2;
invoke-virtual {v0, v1, p1}, Lorg/jbox2d/dynamics/Body;->getWorldPointToOut(Lorg/jbox2d/common/Vec2;Lorg/jbox2d/common/Vec2;)V
.line 92
return-void
.end method
.method public getLocalAnchorA()Lorg/jbox2d/common/Vec2;
.registers 2
.prologue
.line 77
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localAnchorA:Lorg/jbox2d/common/Vec2;
return-object v0
.end method
.method public getLocalAnchorB()Lorg/jbox2d/common/Vec2;
.registers 2
.prologue
.line 81
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localAnchorB:Lorg/jbox2d/common/Vec2;
return-object v0
.end method
.method public getMaxForce()F
.registers 2
.prologue
.line 110
iget v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_maxForce:F
return v0
.end method
.method public getMaxTorque()F
.registers 2
.prologue
.line 119
iget v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_maxTorque:F
return v0
.end method
.method public getReactionForce(FLorg/jbox2d/common/Vec2;)V
.registers 4
.prologue
.line 96
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearImpulse:Lorg/jbox2d/common/Vec2;
invoke-virtual {p2, v0}, Lorg/jbox2d/common/Vec2;->set(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
move-result-object v0
invoke-virtual {v0, p1}, Lorg/jbox2d/common/Vec2;->mulLocal(F)Lorg/jbox2d/common/Vec2;
.line 97
return-void
.end method
.method public getReactionTorque(F)F
.registers 3
.prologue
.line 101
iget v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularImpulse:F
mul-float/2addr v0, p1
return v0
.end method
.method public initVelocityConstraints(Lorg/jbox2d/dynamics/SolverData;)V
.registers 16
.prologue
.line 127
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_bodyA:Lorg/jbox2d/dynamics/Body;
iget v0, v0, Lorg/jbox2d/dynamics/Body;->m_islandIndex:I
iput v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexA:I
.line 128
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_bodyB:Lorg/jbox2d/dynamics/Body;
iget v0, v0, Lorg/jbox2d/dynamics/Body;->m_islandIndex:I
iput v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexB:I
.line 129
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localCenterA:Lorg/jbox2d/common/Vec2;
iget-object v1, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_bodyA:Lorg/jbox2d/dynamics/Body;
iget-object v1, v1, Lorg/jbox2d/dynamics/Body;->m_sweep:Lorg/jbox2d/common/Sweep;
iget-object v1, v1, Lorg/jbox2d/common/Sweep;->localCenter:Lorg/jbox2d/common/Vec2;
invoke-virtual {v0, v1}, Lorg/jbox2d/common/Vec2;->set(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
.line 130
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localCenterB:Lorg/jbox2d/common/Vec2;
iget-object v1, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_bodyB:Lorg/jbox2d/dynamics/Body;
iget-object v1, v1, Lorg/jbox2d/dynamics/Body;->m_sweep:Lorg/jbox2d/common/Sweep;
iget-object v1, v1, Lorg/jbox2d/common/Sweep;->localCenter:Lorg/jbox2d/common/Vec2;
invoke-virtual {v0, v1}, Lorg/jbox2d/common/Vec2;->set(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
.line 131
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_bodyA:Lorg/jbox2d/dynamics/Body;
iget v0, v0, Lorg/jbox2d/dynamics/Body;->m_invMass:F
iput v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_invMassA:F
.line 132
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_bodyB:Lorg/jbox2d/dynamics/Body;
iget v0, v0, Lorg/jbox2d/dynamics/Body;->m_invMass:F
iput v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_invMassB:F
.line 133
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_bodyA:Lorg/jbox2d/dynamics/Body;
iget v0, v0, Lorg/jbox2d/dynamics/Body;->m_invI:F
iput v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_invIA:F
.line 134
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_bodyB:Lorg/jbox2d/dynamics/Body;
iget v0, v0, Lorg/jbox2d/dynamics/Body;->m_invI:F
iput v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_invIB:F
.line 136
iget-object v0, p1, Lorg/jbox2d/dynamics/SolverData;->positions:[Lorg/jbox2d/dynamics/contacts/Position;
iget v1, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexA:I
aget-object v0, v0, v1
iget v2, v0, Lorg/jbox2d/dynamics/contacts/Position;->a:F
.line 137
iget-object v0, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v1, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexA:I
aget-object v0, v0, v1
iget-object v3, v0, Lorg/jbox2d/dynamics/contacts/Velocity;->v:Lorg/jbox2d/common/Vec2;
.line 138
iget-object v0, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v1, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexA:I
aget-object v0, v0, v1
iget v1, v0, Lorg/jbox2d/dynamics/contacts/Velocity;->w:F
.line 140
iget-object v0, p1, Lorg/jbox2d/dynamics/SolverData;->positions:[Lorg/jbox2d/dynamics/contacts/Position;
iget v4, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexB:I
aget-object v0, v0, v4
iget v4, v0, Lorg/jbox2d/dynamics/contacts/Position;->a:F
.line 141
iget-object v0, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v5, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexB:I
aget-object v0, v0, v5
iget-object v5, v0, Lorg/jbox2d/dynamics/contacts/Velocity;->v:Lorg/jbox2d/common/Vec2;
.line 142
iget-object v0, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v6, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexB:I
aget-object v0, v0, v6
iget v0, v0, Lorg/jbox2d/dynamics/contacts/Velocity;->w:F
.line 145
iget-object v6, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
invoke-interface {v6}, Lorg/jbox2d/pooling/IWorldPool;->popVec2()Lorg/jbox2d/common/Vec2;
move-result-object v6
.line 146
iget-object v7, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
invoke-interface {v7}, Lorg/jbox2d/pooling/IWorldPool;->popRot()Lorg/jbox2d/common/Rot;
move-result-object v7
.line 147
iget-object v8, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
invoke-interface {v8}, Lorg/jbox2d/pooling/IWorldPool;->popRot()Lorg/jbox2d/common/Rot;
move-result-object v8
.line 149
invoke-virtual {v7, v2}, Lorg/jbox2d/common/Rot;->set(F)Lorg/jbox2d/common/Rot;
.line 150
invoke-virtual {v8, v4}, Lorg/jbox2d/common/Rot;->set(F)Lorg/jbox2d/common/Rot;
.line 153
iget-object v2, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localAnchorA:Lorg/jbox2d/common/Vec2;
invoke-virtual {v6, v2}, Lorg/jbox2d/common/Vec2;->set(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
move-result-object v2
iget-object v4, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localCenterA:Lorg/jbox2d/common/Vec2;
invoke-virtual {v2, v4}, Lorg/jbox2d/common/Vec2;->subLocal(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
move-result-object v2
iget-object v4, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rA:Lorg/jbox2d/common/Vec2;
invoke-static {v7, v2, v4}, Lorg/jbox2d/common/Rot;->mulToOutUnsafe(Lorg/jbox2d/common/Rot;Lorg/jbox2d/common/Vec2;Lorg/jbox2d/common/Vec2;)V
.line 154
iget-object v2, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localAnchorB:Lorg/jbox2d/common/Vec2;
invoke-virtual {v6, v2}, Lorg/jbox2d/common/Vec2;->set(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
move-result-object v2
iget-object v4, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_localCenterB:Lorg/jbox2d/common/Vec2;
invoke-virtual {v2, v4}, Lorg/jbox2d/common/Vec2;->subLocal(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
move-result-object v2
iget-object v4, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rB:Lorg/jbox2d/common/Vec2;
invoke-static {v8, v2, v4}, Lorg/jbox2d/common/Rot;->mulToOutUnsafe(Lorg/jbox2d/common/Rot;Lorg/jbox2d/common/Vec2;Lorg/jbox2d/common/Vec2;)V
.line 165
iget v2, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_invMassA:F
iget v4, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_invMassB:F
.line 166
iget v7, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_invIA:F
iget v8, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_invIB:F
.line 168
iget-object v9, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
invoke-interface {v9}, Lorg/jbox2d/pooling/IWorldPool;->popMat22()Lorg/jbox2d/common/Mat22;
move-result-object v9
.line 169
iget-object v10, v9, Lorg/jbox2d/common/Mat22;->ex:Lorg/jbox2d/common/Vec2;
add-float v11, v2, v4
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rA:Lorg/jbox2d/common/Vec2;
iget v12, v12, Lorg/jbox2d/common/Vec2;->y:F
mul-float/2addr v12, v7
iget-object v13, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rA:Lorg/jbox2d/common/Vec2;
iget v13, v13, Lorg/jbox2d/common/Vec2;->y:F
mul-float/2addr v12, v13
add-float/2addr v11, v12
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rB:Lorg/jbox2d/common/Vec2;
iget v12, v12, Lorg/jbox2d/common/Vec2;->y:F
mul-float/2addr v12, v8
iget-object v13, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rB:Lorg/jbox2d/common/Vec2;
iget v13, v13, Lorg/jbox2d/common/Vec2;->y:F
mul-float/2addr v12, v13
add-float/2addr v11, v12
iput v11, v10, Lorg/jbox2d/common/Vec2;->x:F
.line 170
iget-object v10, v9, Lorg/jbox2d/common/Mat22;->ex:Lorg/jbox2d/common/Vec2;
neg-float v11, v7
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rA:Lorg/jbox2d/common/Vec2;
iget v12, v12, Lorg/jbox2d/common/Vec2;->x:F
mul-float/2addr v11, v12
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rA:Lorg/jbox2d/common/Vec2;
iget v12, v12, Lorg/jbox2d/common/Vec2;->y:F
mul-float/2addr v11, v12
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rB:Lorg/jbox2d/common/Vec2;
iget v12, v12, Lorg/jbox2d/common/Vec2;->x:F
mul-float/2addr v12, v8
iget-object v13, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rB:Lorg/jbox2d/common/Vec2;
iget v13, v13, Lorg/jbox2d/common/Vec2;->y:F
mul-float/2addr v12, v13
sub-float/2addr v11, v12
iput v11, v10, Lorg/jbox2d/common/Vec2;->y:F
.line 171
iget-object v10, v9, Lorg/jbox2d/common/Mat22;->ey:Lorg/jbox2d/common/Vec2;
iget-object v11, v9, Lorg/jbox2d/common/Mat22;->ex:Lorg/jbox2d/common/Vec2;
iget v11, v11, Lorg/jbox2d/common/Vec2;->y:F
iput v11, v10, Lorg/jbox2d/common/Vec2;->x:F
.line 172
iget-object v10, v9, Lorg/jbox2d/common/Mat22;->ey:Lorg/jbox2d/common/Vec2;
add-float v11, v2, v4
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rA:Lorg/jbox2d/common/Vec2;
iget v12, v12, Lorg/jbox2d/common/Vec2;->x:F
mul-float/2addr v12, v7
iget-object v13, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rA:Lorg/jbox2d/common/Vec2;
iget v13, v13, Lorg/jbox2d/common/Vec2;->x:F
mul-float/2addr v12, v13
add-float/2addr v11, v12
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rB:Lorg/jbox2d/common/Vec2;
iget v12, v12, Lorg/jbox2d/common/Vec2;->x:F
mul-float/2addr v12, v8
iget-object v13, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rB:Lorg/jbox2d/common/Vec2;
iget v13, v13, Lorg/jbox2d/common/Vec2;->x:F
mul-float/2addr v12, v13
add-float/2addr v11, v12
iput v11, v10, Lorg/jbox2d/common/Vec2;->y:F
.line 174
iget-object v10, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearMass:Lorg/jbox2d/common/Mat22;
invoke-virtual {v9, v10}, Lorg/jbox2d/common/Mat22;->invertToOut(Lorg/jbox2d/common/Mat22;)V
.line 176
add-float v9, v7, v8
iput v9, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularMass:F
.line 177
iget v9, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularMass:F
const/4 v10, 0x0
cmpl-float v9, v9, v10
if-lez v9, :cond_123
.line 178
const/high16 v9, 0x3f800000 # 1.0f
iget v10, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularMass:F
div-float/2addr v9, v10
iput v9, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularMass:F
.line 181
:cond_123
iget-object v9, p1, Lorg/jbox2d/dynamics/SolverData;->step:Lorg/jbox2d/dynamics/TimeStep;
iget-boolean v9, v9, Lorg/jbox2d/dynamics/TimeStep;->warmStarting:Z
if-eqz v9, :cond_198
.line 183
iget-object v9, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearImpulse:Lorg/jbox2d/common/Vec2;
iget-object v10, p1, Lorg/jbox2d/dynamics/SolverData;->step:Lorg/jbox2d/dynamics/TimeStep;
iget v10, v10, Lorg/jbox2d/dynamics/TimeStep;->dtRatio:F
invoke-virtual {v9, v10}, Lorg/jbox2d/common/Vec2;->mulLocal(F)Lorg/jbox2d/common/Vec2;
.line 184
iget v9, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularImpulse:F
iget-object v10, p1, Lorg/jbox2d/dynamics/SolverData;->step:Lorg/jbox2d/dynamics/TimeStep;
iget v10, v10, Lorg/jbox2d/dynamics/TimeStep;->dtRatio:F
mul-float/2addr v9, v10
iput v9, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularImpulse:F
.line 186
iget-object v9, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
invoke-interface {v9}, Lorg/jbox2d/pooling/IWorldPool;->popVec2()Lorg/jbox2d/common/Vec2;
move-result-object v9
.line 187
iget-object v10, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearImpulse:Lorg/jbox2d/common/Vec2;
invoke-virtual {v9, v10}, Lorg/jbox2d/common/Vec2;->set(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
.line 189
invoke-virtual {v6, v9}, Lorg/jbox2d/common/Vec2;->set(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
move-result-object v10
invoke-virtual {v10, v2}, Lorg/jbox2d/common/Vec2;->mulLocal(F)Lorg/jbox2d/common/Vec2;
.line 190
invoke-virtual {v3, v6}, Lorg/jbox2d/common/Vec2;->subLocal(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
.line 191
iget-object v2, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rA:Lorg/jbox2d/common/Vec2;
invoke-static {v2, v9}, Lorg/jbox2d/common/Vec2;->cross(Lorg/jbox2d/common/Vec2;Lorg/jbox2d/common/Vec2;)F
move-result v2
iget v3, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularImpulse:F
add-float/2addr v2, v3
mul-float/2addr v2, v7
sub-float/2addr v1, v2
.line 193
invoke-virtual {v6, v9}, Lorg/jbox2d/common/Vec2;->set(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
move-result-object v2
invoke-virtual {v2, v4}, Lorg/jbox2d/common/Vec2;->mulLocal(F)Lorg/jbox2d/common/Vec2;
.line 194
invoke-virtual {v5, v6}, Lorg/jbox2d/common/Vec2;->addLocal(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
.line 195
iget-object v2, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rB:Lorg/jbox2d/common/Vec2;
invoke-static {v2, v9}, Lorg/jbox2d/common/Vec2;->cross(Lorg/jbox2d/common/Vec2;Lorg/jbox2d/common/Vec2;)F
move-result v2
iget v3, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularImpulse:F
add-float/2addr v2, v3
mul-float/2addr v2, v8
add-float/2addr v0, v2
.line 197
iget-object v2, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
const/4 v3, 0x1
invoke-interface {v2, v3}, Lorg/jbox2d/pooling/IWorldPool;->pushVec2(I)V
.line 203
:goto_176
iget-object v2, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v3, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexA:I
aget-object v2, v2, v3
iget v2, v2, Lorg/jbox2d/dynamics/contacts/Velocity;->w:F
cmpl-float v2, v2, v1
if-eqz v2, :cond_1a1
.line 204
sget-boolean v2, Lorg/jbox2d/dynamics/joints/FrictionJoint;->$assertionsDisabled:Z
if-nez v2, :cond_1a1
iget-object v2, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v3, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexA:I
aget-object v2, v2, v3
iget v2, v2, Lorg/jbox2d/dynamics/contacts/Velocity;->w:F
cmpl-float v2, v2, v1
if-nez v2, :cond_1a1
new-instance v0, Ljava/lang/AssertionError;
invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V
throw v0
.line 199
:cond_198
iget-object v2, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearImpulse:Lorg/jbox2d/common/Vec2;
invoke-virtual {v2}, Lorg/jbox2d/common/Vec2;->setZero()V
.line 200
const/4 v2, 0x0
iput v2, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularImpulse:F
goto :goto_176
.line 206
:cond_1a1
iget-object v2, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v3, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexA:I
aget-object v2, v2, v3
iput v1, v2, Lorg/jbox2d/dynamics/contacts/Velocity;->w:F
.line 208
iget-object v1, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v2, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexB:I
aget-object v1, v1, v2
iput v0, v1, Lorg/jbox2d/dynamics/contacts/Velocity;->w:F
.line 210
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
const/4 v1, 0x2
invoke-interface {v0, v1}, Lorg/jbox2d/pooling/IWorldPool;->pushRot(I)V
.line 211
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
const/4 v1, 0x1
invoke-interface {v0, v1}, Lorg/jbox2d/pooling/IWorldPool;->pushVec2(I)V
.line 212
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
const/4 v1, 0x1
invoke-interface {v0, v1}, Lorg/jbox2d/pooling/IWorldPool;->pushMat22(I)V
.line 213
return-void
.end method
.method public setMaxForce(F)V
.registers 3
.prologue
.line 105
sget-boolean v0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->$assertionsDisabled:Z
if-nez v0, :cond_f
const/4 v0, 0x0
cmpl-float v0, p1, v0
if-gez v0, :cond_f
new-instance v0, Ljava/lang/AssertionError;
invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V
throw v0
.line 106
:cond_f
iput p1, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_maxForce:F
.line 107
return-void
.end method
.method public setMaxTorque(F)V
.registers 3
.prologue
.line 114
sget-boolean v0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->$assertionsDisabled:Z
if-nez v0, :cond_f
const/4 v0, 0x0
cmpl-float v0, p1, v0
if-gez v0, :cond_f
new-instance v0, Ljava/lang/AssertionError;
invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V
throw v0
.line 115
:cond_f
iput p1, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_maxTorque:F
.line 116
return-void
.end method
.method public solvePositionConstraints(Lorg/jbox2d/dynamics/SolverData;)Z
.registers 3
.prologue
.line 292
const/4 v0, 0x1
return v0
.end method
.method public solveVelocityConstraints(Lorg/jbox2d/dynamics/SolverData;)V
.registers 16
.prologue
.line 217
iget-object v0, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v1, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexA:I
aget-object v0, v0, v1
iget-object v0, v0, Lorg/jbox2d/dynamics/contacts/Velocity;->v:Lorg/jbox2d/common/Vec2;
.line 218
iget-object v1, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v2, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexA:I
aget-object v1, v1, v2
iget v1, v1, Lorg/jbox2d/dynamics/contacts/Velocity;->w:F
.line 219
iget-object v2, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v3, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexB:I
aget-object v2, v2, v3
iget-object v2, v2, Lorg/jbox2d/dynamics/contacts/Velocity;->v:Lorg/jbox2d/common/Vec2;
.line 220
iget-object v3, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v4, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexB:I
aget-object v3, v3, v4
iget v3, v3, Lorg/jbox2d/dynamics/contacts/Velocity;->w:F
.line 222
iget v4, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_invMassA:F
iget v5, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_invMassB:F
.line 223
iget v6, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_invIA:F
iget v7, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_invIB:F
.line 225
iget-object v8, p1, Lorg/jbox2d/dynamics/SolverData;->step:Lorg/jbox2d/dynamics/TimeStep;
iget v8, v8, Lorg/jbox2d/dynamics/TimeStep;->dt:F
.line 229
sub-float v9, v3, v1
.line 230
iget v10, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularMass:F
neg-float v10, v10
mul-float/2addr v9, v10
.line 232
iget v10, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularImpulse:F
.line 233
iget v11, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_maxTorque:F
mul-float/2addr v11, v8
.line 234
iget v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularImpulse:F
add-float/2addr v9, v12
neg-float v12, v11
invoke-static {v9, v12, v11}, Lorg/jbox2d/common/MathUtils;->clamp(FFF)F
move-result v9
iput v9, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularImpulse:F
.line 235
iget v9, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_angularImpulse:F
sub-float/2addr v9, v10
.line 237
mul-float v10, v6, v9
sub-float/2addr v1, v10
.line 238
mul-float/2addr v9, v7
add-float/2addr v3, v9
.line 243
iget-object v9, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
invoke-interface {v9}, Lorg/jbox2d/pooling/IWorldPool;->popVec2()Lorg/jbox2d/common/Vec2;
move-result-object v9
.line 244
iget-object v10, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
invoke-interface {v10}, Lorg/jbox2d/pooling/IWorldPool;->popVec2()Lorg/jbox2d/common/Vec2;
move-result-object v10
.line 246
iget-object v11, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rA:Lorg/jbox2d/common/Vec2;
invoke-static {v1, v11, v10}, Lorg/jbox2d/common/Vec2;->crossToOutUnsafe(FLorg/jbox2d/common/Vec2;Lorg/jbox2d/common/Vec2;)V
.line 247
iget-object v11, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rB:Lorg/jbox2d/common/Vec2;
invoke-static {v3, v11, v9}, Lorg/jbox2d/common/Vec2;->crossToOutUnsafe(FLorg/jbox2d/common/Vec2;Lorg/jbox2d/common/Vec2;)V
.line 248
invoke-virtual {v9, v2}, Lorg/jbox2d/common/Vec2;->addLocal(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
move-result-object v11
invoke-virtual {v11, v0}, Lorg/jbox2d/common/Vec2;->subLocal(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
move-result-object v11
invoke-virtual {v11, v10}, Lorg/jbox2d/common/Vec2;->subLocal(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
.line 250
iget-object v11, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
invoke-interface {v11}, Lorg/jbox2d/pooling/IWorldPool;->popVec2()Lorg/jbox2d/common/Vec2;
move-result-object v11
.line 251
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearMass:Lorg/jbox2d/common/Mat22;
invoke-static {v12, v9, v11}, Lorg/jbox2d/common/Mat22;->mulToOutUnsafe(Lorg/jbox2d/common/Mat22;Lorg/jbox2d/common/Vec2;Lorg/jbox2d/common/Vec2;)V
.line 252
invoke-virtual {v11}, Lorg/jbox2d/common/Vec2;->negateLocal()Lorg/jbox2d/common/Vec2;
.line 255
iget-object v9, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
invoke-interface {v9}, Lorg/jbox2d/pooling/IWorldPool;->popVec2()Lorg/jbox2d/common/Vec2;
move-result-object v9
.line 256
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearImpulse:Lorg/jbox2d/common/Vec2;
invoke-virtual {v9, v12}, Lorg/jbox2d/common/Vec2;->set(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
.line 257
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearImpulse:Lorg/jbox2d/common/Vec2;
invoke-virtual {v12, v11}, Lorg/jbox2d/common/Vec2;->addLocal(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
.line 259
iget v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_maxForce:F
mul-float/2addr v8, v12
.line 261
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearImpulse:Lorg/jbox2d/common/Vec2;
invoke-virtual {v12}, Lorg/jbox2d/common/Vec2;->lengthSquared()F
move-result v12
mul-float v13, v8, v8
cmpl-float v12, v12, v13
if-lez v12, :cond_a1
.line 262
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearImpulse:Lorg/jbox2d/common/Vec2;
invoke-virtual {v12}, Lorg/jbox2d/common/Vec2;->normalize()F
.line 263
iget-object v12, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearImpulse:Lorg/jbox2d/common/Vec2;
invoke-virtual {v12, v8}, Lorg/jbox2d/common/Vec2;->mulLocal(F)Lorg/jbox2d/common/Vec2;
.line 266
:cond_a1
iget-object v8, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_linearImpulse:Lorg/jbox2d/common/Vec2;
invoke-virtual {v11, v8}, Lorg/jbox2d/common/Vec2;->set(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
move-result-object v8
invoke-virtual {v8, v9}, Lorg/jbox2d/common/Vec2;->subLocal(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
.line 268
invoke-virtual {v10, v11}, Lorg/jbox2d/common/Vec2;->set(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
move-result-object v8
invoke-virtual {v8, v4}, Lorg/jbox2d/common/Vec2;->mulLocal(F)Lorg/jbox2d/common/Vec2;
.line 269
invoke-virtual {v0, v10}, Lorg/jbox2d/common/Vec2;->subLocal(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
.line 270
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rA:Lorg/jbox2d/common/Vec2;
invoke-static {v0, v11}, Lorg/jbox2d/common/Vec2;->cross(Lorg/jbox2d/common/Vec2;Lorg/jbox2d/common/Vec2;)F
move-result v0
mul-float/2addr v0, v6
sub-float v0, v1, v0
.line 272
invoke-virtual {v10, v11}, Lorg/jbox2d/common/Vec2;->set(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
move-result-object v1
invoke-virtual {v1, v5}, Lorg/jbox2d/common/Vec2;->mulLocal(F)Lorg/jbox2d/common/Vec2;
.line 273
invoke-virtual {v2, v10}, Lorg/jbox2d/common/Vec2;->addLocal(Lorg/jbox2d/common/Vec2;)Lorg/jbox2d/common/Vec2;
.line 274
iget-object v1, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_rB:Lorg/jbox2d/common/Vec2;
invoke-static {v1, v11}, Lorg/jbox2d/common/Vec2;->cross(Lorg/jbox2d/common/Vec2;Lorg/jbox2d/common/Vec2;)F
move-result v1
mul-float/2addr v1, v7
add-float/2addr v1, v3
.line 279
iget-object v2, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v3, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexA:I
aget-object v2, v2, v3
iget v2, v2, Lorg/jbox2d/dynamics/contacts/Velocity;->w:F
cmpl-float v2, v2, v0
if-eqz v2, :cond_f1
.line 280
sget-boolean v2, Lorg/jbox2d/dynamics/joints/FrictionJoint;->$assertionsDisabled:Z
if-nez v2, :cond_f1
iget-object v2, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v3, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexA:I
aget-object v2, v2, v3
iget v2, v2, Lorg/jbox2d/dynamics/contacts/Velocity;->w:F
cmpl-float v2, v2, v0
if-nez v2, :cond_f1
new-instance v0, Ljava/lang/AssertionError;
invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V
throw v0
.line 282
:cond_f1
iget-object v2, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v3, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexA:I
aget-object v2, v2, v3
iput v0, v2, Lorg/jbox2d/dynamics/contacts/Velocity;->w:F
.line 285
iget-object v0, p1, Lorg/jbox2d/dynamics/SolverData;->velocities:[Lorg/jbox2d/dynamics/contacts/Velocity;
iget v2, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->m_indexB:I
aget-object v0, v0, v2
iput v1, v0, Lorg/jbox2d/dynamics/contacts/Velocity;->w:F
.line 287
iget-object v0, p0, Lorg/jbox2d/dynamics/joints/FrictionJoint;->pool:Lorg/jbox2d/pooling/IWorldPool;
const/4 v1, 0x4
invoke-interface {v0, v1}, Lorg/jbox2d/pooling/IWorldPool;->pushVec2(I)V
.line 288
return-void
.end method