// File: /workspace/github_cpp_makefile_star2_O2/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 0x15ae6
ucomisd (%rsp), %xmm0
jae 0x16fff
movq 0xd0(%rsp), %rbx
xorl %r14d, %r14d
movslq 0x34(%rbx), %rax
cmpq %rax, %r14
jge 0x16de5
movq 0x28(%rbx), %rax
movq (%rax,%r14,8), %rax
movl 0x14(%rbp), %ecx
cmpl %ecx, 0x14(%rax)
je 0x16de0
movl %ecx, 0x14(%rax)
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 (%rax)
callq 0x16128
popq %rax
popq %rcx
incq %r14
jmp 0x16d95
cmpq $0x0, 0x8(%rbx)
je 0x16eda
movslq 0x20(%rbx), %rax
movsd (%r13,%rax,8), %xmm1
subsd 0x18(%rbx), %xmm1
xorpd %xmm0, %xmm0
movsd %xmm1, 0x20(%rsp)
ucomisd %xmm1, %xmm0
jae 0x16f31
leaq 0x60(%rsp), %rdi
movq 0xd8(%rsp), %r14
movq %r14, %rsi
callq 0x35c9e
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 0x16d3c
popq %rax
popq %rcx
movsd 0x20(%rsp), %xmm0
mulsd %xmm0, %xmm0
movsd (%rsp), %xmm1
ucomisd %xmm0, %xmm1
jbe 0x16ed5
leaq 0x28(%rsp), %rdi
movq %r14, %rsi
callq 0x35c9e
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 0x16d3c
popq %rax
popq %rcx
leaq 0x28(%rsp), %rdi
callq 0x36966
jmp 0x16ff5
xorl %r14d, %r14d
movslq 0x44(%rbx), %rax
cmpq %rax, %r14
jge 0x16fff
movq 0x38(%rbx), %rax
movq (%rax,%r14,8), %rax
movl 0x14(%rbp), %ecx
cmpl %ecx, 0x14(%rax)
je 0x16f2c
movl %ecx, 0x14(%rax)
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 (%rax)
callq 0x16128
popq %rax
popq %rcx
incq %r14
jmp 0x16edd
leaq 0x60(%rsp), %rdi
movq 0xd8(%rsp), %r14
movq %r14, %rsi
callq 0x35c9e
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 0x16d3c
popq %rax
popq %rcx
movsd 0x20(%rsp), %xmm0
mulsd %xmm0, %xmm0
movsd (%rsp), %xmm1
ucomisd %xmm0, %xmm1
jbe 0x16ff5
leaq 0x28(%rsp), %rdi
movq %r14, %rsi
callq 0x35c9e
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 0x16d3c
popq %rax
popq %rcx
leaq 0x28(%rsp), %rdi
callq 0x36966
leaq 0x60(%rsp), %rdi
callq 0x36966
addq $0x98, %rsp
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq
movq %rax, %rbx
leaq 0x28(%rsp), %rdi
callq 0x36966
jmp 0x1703b
movq %rax, %rbx
leaq 0x28(%rsp), %rdi
callq 0x36966
jmp 0x1703b
jmp 0x17033
jmp 0x17038
movq %rax, %rbx
jmp 0x1703b
movq %rax, %rbx
leaq 0x60(%rsp), %rdi
callq 0x36966
movq %rbx, %rdi
callq 0xe820
nop