// File: /workspace/github_cpp_makefile_star2_O3/tomfunkhouser[P]gaps/pkgs/R3Shapes/R3MeshSearchTree.cpp
// Function: gaps::R3MeshSearchTree::FindAll(gaps::R3Point const&, gaps::R3Vector const&, gaps::RNArray<gaps::R3MeshIntersection*>&, double, double, int (*)(gaps::R3Point const&, gaps::R3Vector const&, gaps::R3Mesh*, gaps::R3MeshFace*, void*), void*, gaps::R3MeshSearchTreeNode*, gaps::R3Box const&) const
void R3MeshSearchTree::
FindAll(const R3Point& query_position, const R3Vector& query_normal, RNArray<R3MeshIntersection *>& hits, 
  RNScalar min_distance_squared, RNScalar max_distance_squared, 
  int (*IsCompatible)(const R3Point&, const R3Vector&, R3Mesh *, R3MeshFace *, void *), void *compatible_data,
  R3MeshSearchTreeNode *node, const R3Box& node_box) const
{
  // Compute distance (squared) from query point to node bbox
  RNScalar distance_squared = DistanceSquared(query_position, node_box, max_distance_squared);
  if (distance_squared >= max_distance_squared) return;

  // Check each big face
  for (int i = 0; i < node->big_faces.NEntries(); i++) {
    // Get face container and check mark
    R3MeshSearchTreeFace *face_container = node->big_faces[i];
    if (face_container->mark == mark) continue;
    face_container->mark = mark;
  
    // Find point in mesh face
    FindAll(query_position, query_normal, hits, 
      min_distance_squared, max_distance_squared, 
      IsCompatible, compatible_data, face_container->face);
  }

  // Check if node is interior
  if (node->children[0]) {
    assert(node->children[1]);
    assert(node->small_faces.IsEmpty());

    // Compute distance from query point to split plane
    RNScalar side = query_position[node->split_dimension] - node->split_coordinate;

    // Search children nodes
    if (side <= 0) {
      // Search negative side first
      R3Box child_box(node_box);
      child_box[RN_HI][node->split_dimension] = node->split_coordinate;
      FindAll(query_position, query_normal, hits, 
        min_distance_squared, max_distance_squared, IsCompatible, compatible_data,
        node->children[0], child_box);
      if (side*side < max_distance_squared) {
        R3Box child_box(node_box);
        child_box[RN_LO][node->split_dimension] = node->split_coordinate;
        FindAll(query_position, query_normal, hits, 
          min_distance_squared, max_distance_squared, IsCompatible, compatible_data,
          node->children[1], child_box);
      }
    }
    else {
      // Search positive side first
      R3Box child_box(node_box);
      child_box[RN_LO][node->split_dimension] = node->split_coordinate;
      FindAll(query_position, query_normal, hits, 
        min_distance_squared, max_distance_squared, IsCompatible, compatible_data,
        node->children[1], child_box);
      if (side*side < max_distance_squared) {
        R3Box child_box(node_box);
        child_box[RN_HI][node->split_dimension] = node->split_coordinate;
        FindAll(query_position, query_normal, hits, 
          min_distance_squared, max_distance_squared, IsCompatible, compatible_data,
          node->children[0], child_box);
      }
    }
  }
  else {
    // Check each small face
    for (int i = 0; i < node->small_faces.NEntries(); i++) {
      // Get face container and check mark
      R3MeshSearchTreeFace *face_container = node->small_faces[i];
      if (face_container->mark == mark) continue;
      face_container->mark = mark;

      // Find point in mesh face
      FindAll(query_position, query_normal, hits, 
        min_distance_squared, max_distance_squared, 
        IsCompatible, compatible_data, face_container->face);
    }
  }
}

