DynamicTreeFlatNodes.smali

.class public Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;
.super Ljava/lang/Object;
.source "DynamicTreeFlatNodes.java"

# interfaces
.implements Lorg/jbox2d/collision/broadphase/BroadPhaseStrategy;


# static fields
.field static final synthetic $assertionsDisabled:Z

.field public static final INITIAL_BUFFER_LENGTH:I = 0x10

.field public static final MAX_STACK_SIZE:I = 0x40

.field public static final NULL_NODE:I = -0x1


# instance fields
.field private final aabb:Lorg/jbox2d/collision/AABB;

.field private final color:Lorg/jbox2d/common/Color3f;

.field private final combinedAABB:Lorg/jbox2d/collision/AABB;

.field private final drawVecs:[Lorg/jbox2d/common/Vec2;

.field public m_aabb:[Lorg/jbox2d/collision/AABB;

.field protected m_child1:[I

.field protected m_child2:[I

.field private m_freeList:I

.field protected m_height:[I

.field private m_nodeCapacity:I

.field private m_nodeCount:I

.field protected m_parent:[I

.field public m_root:I

.field public m_userData:[Ljava/lang/Object;

.field private nodeStack:[I

.field private nodeStackIndex:I

.field private final r:Lorg/jbox2d/common/Vec2;

.field private final subInput:Lorg/jbox2d/collision/RayCastInput;

.field private final textVec:Lorg/jbox2d/common/Vec2;


# direct methods
.method static constructor <clinit>()V
    .registers 1

    .prologue
    .line 37
    const-class v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;

    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/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    return-void

    :cond_c
    const/4 v0, 0x0

    goto :goto_9
.end method

.method public constructor <init>()V
    .registers 4

    .prologue
    const/4 v0, 0x0

    .line 57
    invoke-direct {p0}, Ljava/lang/Object;-><init>()V

    .line 55
    const/4 v1, 0x4

    new-array v1, v1, [Lorg/jbox2d/common/Vec2;

    iput-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->drawVecs:[Lorg/jbox2d/common/Vec2;

    .line 166
    const/16 v1, 0x14

    new-array v1, v1, [I

    iput-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    .line 199
    new-instance v1, Lorg/jbox2d/common/Vec2;

    invoke-direct {v1}, Lorg/jbox2d/common/Vec2;-><init>()V

    iput-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->r:Lorg/jbox2d/common/Vec2;

    .line 200
    new-instance v1, Lorg/jbox2d/collision/AABB;

    invoke-direct {v1}, Lorg/jbox2d/collision/AABB;-><init>()V

    iput-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->aabb:Lorg/jbox2d/collision/AABB;

    .line 201
    new-instance v1, Lorg/jbox2d/collision/RayCastInput;

    invoke-direct {v1}, Lorg/jbox2d/collision/RayCastInput;-><init>()V

    iput-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->subInput:Lorg/jbox2d/collision/RayCastInput;

    .line 490
    new-instance v1, Lorg/jbox2d/collision/AABB;

    invoke-direct {v1}, Lorg/jbox2d/collision/AABB;-><init>()V

    iput-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->combinedAABB:Lorg/jbox2d/collision/AABB;

    .line 851
    new-instance v1, Lorg/jbox2d/common/Color3f;

    invoke-direct {v1}, Lorg/jbox2d/common/Color3f;-><init>()V

    iput-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->color:Lorg/jbox2d/common/Color3f;

    .line 852
    new-instance v1, Lorg/jbox2d/common/Vec2;

    invoke-direct {v1}, Lorg/jbox2d/common/Vec2;-><init>()V

    iput-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->textVec:Lorg/jbox2d/common/Vec2;

    .line 58
    const/4 v1, -0x1

    iput v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    .line 59
    iput v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCount:I

    .line 60
    const/16 v1, 0x10

    iput v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    .line 61
    iget v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    invoke-direct {p0, v0, v1}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->expandBuffers(II)V

    .line 63
    :goto_47
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->drawVecs:[Lorg/jbox2d/common/Vec2;

    array-length v1, v1

    if-ge v0, v1, :cond_58

    .line 64
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->drawVecs:[Lorg/jbox2d/common/Vec2;

    new-instance v2, Lorg/jbox2d/common/Vec2;

    invoke-direct {v2}, Lorg/jbox2d/common/Vec2;-><init>()V

    aput-object v2, v1, v0

    .line 63
    add-int/lit8 v0, v0, 0x1

    goto :goto_47

    .line 66
    :cond_58
    return-void
.end method

.method private final allocateNode()I
    .registers 4

    .prologue
    const/4 v2, -0x1

    .line 463
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_freeList:I

    if-ne v0, v2, :cond_22

    .line 464
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_15

    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCount:I

    iget v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-eq v0, v1, :cond_15

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 465
    :cond_15
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    mul-int/lit8 v0, v0, 0x2

    iput v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    .line 466
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCount:I

    iget v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    invoke-direct {p0, v0, v1}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->expandBuffers(II)V

    .line 468
    :cond_22
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_30

    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_freeList:I

    if-ne v0, v2, :cond_30

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 469
    :cond_30
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_freeList:I

    .line 470
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v1, v1, v0

    iput v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_freeList:I

    .line 471
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput v2, v1, v0

    .line 472
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aput v2, v1, v0

    .line 473
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    const/4 v2, 0x0

    aput v2, v1, v0

    .line 474
    iget v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCount:I

    add-int/lit8 v1, v1, 0x1

    iput v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCount:I

    .line 475
    return v0
.end method

.method private balance(I)I
    .registers 9

    .prologue
    const/4 v6, -0x1

    .line 657
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_d

    if-ne p1, v6, :cond_d

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 660
    :cond_d
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v0, v0, p1

    if-eq v0, v6, :cond_1a

    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v0, v0, p1

    const/4 v1, 0x2

    if-ge v0, v1, :cond_1b

    .line 776
    :cond_1a
    :goto_1a
    return p1

    .line 664
    :cond_1b
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v1, v0, p1

    .line 665
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v0, v0, p1

    .line 666
    sget-boolean v2, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v2, :cond_33

    if-ltz v1, :cond_2d

    iget v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt v1, v2, :cond_33

    :cond_2d
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 667
    :cond_33
    sget-boolean v2, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v2, :cond_43

    if-ltz v0, :cond_3d

    iget v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt v0, v2, :cond_43

    :cond_3d
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 672
    :cond_43
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v2, v2, v0

    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v3, v3, v1

    sub-int/2addr v2, v3

    .line 675
    const/4 v3, 0x1

    if-le v2, v3, :cond_155

    .line 676
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v2, v2, v0

    .line 677
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v3, v3, v0

    .line 682
    sget-boolean v4, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v4, :cond_67

    if-ltz v2, :cond_61

    iget v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt v2, v4, :cond_67

    :cond_61
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 683
    :cond_67
    sget-boolean v4, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v4, :cond_77

    if-ltz v3, :cond_71

    iget v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt v3, v4, :cond_77

    :cond_71
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 686
    :cond_77
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aput p1, v4, v0

    .line 687
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v5, v5, p1

    aput v5, v4, v0

    .line 688
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput v0, v4, p1

    .line 691
    if-eq v5, v6, :cond_103

    .line 692
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v4, v4, v5

    if-ne v4, p1, :cond_ee

    .line 693
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aput v0, v4, v5

    .line 703
    :goto_93
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v4, v4, v2

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v5, v5, v3

    if-le v4, v5, :cond_106

    .line 704
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput v2, v4, v0

    .line 705
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput v3, v4, p1

    .line 706
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput p1, v4, v3

    .line 707
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v4, v4, p1

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v5, v5, v1

    iget-object v6, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v6, v6, v3

    invoke-virtual {v4, v5, v6}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 708
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v4, v4, v0

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v5, v5, p1

    iget-object v6, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v6, v6, v2

    invoke-virtual {v4, v5, v6}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 710
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v1, v5, v1

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v3, v5, v3

    invoke-static {v1, v3}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v1

    add-int/lit8 v1, v1, 0x1

    aput v1, v4, p1

    .line 711
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v3, v3, p1

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v2, v4, v2

    invoke-static {v3, v2}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v2

    add-int/lit8 v2, v2, 0x1

    aput v2, v1, v0

    :goto_eb
    move p1, v0

    .line 723
    goto/16 :goto_1a

    .line 695
    :cond_ee
    sget-boolean v4, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v4, :cond_fe

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v4, v4, v5

    if-eq v4, p1, :cond_fe

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 696
    :cond_fe
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput v0, v4, v5

    goto :goto_93

    .line 699
    :cond_103
    iput v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    goto :goto_93

    .line 713
    :cond_106
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput v3, v4, v0

    .line 714
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput v2, v4, p1

    .line 715
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput p1, v4, v2

    .line 716
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v4, v4, p1

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v5, v5, v1

    iget-object v6, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v6, v6, v2

    invoke-virtual {v4, v5, v6}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 717
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v4, v4, v0

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v5, v5, p1

    iget-object v6, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v6, v6, v3

    invoke-virtual {v4, v5, v6}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 719
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v1, v5, v1

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v2, v5, v2

    invoke-static {v1, v2}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v1

    add-int/lit8 v1, v1, 0x1

    aput v1, v4, p1

    .line 720
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v2, v2, p1

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v3, v4, v3

    invoke-static {v2, v3}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v2

    add-int/lit8 v2, v2, 0x1

    aput v2, v1, v0

    goto :goto_eb

    .line 727
    :cond_155
    if-ge v2, v6, :cond_1a

    .line 728
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v2, v2, v1

    .line 729
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v3, v3, v1

    .line 732
    sget-boolean v4, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v4, :cond_16f

    if-ltz v2, :cond_169

    iget v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt v2, v4, :cond_16f

    :cond_169
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 733
    :cond_16f
    sget-boolean v4, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v4, :cond_17f

    if-ltz v3, :cond_179

    iget v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt v3, v4, :cond_17f

    :cond_179
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 736
    :cond_17f
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aput p1, v4, v1

    .line 737
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v5, v5, p1

    aput v5, v4, v1

    .line 738
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput v1, v4, p1

    .line 741
    if-eq v5, v6, :cond_20b

    .line 742
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v4, v4, v5

    if-ne v4, p1, :cond_1f6

    .line 743
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aput v1, v4, v5

    .line 753
    :goto_19b
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v4, v4, v2

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v5, v5, v3

    if-le v4, v5, :cond_20e

    .line 754
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput v2, v4, v1

    .line 755
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aput v3, v4, p1

    .line 756
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput p1, v4, v3

    .line 757
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v4, v4, p1

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v5, v5, v0

    iget-object v6, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v6, v6, v3

    invoke-virtual {v4, v5, v6}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 758
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v4, v4, v1

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v5, v5, p1

    iget-object v6, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v6, v6, v2

    invoke-virtual {v4, v5, v6}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 760
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v0, v5, v0

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v3, v5, v3

    invoke-static {v0, v3}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v0

    add-int/lit8 v0, v0, 0x1

    aput v0, v4, p1

    .line 761
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v3, v3, p1

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v2, v4, v2

    invoke-static {v3, v2}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v2

    add-int/lit8 v2, v2, 0x1

    aput v2, v0, v1

    :goto_1f3
    move p1, v1

    .line 773
    goto/16 :goto_1a

    .line 745
    :cond_1f6
    sget-boolean v4, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v4, :cond_206

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v4, v4, v5

    if-eq v4, p1, :cond_206

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 746
    :cond_206
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput v1, v4, v5

    goto :goto_19b

    .line 749
    :cond_20b
    iput v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    goto :goto_19b

    .line 763
    :cond_20e
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput v3, v4, v1

    .line 764
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aput v2, v4, p1

    .line 765
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput p1, v4, v2

    .line 766
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v4, v4, p1

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v5, v5, v0

    iget-object v6, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v6, v6, v2

    invoke-virtual {v4, v5, v6}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 767
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v4, v4, v1

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v5, v5, p1

    iget-object v6, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v6, v6, v3

    invoke-virtual {v4, v5, v6}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 769
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v0, v5, v0

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v2, v5, v2

    invoke-static {v0, v2}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v0

    add-int/lit8 v0, v0, 0x1

    aput v0, v4, p1

    .line 770
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v2, v2, p1

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v3, v4, v3

    invoke-static {v2, v3}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v2

    add-int/lit8 v2, v2, 0x1

    aput v2, v0, v1

    goto :goto_1f3
.end method

.method private final computeHeight(I)I
    .registers 4

    .prologue
    .line 316
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_10

    if-ltz p1, :cond_a

    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt p1, v0, :cond_10

    :cond_a
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 318
    :cond_10
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v0, v0, p1

    const/4 v1, -0x1

    if-ne v0, v1, :cond_19

    .line 319
    const/4 v0, 0x0

    .line 323
    :goto_18
    return v0

    .line 321
    :cond_19
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v0, v0, p1

    invoke-direct {p0, v0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->computeHeight(I)I

    move-result v0

    .line 322
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v1, v1, p1

    invoke-direct {p0, v1}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->computeHeight(I)I

    move-result v1

    .line 323
    invoke-static {v0, v1}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v0

    add-int/lit8 v0, v0, 0x1

    goto :goto_18
.end method

.method private expandBuffers(II)V
    .registers 7

    .prologue
    const/4 v1, -0x1

    .line 69
    const-class v0, Lorg/jbox2d/collision/AABB;

    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    invoke-static {v0, v2, p1, p2}, Lorg/jbox2d/common/BufferUtils;->reallocateBuffer(Ljava/lang/Class;[Ljava/lang/Object;II)[Ljava/lang/Object;

    move-result-object v0

    check-cast v0, [Lorg/jbox2d/collision/AABB;

    iput-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    .line 70
    const-class v0, Ljava/lang/Object;

    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_userData:[Ljava/lang/Object;

    invoke-static {v0, v2, p1, p2}, Lorg/jbox2d/common/BufferUtils;->reallocateBuffer(Ljava/lang/Class;[Ljava/lang/Object;II)[Ljava/lang/Object;

    move-result-object v0

    iput-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_userData:[Ljava/lang/Object;

    .line 71
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    invoke-static {v0, p1, p2}, Lorg/jbox2d/common/BufferUtils;->reallocateBuffer([III)[I

    move-result-object v0

    iput-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    .line 72
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    invoke-static {v0, p1, p2}, Lorg/jbox2d/common/BufferUtils;->reallocateBuffer([III)[I

    move-result-object v0

    iput-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    .line 73
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    invoke-static {v0, p1, p2}, Lorg/jbox2d/common/BufferUtils;->reallocateBuffer([III)[I

    move-result-object v0

    iput-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    .line 74
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    invoke-static {v0, p1, p2}, Lorg/jbox2d/common/BufferUtils;->reallocateBuffer([III)[I

    move-result-object v0

    iput-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    move v2, p1

    .line 77
    :goto_38
    if-ge v2, p2, :cond_5f

    .line 78
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    new-instance v3, Lorg/jbox2d/collision/AABB;

    invoke-direct {v3}, Lorg/jbox2d/collision/AABB;-><init>()V

    aput-object v3, v0, v2

    .line 79
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    add-int/lit8 v0, p2, -0x1

    if-ne v2, v0, :cond_5c

    move v0, v1

    :goto_4a
    aput v0, v3, v2

    .line 80
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aput v1, v0, v2

    .line 81
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aput v1, v0, v2

    .line 82
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput v1, v0, v2

    .line 77
    add-int/lit8 v0, v2, 0x1

    move v2, v0

    goto :goto_38

    .line 79
    :cond_5c
    add-int/lit8 v0, v2, 0x1

    goto :goto_4a

    .line 84
    :cond_5f
    iput p1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_freeList:I

    .line 85
    return-void
.end method

.method private final freeNode(I)V
    .registers 5

    .prologue
    const/4 v1, -0x1

    .line 482
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_d

    if-ne p1, v1, :cond_d

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 483
    :cond_d
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_1b

    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCount:I

    if-gtz v0, :cond_1b

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 484
    :cond_1b
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_freeList:I

    if-eq v0, v1, :cond_32

    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_freeList:I

    :goto_23
    aput v0, v2, p1

    .line 485
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aput v1, v0, p1

    .line 486
    iput p1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_freeList:I

    .line 487
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCount:I

    add-int/lit8 v0, v0, -0x1

    iput v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCount:I

    .line 488
    return-void

    :cond_32
    move v0, v1

    .line 484
    goto :goto_23
.end method

.method private final insertLeaf(I)V
    .registers 13

    .prologue
    const/high16 v10, 0x40000000    # 2.0f

    const/4 v9, -0x1

    .line 493
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    if-ne v0, v9, :cond_10

    .line 494
    iput p1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    .line 495
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    iget v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    aput v9, v0, v1

    .line 603
    :cond_f
    return-void

    .line 500
    :cond_10
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v5, v0, p1

    .line 501
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    .line 502
    :goto_16
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v1, v1, v0

    if-eq v1, v9, :cond_70

    .line 504
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v2, v1, v0

    .line 505
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v3, v1, v0

    .line 506
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v1, v1, v0

    .line 507
    invoke-virtual {v1}, Lorg/jbox2d/collision/AABB;->getPerimeter()F

    move-result v4

    .line 509
    iget-object v6, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->combinedAABB:Lorg/jbox2d/collision/AABB;

    invoke-virtual {v6, v1, v5}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 510
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->combinedAABB:Lorg/jbox2d/collision/AABB;

    invoke-virtual {v1}, Lorg/jbox2d/collision/AABB;->getPerimeter()F

    move-result v1

    .line 513
    mul-float v6, v10, v1

    .line 516
    sub-float/2addr v1, v4

    mul-float v4, v10, v1

    .line 520
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v1, v1, v2

    .line 521
    iget-object v7, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v7, v7, v2

    if-ne v7, v9, :cond_d0

    .line 522
    iget-object v7, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->combinedAABB:Lorg/jbox2d/collision/AABB;

    invoke-virtual {v7, v5, v1}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 523
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->combinedAABB:Lorg/jbox2d/collision/AABB;

    invoke-virtual {v1}, Lorg/jbox2d/collision/AABB;->getPerimeter()F

    move-result v1

    add-float/2addr v1, v4

    .line 533
    :goto_52
    iget-object v7, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v7, v7, v3

    .line 534
    iget-object v8, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v8, v8, v3

    if-ne v8, v9, :cond_e4

    .line 535
    iget-object v8, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->combinedAABB:Lorg/jbox2d/collision/AABB;

    invoke-virtual {v8, v5, v7}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 536
    iget-object v7, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->combinedAABB:Lorg/jbox2d/collision/AABB;

    invoke-virtual {v7}, Lorg/jbox2d/collision/AABB;->getPerimeter()F

    move-result v7

    add-float/2addr v4, v7

    .line 545
    :goto_68
    cmpg-float v7, v6, v1

    if-gez v7, :cond_f8

    cmpg-float v6, v6, v4

    if-gez v6, :cond_f8

    .line 558
    :cond_70
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v1, v1, v0

    .line 559
    invoke-direct {p0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->allocateNode()I

    move-result v2

    .line 560
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput v1, v3, v2

    .line 561
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_userData:[Ljava/lang/Object;

    const/4 v4, 0x0

    aput-object v4, v3, v2

    .line 562
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v3, v3, v2

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v4, v4, v0

    invoke-virtual {v3, v5, v4}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 563
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v4, v4, v0

    add-int/lit8 v4, v4, 0x1

    aput v4, v3, v2

    .line 565
    if-eq v1, v9, :cond_107

    .line 567
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v3, v3, v1

    if-ne v3, v0, :cond_102

    .line 568
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aput v2, v3, v1

    .line 573
    :goto_a2
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aput v0, v1, v2

    .line 574
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput p1, v1, v2

    .line 575
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput v2, v1, v0

    .line 576
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput v2, v0, p1

    .line 587
    :goto_b2
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v0, v0, p1

    .line 588
    :goto_b6
    if-eq v0, v9, :cond_f

    .line 589
    invoke-direct {p0, v0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->balance(I)I

    move-result v0

    .line 591
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v1, v1, v0

    .line 592
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v2, v2, v0

    .line 594
    sget-boolean v3, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v3, :cond_11a

    if-ne v1, v9, :cond_11a

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 525
    :cond_d0
    iget-object v7, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->combinedAABB:Lorg/jbox2d/collision/AABB;

    invoke-virtual {v7, v5, v1}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 526
    invoke-virtual {v1}, Lorg/jbox2d/collision/AABB;->getPerimeter()F

    move-result v1

    .line 527
    iget-object v7, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->combinedAABB:Lorg/jbox2d/collision/AABB;

    invoke-virtual {v7}, Lorg/jbox2d/collision/AABB;->getPerimeter()F

    move-result v7

    .line 528
    sub-float v1, v7, v1

    add-float/2addr v1, v4

    goto/16 :goto_52

    .line 538
    :cond_e4
    iget-object v8, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->combinedAABB:Lorg/jbox2d/collision/AABB;

    invoke-virtual {v8, v5, v7}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 539
    invoke-virtual {v7}, Lorg/jbox2d/collision/AABB;->getPerimeter()F

    move-result v7

    .line 540
    iget-object v8, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->combinedAABB:Lorg/jbox2d/collision/AABB;

    invoke-virtual {v8}, Lorg/jbox2d/collision/AABB;->getPerimeter()F

    move-result v8

    .line 541
    sub-float v7, v8, v7

    add-float/2addr v4, v7

    goto/16 :goto_68

    .line 550
    :cond_f8
    cmpg-float v0, v1, v4

    if-gez v0, :cond_ff

    move v0, v2

    .line 551
    goto/16 :goto_16

    :cond_ff
    move v0, v3

    .line 553
    goto/16 :goto_16

    .line 570
    :cond_102
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput v2, v3, v1

    goto :goto_a2

    .line 579
    :cond_107
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aput v0, v1, v2

    .line 580
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput p1, v1, v2

    .line 581
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput v2, v1, v0

    .line 582
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput v2, v0, p1

    .line 583
    iput v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    goto :goto_b2

    .line 595
    :cond_11a
    sget-boolean v3, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v3, :cond_126

    if-ne v2, v9, :cond_126

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 597
    :cond_126
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v4, v4, v1

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v5, v5, v2

    invoke-static {v4, v5}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v4

    add-int/lit8 v4, v4, 0x1

    aput v4, v3, v0

    .line 598
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v3, v3, v0

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v1, v4, v1

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v2, v4, v2

    invoke-virtual {v3, v1, v2}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 600
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v0, v1, v0

    goto/16 :goto_b6
.end method

.method private final removeLeaf(I)V
    .registers 9

    .prologue
    const/4 v6, -0x1

    .line 606
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    if-ne p1, v0, :cond_8

    .line 607
    iput v6, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    .line 652
    :cond_7
    :goto_7
    return-void

    .line 611
    :cond_8
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v3, v0, p1

    .line 612
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v0, v0, v3

    .line 613
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v2, v1, v3

    .line 614
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v1, v1, v3

    .line 616
    if-ne v2, p1, :cond_61

    .line 622
    :goto_1a
    if-eq v0, v6, :cond_68

    .line 624
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v2, v2, v0

    if-ne v2, v3, :cond_63

    .line 625
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aput v1, v2, v0

    .line 629
    :goto_26
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput v0, v2, v1

    .line 630
    invoke-direct {p0, v3}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->freeNode(I)V

    .line 634
    :goto_2d
    if-eq v0, v6, :cond_7

    .line 635
    invoke-direct {p0, v0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->balance(I)I

    move-result v0

    .line 637
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v1, v1, v0

    .line 638
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v2, v2, v0

    .line 640
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v3, v3, v0

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v4, v4, v1

    iget-object v5, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v5, v5, v2

    invoke-virtual {v3, v4, v5}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 641
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v1, v4, v1

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v2, v4, v2

    invoke-static {v1, v2}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v1

    add-int/lit8 v1, v1, 0x1

    aput v1, v3, v0

    .line 643
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v0, v1, v0

    goto :goto_2d

    :cond_61
    move v1, v2

    .line 619
    goto :goto_1a

    .line 627
    :cond_63
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aput v1, v2, v0

    goto :goto_26

    .line 646
    :cond_68
    iput v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    .line 647
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aput v6, v0, v1

    .line 648
    invoke-direct {p0, v3}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->freeNode(I)V

    goto :goto_7
.end method

.method private validateMetrics(I)V
    .registers 7

    .prologue
    const/4 v3, -0x1

    .line 809
    if-ne p1, v3, :cond_4

    .line 840
    :cond_3
    :goto_3
    return-void

    .line 813
    :cond_4
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v0, v0, p1

    .line 814
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v1, v1, p1

    .line 816
    if-ne v0, v3, :cond_36

    .line 817
    sget-boolean v2, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v2, :cond_1a

    if-eq v0, v3, :cond_1a

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 818
    :cond_1a
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_26

    if-eq v1, v3, :cond_26

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 819
    :cond_26
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_3

    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v0, v0, p1

    if-eqz v0, :cond_3

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 823
    :cond_36
    sget-boolean v2, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v2, :cond_48

    if-eq v0, v3, :cond_42

    if-ltz v0, :cond_42

    iget v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt v0, v2, :cond_48

    :cond_42
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 824
    :cond_48
    sget-boolean v2, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v2, :cond_5a

    if-eq v1, v0, :cond_54

    if-ltz v1, :cond_54

    iget v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt v1, v2, :cond_5a

    :cond_54
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 826
    :cond_5a
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v2, v2, v0

    .line 827
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v3, v3, v1

    .line 829
    invoke-static {v2, v3}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v2

    add-int/lit8 v2, v2, 0x1

    .line 830
    sget-boolean v3, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v3, :cond_78

    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v3, v3, p1

    if-eq v3, v2, :cond_78

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 832
    :cond_78
    new-instance v2, Lorg/jbox2d/collision/AABB;

    invoke-direct {v2}, Lorg/jbox2d/collision/AABB;-><init>()V

    .line 833
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v3, v3, v0

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v4, v4, v1

    invoke-virtual {v2, v3, v4}, Lorg/jbox2d/collision/AABB;->combine(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)V

    .line 835
    sget-boolean v3, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v3, :cond_a0

    iget-object v3, v2, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v4, v4, p1

    iget-object v4, v4, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    invoke-virtual {v3, v4}, Lorg/jbox2d/common/Vec2;->equals(Ljava/lang/Object;)Z

    move-result v3

    if-nez v3, :cond_a0

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 836
    :cond_a0
    sget-boolean v3, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v3, :cond_b8

    iget-object v2, v2, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v3, v3, p1

    iget-object v3, v3, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    invoke-virtual {v2, v3}, Lorg/jbox2d/common/Vec2;->equals(Ljava/lang/Object;)Z

    move-result v2

    if-nez v2, :cond_b8

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 838
    :cond_b8
    invoke-direct {p0, v0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->validateMetrics(I)V

    .line 839
    invoke-direct {p0, v1}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->validateMetrics(I)V

    goto/16 :goto_3
.end method

.method private validateStructure(I)V
    .registers 6

    .prologue
    const/4 v3, -0x1

    .line 780
    if-ne p1, v3, :cond_4

    .line 806
    :cond_3
    :goto_3
    return-void

    .line 784
    :cond_4
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    if-ne p1, v0, :cond_18

    .line 785
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_18

    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v0, v0, p1

    if-eq v0, v3, :cond_18

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 788
    :cond_18
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v0, v0, p1

    .line 789
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v1, v1, p1

    .line 791
    if-ne v0, v3, :cond_4a

    .line 792
    sget-boolean v2, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v2, :cond_2e

    if-eq v0, v3, :cond_2e

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 793
    :cond_2e
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_3a

    if-eq v1, v3, :cond_3a

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 794
    :cond_3a
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_3

    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v0, v0, p1

    if-eqz v0, :cond_3

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 798
    :cond_4a
    sget-boolean v2, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v2, :cond_5c

    if-eq v0, v3, :cond_56

    if-ltz v0, :cond_56

    iget v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt v0, v2, :cond_5c

    :cond_56
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 799
    :cond_5c
    sget-boolean v2, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v2, :cond_6e

    if-eq v1, v3, :cond_68

    if-ltz v1, :cond_68

    iget v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt v1, v2, :cond_6e

    :cond_68
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 801
    :cond_6e
    sget-boolean v2, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v2, :cond_7e

    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v2, v2, v0

    if-eq v2, p1, :cond_7e

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 802
    :cond_7e
    sget-boolean v2, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v2, :cond_8e

    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v2, v2, v1

    if-eq v2, p1, :cond_8e

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 804
    :cond_8e
    invoke-direct {p0, v0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->validateStructure(I)V

    .line 805
    invoke-direct {p0, v1}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->validateStructure(I)V

    goto/16 :goto_3
.end method


# virtual methods
.method public final computeHeight()I
    .registers 2

    .prologue
    .line 312
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    invoke-direct {p0, v0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->computeHeight(I)I

    move-result v0

    return v0
.end method

.method public final createProxy(Lorg/jbox2d/collision/AABB;Ljava/lang/Object;)I
    .registers 8

    .prologue
    .line 89
    invoke-direct {p0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->allocateNode()I

    move-result v0

    .line 91
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v1, v1, v0

    .line 92
    iget-object v2, v1, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget-object v3, p1, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget v3, v3, Lorg/jbox2d/common/Vec2;->x:F

    sget v4, Lorg/jbox2d/common/Settings;->aabbExtension:F

    sub-float/2addr v3, v4

    iput v3, v2, Lorg/jbox2d/common/Vec2;->x:F

    .line 93
    iget-object v2, v1, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget-object v3, p1, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget v3, v3, Lorg/jbox2d/common/Vec2;->y:F

    sget v4, Lorg/jbox2d/common/Settings;->aabbExtension:F

    sub-float/2addr v3, v4

    iput v3, v2, Lorg/jbox2d/common/Vec2;->y:F

    .line 94
    iget-object v2, v1, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget-object v3, p1, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget v3, v3, Lorg/jbox2d/common/Vec2;->x:F

    sget v4, Lorg/jbox2d/common/Settings;->aabbExtension:F

    add-float/2addr v3, v4

    iput v3, v2, Lorg/jbox2d/common/Vec2;->x:F

    .line 95
    iget-object v1, v1, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget-object v2, p1, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget v2, v2, Lorg/jbox2d/common/Vec2;->y:F

    sget v3, Lorg/jbox2d/common/Settings;->aabbExtension:F

    add-float/2addr v2, v3

    iput v2, v1, Lorg/jbox2d/common/Vec2;->y:F

    .line 96
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_userData:[Ljava/lang/Object;

    aput-object p2, v1, v0

    .line 98
    invoke-direct {p0, v0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->insertLeaf(I)V

    .line 100
    return v0
.end method

.method public final destroyProxy(I)V
    .registers 4

    .prologue
    .line 105
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_10

    if-ltz p1, :cond_a

    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt p1, v0, :cond_10

    :cond_a
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 106
    :cond_10
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_21

    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v0, v0, p1

    const/4 v1, -0x1

    if-eq v0, v1, :cond_21

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 108
    :cond_21
    invoke-direct {p0, p1}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->removeLeaf(I)V

    .line 109
    invoke-direct {p0, p1}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->freeNode(I)V

    .line 110
    return-void
.end method

.method public drawTree(Lorg/jbox2d/callbacks/DebugDraw;)V
    .registers 5

    .prologue
    .line 844
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    const/4 v1, -0x1

    if-ne v0, v1, :cond_6

    .line 849
    :goto_5
    return-void

    .line 847
    :cond_6
    invoke-virtual {p0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->computeHeight()I

    move-result v0

    .line 848
    iget v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    const/4 v2, 0x0

    invoke-virtual {p0, p1, v1, v2, v0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->drawTree(Lorg/jbox2d/callbacks/DebugDraw;III)V

    goto :goto_5
.end method

.method public drawTree(Lorg/jbox2d/callbacks/DebugDraw;III)V
    .registers 12

    .prologue
    const/4 v6, -0x1

    const/high16 v5, 0x3f800000    # 1.0f

    .line 855
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v0, v0, p2

    .line 856
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->drawVecs:[Lorg/jbox2d/common/Vec2;

    invoke-virtual {v0, v1}, Lorg/jbox2d/collision/AABB;->getVertices([Lorg/jbox2d/common/Vec2;)V

    .line 858
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->color:Lorg/jbox2d/common/Color3f;

    sub-int v2, p4, p3

    int-to-float v2, v2

    mul-float/2addr v2, v5

    int-to-float v3, p4

    div-float/2addr v2, v3

    sub-int v3, p4, p3

    int-to-float v3, v3

    mul-float/2addr v3, v5

    int-to-float v4, p4

    div-float/2addr v3, v4

    invoke-virtual {v1, v5, v2, v3}, Lorg/jbox2d/common/Color3f;->set(FFF)V

    .line 859
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->drawVecs:[Lorg/jbox2d/common/Vec2;

    const/4 v2, 0x4

    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->color:Lorg/jbox2d/common/Color3f;

    invoke-virtual {p1, v1, v2, v3}, Lorg/jbox2d/callbacks/DebugDraw;->drawPolygon([Lorg/jbox2d/common/Vec2;ILorg/jbox2d/common/Color3f;)V

    .line 861
    invoke-virtual {p1}, Lorg/jbox2d/callbacks/DebugDraw;->getViewportTranform()Lorg/jbox2d/common/IViewportTransform;

    move-result-object v1

    iget-object v0, v0, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->textVec:Lorg/jbox2d/common/Vec2;

    invoke-interface {v1, v0, v2}, Lorg/jbox2d/common/IViewportTransform;->getWorldToScreen(Lorg/jbox2d/common/Vec2;Lorg/jbox2d/common/Vec2;)V

    .line 862
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->textVec:Lorg/jbox2d/common/Vec2;

    iget v0, v0, Lorg/jbox2d/common/Vec2;->x:F

    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->textVec:Lorg/jbox2d/common/Vec2;

    iget v1, v1, Lorg/jbox2d/common/Vec2;->y:F

    new-instance v2, Ljava/lang/StringBuilder;

    invoke-direct {v2}, Ljava/lang/StringBuilder;-><init>()V

    invoke-virtual {v2, p2}, Ljava/lang/StringBuilder;->append(I)Ljava/lang/StringBuilder;

    move-result-object v2

    const-string v3, "-"

    invoke-virtual {v2, v3}, Ljava/lang/StringBuilder;->append(Ljava/lang/String;)Ljava/lang/StringBuilder;

    move-result-object v2

    add-int/lit8 v3, p3, 0x1

    invoke-virtual {v2, v3}, Ljava/lang/StringBuilder;->append(I)Ljava/lang/StringBuilder;

    move-result-object v2

    const-string v3, "/"

    invoke-virtual {v2, v3}, Ljava/lang/StringBuilder;->append(Ljava/lang/String;)Ljava/lang/StringBuilder;

    move-result-object v2

    invoke-virtual {v2, p4}, Ljava/lang/StringBuilder;->append(I)Ljava/lang/StringBuilder;

    move-result-object v2

    invoke-virtual {v2}, Ljava/lang/StringBuilder;->toString()Ljava/lang/String;

    move-result-object v2

    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->color:Lorg/jbox2d/common/Color3f;

    invoke-virtual {p1, v0, v1, v2, v3}, Lorg/jbox2d/callbacks/DebugDraw;->drawString(FFLjava/lang/String;Lorg/jbox2d/common/Color3f;)V

    .line 864
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v0, v0, p2

    .line 865
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v1, v1, p2

    .line 866
    if-eq v0, v6, :cond_6f

    .line 867
    add-int/lit8 v2, p3, 0x1

    invoke-virtual {p0, p1, v0, v2, p4}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->drawTree(Lorg/jbox2d/callbacks/DebugDraw;III)V

    .line 869
    :cond_6f
    if-eq v1, v6, :cond_76

    .line 870
    add-int/lit8 v0, p3, 0x1

    invoke-virtual {p0, p1, v1, v0, p4}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->drawTree(Lorg/jbox2d/callbacks/DebugDraw;III)V

    .line 872
    :cond_76
    return-void
.end method

.method public getAreaRatio()F
    .registers 5

    .prologue
    const/4 v1, 0x0

    .line 374
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    const/4 v2, -0x1

    if-ne v0, v2, :cond_7

    .line 391
    :goto_6
    return v1

    .line 378
    :cond_7
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    .line 379
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v0, v2, v0

    invoke-virtual {v0}, Lorg/jbox2d/collision/AABB;->getPerimeter()F

    move-result v2

    .line 382
    const/4 v0, 0x0

    :goto_12
    iget v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-ge v0, v3, :cond_29

    .line 383
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v3, v3, v0

    if-gez v3, :cond_1f

    .line 382
    :goto_1c
    add-int/lit8 v0, v0, 0x1

    goto :goto_12

    .line 388
    :cond_1f
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v3, v3, v0

    invoke-virtual {v3}, Lorg/jbox2d/collision/AABB;->getPerimeter()F

    move-result v3

    add-float/2addr v1, v3

    goto :goto_1c

    .line 391
    :cond_29
    div-float/2addr v1, v2

    goto :goto_6
.end method

.method public final getFatAABB(I)Lorg/jbox2d/collision/AABB;
    .registers 3

    .prologue
    .line 162
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_10

    if-ltz p1, :cond_a

    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCount:I

    if-lt p1, v0, :cond_10

    :cond_a
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 163
    :cond_10
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v0, v0, p1

    return-object v0
.end method

.method public getHeight()I
    .registers 3

    .prologue
    .line 347
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    const/4 v1, -0x1

    if-ne v0, v1, :cond_7

    .line 348
    const/4 v0, 0x0

    .line 350
    :goto_6
    return v0

    :cond_7
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    iget v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    aget v0, v0, v1

    goto :goto_6
.end method

.method public getMaxBalance()I
    .registers 6

    .prologue
    const/4 v0, 0x0

    .line 355
    move v1, v0

    .line 356
    :goto_2
    iget v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-ge v0, v2, :cond_3c

    .line 357
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v2, v2, v0

    const/4 v3, 0x1

    if-gt v2, v3, :cond_10

    .line 356
    :goto_d
    add-int/lit8 v0, v0, 0x1

    goto :goto_2

    .line 361
    :cond_10
    sget-boolean v2, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v2, :cond_21

    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v2, v2, v0

    const/4 v3, -0x1

    if-ne v2, v3, :cond_21

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 363
    :cond_21
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v2, v2, v0

    .line 364
    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v3, v3, v0

    .line 365
    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v3, v4, v3

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_height:[I

    aget v2, v4, v2

    sub-int v2, v3, v2

    invoke-static {v2}, Lorg/jbox2d/common/MathUtils;->abs(I)I

    move-result v2

    .line 366
    invoke-static {v1, v2}, Lorg/jbox2d/common/MathUtils;->max(II)I

    move-result v1

    goto :goto_d

    .line 369
    :cond_3c
    return v1
.end method

.method public final getUserData(I)Ljava/lang/Object;
    .registers 3

    .prologue
    .line 156
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_10

    if-ltz p1, :cond_a

    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCount:I

    if-lt p1, v0, :cond_10

    :cond_a
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 157
    :cond_10
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_userData:[Ljava/lang/Object;

    aget-object v0, v0, p1

    return-object v0
.end method

.method public final moveProxy(ILorg/jbox2d/collision/AABB;Lorg/jbox2d/common/Vec2;)Z
    .registers 10

    .prologue
    const/4 v5, 0x0

    .line 114
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_11

    if-ltz p1, :cond_b

    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt p1, v0, :cond_11

    :cond_b
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 116
    :cond_11
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_22

    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v0, v0, p1

    const/4 v1, -0x1

    if-eq v0, v1, :cond_22

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 118
    :cond_22
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v0, v0, p1

    .line 120
    iget-object v1, v0, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget v1, v1, Lorg/jbox2d/common/Vec2;->x:F

    iget-object v2, p2, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget v2, v2, Lorg/jbox2d/common/Vec2;->x:F

    cmpg-float v1, v1, v2

    if-gtz v1, :cond_58

    iget-object v1, v0, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget v1, v1, Lorg/jbox2d/common/Vec2;->y:F

    iget-object v2, p2, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget v2, v2, Lorg/jbox2d/common/Vec2;->y:F

    cmpg-float v1, v1, v2

    if-gtz v1, :cond_58

    iget-object v1, p2, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget v1, v1, Lorg/jbox2d/common/Vec2;->x:F

    iget-object v2, v0, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget v2, v2, Lorg/jbox2d/common/Vec2;->x:F

    cmpg-float v1, v1, v2

    if-gtz v1, :cond_58

    iget-object v1, p2, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget v1, v1, Lorg/jbox2d/common/Vec2;->y:F

    iget-object v2, v0, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget v2, v2, Lorg/jbox2d/common/Vec2;->y:F

    cmpg-float v1, v1, v2

    if-gtz v1, :cond_58

    .line 122
    const/4 v0, 0x0

    .line 151
    :goto_57
    return v0

    .line 125
    :cond_58
    invoke-direct {p0, p1}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->removeLeaf(I)V

    .line 128
    iget-object v1, v0, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    .line 129
    iget-object v0, v0, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    .line 130
    iget-object v2, p2, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget v2, v2, Lorg/jbox2d/common/Vec2;->x:F

    sget v3, Lorg/jbox2d/common/Settings;->aabbExtension:F

    sub-float/2addr v2, v3

    iput v2, v1, Lorg/jbox2d/common/Vec2;->x:F

    .line 131
    iget-object v2, p2, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget v2, v2, Lorg/jbox2d/common/Vec2;->y:F

    sget v3, Lorg/jbox2d/common/Settings;->aabbExtension:F

    sub-float/2addr v2, v3

    iput v2, v1, Lorg/jbox2d/common/Vec2;->y:F

    .line 132
    iget-object v2, p2, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget v2, v2, Lorg/jbox2d/common/Vec2;->x:F

    sget v3, Lorg/jbox2d/common/Settings;->aabbExtension:F

    add-float/2addr v2, v3

    iput v2, v0, Lorg/jbox2d/common/Vec2;->x:F

    .line 133
    iget-object v2, p2, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget v2, v2, Lorg/jbox2d/common/Vec2;->y:F

    sget v3, Lorg/jbox2d/common/Settings;->aabbExtension:F

    add-float/2addr v2, v3

    iput v2, v0, Lorg/jbox2d/common/Vec2;->y:F

    .line 136
    iget v2, p3, Lorg/jbox2d/common/Vec2;->x:F

    sget v3, Lorg/jbox2d/common/Settings;->aabbMultiplier:F

    mul-float/2addr v2, v3

    .line 137
    iget v3, p3, Lorg/jbox2d/common/Vec2;->y:F

    sget v4, Lorg/jbox2d/common/Settings;->aabbMultiplier:F

    mul-float/2addr v3, v4

    .line 138
    cmpg-float v4, v2, v5

    if-gez v4, :cond_a4

    .line 139
    iget v4, v1, Lorg/jbox2d/common/Vec2;->x:F

    add-float/2addr v2, v4

    iput v2, v1, Lorg/jbox2d/common/Vec2;->x:F

    .line 144
    :goto_96
    cmpg-float v2, v3, v5

    if-gez v2, :cond_aa

    .line 145
    iget v0, v1, Lorg/jbox2d/common/Vec2;->y:F

    add-float/2addr v0, v3

    iput v0, v1, Lorg/jbox2d/common/Vec2;->y:F

    .line 150
    :goto_9f
    invoke-direct {p0, p1}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->insertLeaf(I)V

    .line 151
    const/4 v0, 0x1

    goto :goto_57

    .line 141
    :cond_a4
    iget v4, v0, Lorg/jbox2d/common/Vec2;->x:F

    add-float/2addr v2, v4

    iput v2, v0, Lorg/jbox2d/common/Vec2;->x:F

    goto :goto_96

    .line 147
    :cond_aa
    iget v1, v0, Lorg/jbox2d/common/Vec2;->y:F

    add-float/2addr v1, v3

    iput v1, v0, Lorg/jbox2d/common/Vec2;->y:F

    goto :goto_9f
.end method

.method public final query(Lorg/jbox2d/callbacks/TreeCallback;Lorg/jbox2d/collision/AABB;)V
    .registers 9

    .prologue
    const/4 v5, -0x1

    .line 171
    const/4 v0, 0x0

    iput v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    .line 172
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    iget v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    add-int/lit8 v2, v1, 0x1

    iput v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    iget v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    aput v2, v0, v1

    .line 174
    :cond_10
    :goto_10
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    if-lez v0, :cond_36

    .line 175
    iget-object v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    iget v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    add-int/lit8 v1, v1, -0x1

    iput v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    aget v0, v0, v1

    .line 176
    if-eq v0, v5, :cond_10

    .line 180
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v1, v1, v0

    invoke-static {v1, p2}, Lorg/jbox2d/collision/AABB;->testOverlap(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)Z

    move-result v1

    if-eqz v1, :cond_10

    .line 181
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v1, v1, v0

    .line 182
    if-ne v1, v5, :cond_37

    .line 183
    invoke-interface {p1, v0}, Lorg/jbox2d/callbacks/TreeCallback;->treeCallback(I)Z

    move-result v0

    .line 184
    if-nez v0, :cond_10

    .line 197
    :cond_36
    return-void

    .line 188
    :cond_37
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    array-length v2, v2

    iget v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    sub-int/2addr v2, v3

    add-int/lit8 v2, v2, -0x2

    if-gtz v2, :cond_51

    .line 189
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    array-length v3, v3

    iget-object v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    array-length v4, v4

    mul-int/lit8 v4, v4, 0x2

    invoke-static {v2, v3, v4}, Lorg/jbox2d/common/BufferUtils;->reallocateBuffer([III)[I

    move-result-object v2

    iput-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    .line 192
    :cond_51
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    iget v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    add-int/lit8 v4, v3, 0x1

    iput v4, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    aput v1, v2, v3

    .line 193
    iget-object v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    iget v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    add-int/lit8 v3, v2, 0x1

    iput v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    iget-object v3, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v0, v3, v0

    aput v0, v1, v2

    goto :goto_10
.end method

.method public raycast(Lorg/jbox2d/callbacks/TreeRayCastCallback;Lorg/jbox2d/collision/RayCastInput;)V
    .registers 20

    .prologue
    .line 205
    move-object/from16 v0, p2

    iget-object v1, v0, Lorg/jbox2d/collision/RayCastInput;->p1:Lorg/jbox2d/common/Vec2;

    .line 206
    move-object/from16 v0, p2

    iget-object v3, v0, Lorg/jbox2d/collision/RayCastInput;->p2:Lorg/jbox2d/common/Vec2;

    .line 207
    iget v2, v1, Lorg/jbox2d/common/Vec2;->x:F

    iget v7, v3, Lorg/jbox2d/common/Vec2;->x:F

    iget v4, v1, Lorg/jbox2d/common/Vec2;->y:F

    iget v8, v3, Lorg/jbox2d/common/Vec2;->y:F

    .line 214
    move-object/from16 v0, p0

    iget-object v1, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->r:Lorg/jbox2d/common/Vec2;

    sub-float v3, v7, v2

    iput v3, v1, Lorg/jbox2d/common/Vec2;->x:F

    .line 215
    move-object/from16 v0, p0

    iget-object v1, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->r:Lorg/jbox2d/common/Vec2;

    sub-float v3, v8, v4

    iput v3, v1, Lorg/jbox2d/common/Vec2;->y:F

    .line 216
    sget-boolean v1, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v1, :cond_4a

    move-object/from16 v0, p0

    iget-object v1, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->r:Lorg/jbox2d/common/Vec2;

    iget v1, v1, Lorg/jbox2d/common/Vec2;->x:F

    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->r:Lorg/jbox2d/common/Vec2;

    iget v3, v3, Lorg/jbox2d/common/Vec2;->x:F

    mul-float/2addr v1, v3

    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->r:Lorg/jbox2d/common/Vec2;

    iget v3, v3, Lorg/jbox2d/common/Vec2;->y:F

    move-object/from16 v0, p0

    iget-object v5, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->r:Lorg/jbox2d/common/Vec2;

    iget v5, v5, Lorg/jbox2d/common/Vec2;->y:F

    mul-float/2addr v3, v5

    add-float/2addr v1, v3

    const/4 v3, 0x0

    cmpl-float v1, v1, v3

    if-gtz v1, :cond_4a

    new-instance v1, Ljava/lang/AssertionError;

    invoke-direct {v1}, Ljava/lang/AssertionError;-><init>()V

    throw v1

    .line 217
    :cond_4a
    move-object/from16 v0, p0

    iget-object v1, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->r:Lorg/jbox2d/common/Vec2;

    invoke-virtual {v1}, Lorg/jbox2d/common/Vec2;->normalize()F

    .line 218
    move-object/from16 v0, p0

    iget-object v1, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->r:Lorg/jbox2d/common/Vec2;

    iget v1, v1, Lorg/jbox2d/common/Vec2;->x:F

    .line 219
    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->r:Lorg/jbox2d/common/Vec2;

    iget v3, v3, Lorg/jbox2d/common/Vec2;->y:F

    .line 222
    const/high16 v5, -0x40800000    # -1.0f

    mul-float v9, v5, v3

    .line 223
    const/high16 v3, 0x3f800000    # 1.0f

    mul-float v10, v3, v1

    .line 224
    invoke-static {v9}, Lorg/jbox2d/common/MathUtils;->abs(F)F

    move-result v11

    .line 225
    invoke-static {v10}, Lorg/jbox2d/common/MathUtils;->abs(F)F

    move-result v12

    .line 230
    move-object/from16 v0, p2

    iget v6, v0, Lorg/jbox2d/collision/RayCastInput;->maxFraction:F

    .line 233
    move-object/from16 v0, p0

    iget-object v13, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->aabb:Lorg/jbox2d/collision/AABB;

    .line 239
    sub-float v1, v7, v2

    mul-float/2addr v1, v6

    add-float v3, v1, v2

    .line 240
    sub-float v1, v8, v4

    mul-float/2addr v1, v6

    add-float v5, v1, v4

    .line 241
    iget-object v14, v13, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    cmpg-float v1, v2, v3

    if-gez v1, :cond_17b

    move v1, v2

    :goto_86
    iput v1, v14, Lorg/jbox2d/common/Vec2;->x:F

    .line 242
    iget-object v14, v13, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    cmpg-float v1, v4, v5

    if-gez v1, :cond_17e

    move v1, v4

    :goto_8f
    iput v1, v14, Lorg/jbox2d/common/Vec2;->y:F

    .line 243
    iget-object v1, v13, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    cmpl-float v14, v2, v3

    if-lez v14, :cond_98

    move v3, v2

    :cond_98
    iput v3, v1, Lorg/jbox2d/common/Vec2;->x:F

    .line 244
    iget-object v1, v13, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    cmpl-float v3, v4, v5

    if-lez v3, :cond_a1

    move v5, v4

    :cond_a1
    iput v5, v1, Lorg/jbox2d/common/Vec2;->y:F

    .line 247
    const/4 v1, 0x0

    move-object/from16 v0, p0

    iput v1, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    .line 248
    move-object/from16 v0, p0

    iget-object v1, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    move-object/from16 v0, p0

    iget v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    add-int/lit8 v5, v3, 0x1

    move-object/from16 v0, p0

    iput v5, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    move-object/from16 v0, p0

    iget v5, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    aput v5, v1, v3

    :goto_bc
    move v1, v6

    .line 249
    :cond_bd
    :goto_bd
    move-object/from16 v0, p0

    iget v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    if-lez v3, :cond_17a

    .line 250
    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    move-object/from16 v0, p0

    iget v5, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    add-int/lit8 v5, v5, -0x1

    move-object/from16 v0, p0

    iput v5, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    move-object/from16 v0, p0

    iget v6, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    aput v6, v3, v5

    .line 251
    const/4 v3, -0x1

    if-eq v6, v3, :cond_bd

    .line 255
    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_aabb:[Lorg/jbox2d/collision/AABB;

    aget-object v3, v3, v6

    .line 256
    invoke-static {v3, v13}, Lorg/jbox2d/collision/AABB;->testOverlap(Lorg/jbox2d/collision/AABB;Lorg/jbox2d/collision/AABB;)Z

    move-result v5

    if-eqz v5, :cond_bd

    .line 264
    iget-object v5, v3, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget v5, v5, Lorg/jbox2d/common/Vec2;->x:F

    iget-object v14, v3, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget v14, v14, Lorg/jbox2d/common/Vec2;->x:F

    add-float/2addr v5, v14

    const/high16 v14, 0x3f000000    # 0.5f

    mul-float/2addr v5, v14

    .line 265
    iget-object v14, v3, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget v14, v14, Lorg/jbox2d/common/Vec2;->y:F

    iget-object v15, v3, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget v15, v15, Lorg/jbox2d/common/Vec2;->y:F

    add-float/2addr v14, v15

    const/high16 v15, 0x3f000000    # 0.5f

    mul-float/2addr v14, v15

    .line 266
    iget-object v15, v3, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    iget v15, v15, Lorg/jbox2d/common/Vec2;->x:F

    iget-object v0, v3, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    move-object/from16 v16, v0

    move-object/from16 v0, v16

    iget v0, v0, Lorg/jbox2d/common/Vec2;->x:F

    move/from16 v16, v0

    sub-float v15, v15, v16

    const/high16 v16, 0x3f000000    # 0.5f

    mul-float v15, v15, v16

    .line 267
    iget-object v0, v3, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    move-object/from16 v16, v0

    move-object/from16 v0, v16

    iget v0, v0, Lorg/jbox2d/common/Vec2;->y:F

    move/from16 v16, v0

    iget-object v3, v3, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    iget v3, v3, Lorg/jbox2d/common/Vec2;->y:F

    sub-float v3, v16, v3

    const/high16 v16, 0x3f000000    # 0.5f

    mul-float v3, v3, v16

    .line 268
    sub-float v5, v2, v5

    .line 269
    sub-float v14, v4, v14

    .line 270
    mul-float/2addr v5, v9

    mul-float/2addr v14, v10

    add-float/2addr v5, v14

    invoke-static {v5}, Lorg/jbox2d/common/MathUtils;->abs(F)F

    move-result v5

    mul-float v14, v11, v15

    mul-float/2addr v3, v12

    add-float/2addr v3, v14

    sub-float v3, v5, v3

    .line 271
    const/4 v5, 0x0

    cmpl-float v3, v3, v5

    if-gtz v3, :cond_bd

    .line 275
    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child1:[I

    aget v3, v3, v6

    .line 276
    const/4 v5, -0x1

    if-ne v3, v5, :cond_1ba

    .line 277
    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->subInput:Lorg/jbox2d/collision/RayCastInput;

    iget-object v3, v3, Lorg/jbox2d/collision/RayCastInput;->p1:Lorg/jbox2d/common/Vec2;

    iput v2, v3, Lorg/jbox2d/common/Vec2;->x:F

    .line 278
    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->subInput:Lorg/jbox2d/collision/RayCastInput;

    iget-object v3, v3, Lorg/jbox2d/collision/RayCastInput;->p1:Lorg/jbox2d/common/Vec2;

    iput v4, v3, Lorg/jbox2d/common/Vec2;->y:F

    .line 279
    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->subInput:Lorg/jbox2d/collision/RayCastInput;

    iget-object v3, v3, Lorg/jbox2d/collision/RayCastInput;->p2:Lorg/jbox2d/common/Vec2;

    iput v7, v3, Lorg/jbox2d/common/Vec2;->x:F

    .line 280
    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->subInput:Lorg/jbox2d/collision/RayCastInput;

    iget-object v3, v3, Lorg/jbox2d/collision/RayCastInput;->p2:Lorg/jbox2d/common/Vec2;

    iput v8, v3, Lorg/jbox2d/common/Vec2;->y:F

    .line 281
    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->subInput:Lorg/jbox2d/collision/RayCastInput;

    iput v1, v3, Lorg/jbox2d/collision/RayCastInput;->maxFraction:F

    .line 283
    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->subInput:Lorg/jbox2d/collision/RayCastInput;

    move-object/from16 v0, p1

    invoke-interface {v0, v3, v6}, Lorg/jbox2d/callbacks/TreeRayCastCallback;->raycastCallback(Lorg/jbox2d/collision/RayCastInput;I)F

    move-result v6

    .line 285
    const/4 v3, 0x0

    cmpl-float v3, v6, v3

    if-nez v3, :cond_181

    .line 308
    :cond_17a
    return-void

    :cond_17b
    move v1, v3

    .line 241
    goto/16 :goto_86

    :cond_17e
    move v1, v5

    .line 242
    goto/16 :goto_8f

    .line 290
    :cond_181
    const/4 v3, 0x0

    cmpl-float v3, v6, v3

    if-lez v3, :cond_bd

    .line 296
    sub-float v1, v7, v2

    mul-float/2addr v1, v6

    add-float v3, v1, v2

    .line 297
    sub-float v1, v8, v4

    mul-float/2addr v1, v6

    add-float v5, v1, v4

    .line 298
    iget-object v14, v13, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    cmpg-float v1, v2, v3

    if-gez v1, :cond_1b6

    move v1, v2

    :goto_197
    iput v1, v14, Lorg/jbox2d/common/Vec2;->x:F

    .line 299
    iget-object v14, v13, Lorg/jbox2d/collision/AABB;->lowerBound:Lorg/jbox2d/common/Vec2;

    cmpg-float v1, v4, v5

    if-gez v1, :cond_1b8

    move v1, v4

    :goto_1a0
    iput v1, v14, Lorg/jbox2d/common/Vec2;->y:F

    .line 300
    iget-object v1, v13, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    cmpl-float v14, v2, v3

    if-lez v14, :cond_1a9

    move v3, v2

    :cond_1a9
    iput v3, v1, Lorg/jbox2d/common/Vec2;->x:F

    .line 301
    iget-object v1, v13, Lorg/jbox2d/collision/AABB;->upperBound:Lorg/jbox2d/common/Vec2;

    cmpl-float v3, v4, v5

    if-lez v3, :cond_1b2

    move v5, v4

    :cond_1b2
    iput v5, v1, Lorg/jbox2d/common/Vec2;->y:F

    goto/16 :goto_bc

    :cond_1b6
    move v1, v3

    .line 298
    goto :goto_197

    :cond_1b8
    move v1, v5

    .line 299
    goto :goto_1a0

    .line 304
    :cond_1ba
    move-object/from16 v0, p0

    iget-object v5, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    move-object/from16 v0, p0

    iget v14, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    add-int/lit8 v15, v14, 0x1

    move-object/from16 v0, p0

    iput v15, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    aput v3, v5, v14

    .line 305
    move-object/from16 v0, p0

    iget-object v3, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStack:[I

    move-object/from16 v0, p0

    iget v5, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    add-int/lit8 v14, v5, 0x1

    move-object/from16 v0, p0

    iput v14, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->nodeStackIndex:I

    move-object/from16 v0, p0

    iget-object v14, v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_child2:[I

    aget v6, v14, v6

    aput v6, v3, v5

    goto/16 :goto_bd
.end method

.method public validate()V
    .registers 4

    .prologue
    .line 330
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    invoke-direct {p0, v0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->validateStructure(I)V

    .line 331
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_root:I

    invoke-direct {p0, v0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->validateMetrics(I)V

    .line 333
    const/4 v1, 0x0

    .line 334
    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_freeList:I

    .line 335
    :goto_d
    const/4 v2, -0x1

    if-eq v0, v2, :cond_27

    .line 336
    sget-boolean v2, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v2, :cond_20

    if-ltz v0, :cond_1a

    iget v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-lt v0, v2, :cond_20

    :cond_1a
    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 337
    :cond_20
    iget-object v2, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_parent:[I

    aget v0, v2, v0

    .line 338
    add-int/lit8 v1, v1, 0x1

    goto :goto_d

    .line 341
    :cond_27
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_3b

    invoke-virtual {p0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->getHeight()I

    move-result v0

    invoke-virtual {p0}, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->computeHeight()I

    move-result v2

    if-eq v0, v2, :cond_3b

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 342
    :cond_3b
    sget-boolean v0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->$assertionsDisabled:Z

    if-nez v0, :cond_4c

    iget v0, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCount:I

    add-int/2addr v0, v1

    iget v1, p0, Lorg/jbox2d/collision/broadphase/DynamicTreeFlatNodes;->m_nodeCapacity:I

    if-eq v0, v1, :cond_4c

    new-instance v0, Ljava/lang/AssertionError;

    invoke-direct {v0}, Ljava/lang/AssertionError;-><init>()V

    throw v0

    .line 343
    :cond_4c
    return-void
.end method