// Assembly:
pushq %rbp
pushq %r15
pushq %r14
pushq %r13
pushq %r12
pushq %rbx
subq $0x98, %rsp
movq %r9, 0x18(%rsp)
movq %r8, 0x10(%rsp)
movsd %xmm1, (%rsp)
movsd %xmm0, 0x8(%rsp)
movq %rcx, %r15
movq %rdx, %r12
movq %rsi, %r13
movq %rdi, %rbp
movq 0xd8(%rsp), %rdx
movapd %xmm1, %xmm0
callq 0x17134
ucomisd (%rsp), %xmm0
jae 0x1880e
movq 0xd0(%rsp), %rbx
movl 0x34(%rbx), %eax
testl %eax, %eax
jle 0x185db
xorl %r14d, %r14d
movq 0x28(%rbx), %rcx
movq (%rcx,%r14,8), %r10
movl 0x14(%rbp), %ecx
cmpl %ecx, 0x14(%r10)
je 0x185d0
movl %ecx, 0x14(%r10)
subq $0x8, %rsp
movq %rbp, %rdi
movq %r13, %rsi
movq %r12, %rdx
movq %r15, %rcx
movsd 0x10(%rsp), %xmm0
movsd 0x8(%rsp), %xmm1
movq 0x18(%rsp), %r8
movq 0x20(%rsp), %r9
pushq (%r10)
callq 0x177be
addq $0x10, %rsp
movl 0x34(%rbx), %eax
incq %r14
movslq %eax, %rcx
cmpq %rcx, %r14
jl 0x18586
cmpq $0x0, 0x8(%rbx)
je 0x186d4
movslq 0x20(%rbx), %rax
movsd (%r13,%rax,8), %xmm1
subsd 0x18(%rbx), %xmm1
xorpd %xmm0, %xmm0
movsd %xmm1, 0x20(%rsp)
ucomisd %xmm1, %xmm0
jae 0x1873c
leaq 0x60(%rsp), %rdi
movq 0xd8(%rsp), %r14
movq %r14, %rsi
callq 0x3aa88
movsd 0x18(%rbx), %xmm0
movslq 0x20(%rbx), %rax
movsd %xmm0, 0x68(%rsp,%rax,8)
movq %rbp, %rdi
movq %r13, %rsi
movq %r12, %rdx
movq %r15, %rcx
movsd 0x8(%rsp), %xmm0
movsd (%rsp), %xmm1
movq 0x10(%rsp), %r8
movq 0x18(%rsp), %r9
leaq 0x60(%rsp), %rax
pushq %rax
pushq 0x10(%rbx)
callq 0x18526
addq $0x10, %rsp
movsd 0x20(%rsp), %xmm0
mulsd %xmm0, %xmm0
movsd (%rsp), %xmm1
ucomisd %xmm0, %xmm1
jbe 0x186cf
leaq 0x28(%rsp), %rdi
movq %r14, %rsi
callq 0x3aa88
movsd 0x18(%rbx), %xmm0
movslq 0x20(%rbx), %rax
movsd %xmm0, 0x48(%rsp,%rax,8)
movq %rbp, %rdi
movq %r13, %rsi
movq %r12, %rdx
movq %r15, %rcx
movsd 0x8(%rsp), %xmm0
movsd (%rsp), %xmm1
movq 0x10(%rsp), %r8
movq 0x18(%rsp), %r9
leaq 0x28(%rsp), %rax
pushq %rax
pushq 0x8(%rbx)
callq 0x18526
addq $0x10, %rsp
leaq 0x28(%rsp), %rdi
callq 0x3b8a8
jmp 0x18804
movl 0x44(%rbx), %eax
testl %eax, %eax
jle 0x1880e
xorl %r14d, %r14d
movq 0x38(%rbx), %rcx
movq (%rcx,%r14,8), %r10
movl 0x14(%rbp), %ecx
cmpl %ecx, 0x14(%r10)
je 0x1872c
movl %ecx, 0x14(%r10)
subq $0x8, %rsp
movq %rbp, %rdi
movq %r13, %rsi
movq %r12, %rdx
movq %r15, %rcx
movsd 0x10(%rsp), %xmm0
movsd 0x8(%rsp), %xmm1
movq 0x18(%rsp), %r8
movq 0x20(%rsp), %r9
pushq (%r10)
callq 0x177be
addq $0x10, %rsp
movl 0x44(%rbx), %eax
incq %r14
movslq %eax, %rcx
cmpq %rcx, %r14
jl 0x186e2
jmp 0x1880e
leaq 0x60(%rsp), %rdi
movq 0xd8(%rsp), %r14
movq %r14, %rsi
callq 0x3aa88
movsd 0x18(%rbx), %xmm0
movslq 0x20(%rbx), %rax
movsd %xmm0, 0x80(%rsp,%rax,8)
movq %rbp, %rdi
movq %r13, %rsi
movq %r12, %rdx
movq %r15, %rcx
movsd 0x8(%rsp), %xmm0
movsd (%rsp), %xmm1
movq 0x10(%rsp), %r8
movq 0x18(%rsp), %r9
leaq 0x60(%rsp), %rax
pushq %rax
pushq 0x8(%rbx)
callq 0x18526
addq $0x10, %rsp
movsd 0x20(%rsp), %xmm0
mulsd %xmm0, %xmm0
movsd (%rsp), %xmm1
ucomisd %xmm0, %xmm1
jbe 0x18804
leaq 0x28(%rsp), %rdi
movq %r14, %rsi
callq 0x3aa88
movsd 0x18(%rbx), %xmm0
movslq 0x20(%rbx), %rax
movsd %xmm0, 0x30(%rsp,%rax,8)
movq %rbp, %rdi
movq %r13, %rsi
movq %r12, %rdx
movq %r15, %rcx
movsd 0x8(%rsp), %xmm0
movsd (%rsp), %xmm1
movq 0x10(%rsp), %r8
movq 0x18(%rsp), %r9
leaq 0x28(%rsp), %rax
pushq %rax
pushq 0x10(%rbx)
callq 0x18526
addq $0x10, %rsp
leaq 0x28(%rsp), %rdi
callq 0x3b8a8
leaq 0x60(%rsp), %rdi
callq 0x3b8a8
addq $0x98, %rsp
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq
movq %rax, %rbx
leaq 0x28(%rsp), %rdi
callq 0x3b8a8
jmp 0x1884a
movq %rax, %rbx
leaq 0x28(%rsp), %rdi
callq 0x3b8a8
jmp 0x1884a
jmp 0x18842
jmp 0x18847
movq %rax, %rbx
jmp 0x1884a
movq %rax, %rbx
leaq 0x60(%rsp), %rdi
callq 0x3b8a8
movq %rbx, %rdi
callq 0xe7f0