// File: /workspace/github_cpp_makefile_star2_O1/tomfunkhouser[P]gaps/pkgs/R3Surfels/R3SurfelBlock.cpp
// Function: gaps::R3SurfelBlock::R3SurfelBlock(gaps::R3SurfelPointSet const*, gaps::R3Point const&, double)
R3SurfelBlock::
R3SurfelBlock(const R3SurfelPointSet *set,
  const R3Point& position_origin, RNScalar timestamp_origin)
  : surfels(NULL),
    nsurfels(set->NPoints()),
    position_origin(position_origin),
    bbox(set->BBox()),
    timestamp_origin(0),
    timestamp_range(FLT_MAX,-FLT_MAX),
    min_identifier(UINT_MAX),
    max_identifier(0),
    resolution(0),
    flags(R3_SURFEL_BLOCK_BBOX_UPTODATE_FLAG),
    data(NULL),
    database(NULL),
    database_index(-1),
    file_surfels_offset(0),
    file_surfels_count(0),
    file_read_count(0),
    node(NULL),
    opengl_id(0)
{
  // Copy surfels
  if (nsurfels > 0) {
    // Set timestamp range and origin
    this->timestamp_range = set->TimestampRange();
    if (!this->timestamp_range.IsEmpty()) {
      this->timestamp_origin = this->timestamp_range.Mid();
    }

    // Copy surfels
    surfels = new R3Surfel [ nsurfels ];
    for (int i = 0; i < set->NPoints(); i++) {
      const R3SurfelPoint *point = set->Point(i);
      R3Point position = point->Position() - position_origin.Vector();
      R3Vector normal = point->Normal();
      R3Vector tangent = point->Tangent();
      R3Surfel *surfel = &surfels[i];
      surfel->SetPosition(position[0], position[1], position[2]);
      surfel->SetNormal(normal[0], normal[1], normal[2]);
      surfel->SetTangent(tangent[0], tangent[1], tangent[2]);
      surfel->SetRadius(0, point->Radius(0));
      surfel->SetRadius(1, point->Radius(1));
      surfel->SetDepth(point->Depth());
      surfel->SetElevation(point->Elevation());
      surfel->SetColor(point->Color());
      surfel->SetTimestamp(point->Timestamp() - timestamp_origin);
      surfel->SetIdentifier(point->Identifier());
      surfel->SetAttribute(point->Attribute());
      surfel->SetFlags(point->Flags() & ~R3_SURFEL_MARKED_FLAG);
    }
  }
}

// Assembly:
pushq %rbp
pushq %r15
pushq %r14
pushq %r13
pushq %r12
pushq %rbx
subq $0x88, %rsp
movsd %xmm0, 0x18(%rsp)
movq %rsi, %r15
movq %rdi, %r14
xorl %ebx, %ebx
movq %rbx, (%rdi)
movl 0x10(%rsi), %eax
movl %eax, 0x8(%rdi)
addq $0x10, %rdi
movq %rdx, 0x20(%rsp)
movq %rdx, %rsi
callq 0x84d8e
leaq 0x28(%r14), %rdi
leaq 0x18(%r15), %rsi
movq %rdi, 0x10(%rsp)
callq 0x6df88
movq %rbx, 0x60(%r14)
movq %r14, (%rsp)
leaq 0x68(%r14), %rbx
movsd 0xb1f99(%rip), %xmm0    # 0xde170
movsd 0xb1f99(%rip), %xmm1    # 0xde178
movq %rbx, %rdi
callq 0xace9e
movl $0xffffffff, %eax       # imm = 0xFFFFFFFF
movq (%rsp), %rcx
movq %rax, 0x78(%rcx)
movq $0x0, 0x80(%rcx)
movq $0x1, 0x88(%rcx)
xorpd %xmm0, %xmm0
movupd %xmm0, 0x90(%rcx)
movl $0xffffffff, 0xa0(%rcx) # imm = 0xFFFFFFFF
movupd %xmm0, 0xa8(%rcx)
movupd %xmm0, 0xb4(%rcx)
movslq 0x8(%rcx), %rax
testq %rax, %rax
jle 0x2c64b
movups 0x50(%r15), %xmm0
movups %xmm0, (%rbx)
movq (%rsp), %rcx
movsd 0x68(%rcx), %xmm0
movsd 0x70(%rcx), %xmm1
ucomisd %xmm1, %xmm0
ja 0x2c26e
addsd %xmm1, %xmm0
mulsd 0xb1edb(%rip), %xmm0    # 0xde140
movq (%rsp), %rcx
movsd %xmm0, 0x60(%rcx)
shlq $0x4, %rax
leaq (%rax,%rax,2), %rbx
movq %rbx, %rdi
callq 0x13030
movq %rax, %r13
movq %r15, 0x8(%rsp)
xorl %r15d, %r15d
leaq (%r15,%r13), %rdi
callq 0x2b548
addq $0x30, %r15
cmpq %r15, %rbx
jne 0x2c289
movq (%rsp), %rax
movq %r13, (%rax)
movq 0x8(%rsp), %rcx
cmpl $0x0, 0x10(%rcx)
jle 0x2c64b
movl $0x2f, %ebx
movl $0x8, %r13d
xorl %esi, %esi
leaq 0x50(%rsp), %rdi
leaq 0x30(%rsp), %r12
movq %rsi, 0x28(%rsp)
movq 0x8(%rcx), %r15
movq -0x8(%r15,%r13), %rax
movq (%r15,%r13), %rcx
xorps %xmm0, %xmm0
cvtss2sd (%rcx), %xmm0
addsd 0x10(%rax), %xmm0
xorps %xmm1, %xmm1
cvtss2sd 0x4(%rcx), %xmm1
addsd 0x18(%rax), %xmm1
xorps %xmm2, %xmm2
cvtss2sd 0x8(%rcx), %xmm2
addsd 0x20(%rax), %xmm2
movq %rdi, %rbp
callq 0x84d7e
movq 0x20(%rsp), %rax
movsd (%rax), %xmm0
movsd 0x8(%rax), %xmm1
movsd 0x10(%rax), %xmm2
movq %r12, %rdi
callq 0x85816
movq %rbp, %r14
leaq 0x70(%rsp), %rdi
movq %rbp, %rsi
movq %r12, %rdx
callq 0x857a5
movq (%r15,%r13), %rax
movswl 0x10(%rax), %ecx
xorps %xmm0, %xmm0
cvtsi2ss %ecx, %xmm0
movss 0xb20b3(%rip), %xmm3    # 0xde400
mulss %xmm3, %xmm0
cvtss2sd %xmm0, %xmm0
movswl 0x12(%rax), %ecx
xorps %xmm1, %xmm1
cvtsi2ss %ecx, %xmm1
movswl 0x14(%rax), %eax
xorps %xmm2, %xmm2
cvtsi2ss %eax, %xmm2
mulss %xmm3, %xmm1
cvtss2sd %xmm1, %xmm1
mulss %xmm3, %xmm2
cvtss2sd %xmm2, %xmm2
movq %r14, %rdi
callq 0x85816
movq (%r15,%r13), %rax
movswl 0x16(%rax), %ecx
xorps %xmm0, %xmm0
cvtsi2ss %ecx, %xmm0
movss 0xb2066(%rip), %xmm3    # 0xde400
mulss %xmm3, %xmm0
cvtss2sd %xmm0, %xmm0
movswl 0x18(%rax), %ecx
xorps %xmm1, %xmm1
cvtsi2ss %ecx, %xmm1
movswl 0x1a(%rax), %eax
xorps %xmm2, %xmm2
cvtsi2ss %eax, %xmm2
mulss %xmm3, %xmm1
cvtss2sd %xmm1, %xmm1
mulss %xmm3, %xmm2
cvtss2sd %xmm2, %xmm2
movq %r12, %rdi
callq 0x85816
movq (%rsp), %rax
movq (%rax), %rax
xorps %xmm0, %xmm0
cvtsd2ss 0x80(%rsp), %xmm0
cvtpd2ps 0x70(%rsp), %xmm1
movlpd %xmm1, -0x2f(%rax,%rbx)
movss %xmm0, -0x27(%rax,%rbx)
xorps %xmm0, %xmm0
cvtsd2ss 0x60(%rsp), %xmm0
cvtpd2ps 0x50(%rsp), %xmm1
xorps %xmm2, %xmm2
cvtss2sd %xmm0, %xmm2
movsd 0xb29bd(%rip), %xmm5    # 0xdedd0
mulsd %xmm5, %xmm2
movsd 0xb1d21(%rip), %xmm6    # 0xde140
addsd %xmm6, %xmm2
cvttsd2si %xmm2, %ecx
cvtps2pd %xmm1, %xmm2
movapd 0xb295e(%rip), %xmm3    # 0xded90
mulpd %xmm3, %xmm2
movapd 0xb2962(%rip), %xmm4    # 0xdeda0
addpd %xmm4, %xmm2
cvttpd2dq %xmm2, %xmm2
pshuflw $0xe8, %xmm2, %xmm2     # xmm2 = xmm2[0,2,2,3,4,5,6,7]
movd %xmm2, -0x1f(%rax,%rbx)
movw %cx, -0x1b(%rax,%rbx)
xorps %xmm7, %xmm7
ucomiss %xmm7, %xmm1
movq %rbp, %rdi
jne 0x2c475
jp 0x2c475
shufps $0x55, %xmm1, %xmm1     # xmm1 = xmm1[1,1,1,1]
ucomiss %xmm7, %xmm1
jne 0x2c475
jp 0x2c475
ucomiss %xmm7, %xmm0
jne 0x2c475
jnp 0x2c479
orb $0x40, (%rax,%rbx)
xorps %xmm0, %xmm0
cvtsd2ss 0x40(%rsp), %xmm0
cvtpd2ps 0x30(%rsp), %xmm1
xorps %xmm2, %xmm2
cvtss2sd %xmm0, %xmm2
mulsd %xmm5, %xmm2
addsd %xmm6, %xmm2
cvttsd2si %xmm2, %ecx
cvtps2pd %xmm1, %xmm2
mulpd %xmm3, %xmm2
addpd %xmm4, %xmm2
cvttpd2dq %xmm2, %xmm2
pshuflw $0xe8, %xmm2, %xmm2     # xmm2 = xmm2[0,2,2,3,4,5,6,7]
movd %xmm2, -0x19(%rax,%rbx)
movw %cx, -0x15(%rax,%rbx)
ucomiss %xmm7, %xmm1
jne 0x2c4d3
jp 0x2c4d3
shufps $0x55, %xmm1, %xmm1     # xmm1 = xmm1[1,1,1,1]
ucomiss %xmm7, %xmm1
jne 0x2c4d3
jp 0x2c4d3
ucomiss %xmm7, %xmm0
jne 0x2c4d3
jnp 0x2c4d7
orb $0x1, (%rax,%rbx)
movq (%r15,%r13), %rcx
movzwl 0x1c(%rcx), %edx
xorps %xmm0, %xmm0
cvtsi2ss %edx, %xmm0
movss 0xb2922(%rip), %xmm2    # 0xdee10
mulss %xmm2, %xmm0
cvtss2sd %xmm0, %xmm0
movsd 0xb28da(%rip), %xmm3    # 0xdedd8
mulsd %xmm3, %xmm0
addsd %xmm6, %xmm0
cvtsd2ss %xmm0, %xmm0
movss 0xb28d6(%rip), %xmm4    # 0xdede8
movaps %xmm4, %xmm1
minss %xmm0, %xmm1
cvttss2si %xmm1, %edx
movw %dx, -0x13(%rax,%rbx)
movzwl 0x1e(%rcx), %edx
xorps %xmm0, %xmm0
cvtsi2ss %edx, %xmm0
mulss %xmm2, %xmm0
cvtss2sd %xmm0, %xmm0
mulsd %xmm3, %xmm0
addsd %xmm6, %xmm0
cvtsd2ss %xmm0, %xmm0
movaps %xmm4, %xmm1
minss %xmm0, %xmm1
cvttss2si %xmm1, %edx
movw %dx, -0x11(%rax,%rbx)
movzwl 0x28(%rcx), %edx
xorps %xmm0, %xmm0
cvtsi2sd %edx, %xmm0
movsd 0xb287c(%rip), %xmm2    # 0xdede0
divsd %xmm2, %xmm0
cvtsd2ss %xmm0, %xmm0
cvtss2sd %xmm0, %xmm0
mulsd %xmm2, %xmm0
addsd %xmm6, %xmm0
cvtsd2ss %xmm0, %xmm0
movaps %xmm4, %xmm1
minss %xmm0, %xmm1
cvttss2si %xmm1, %edx
movw %dx, -0x7(%rax,%rbx)
movswl 0x2a(%rcx), %edx
xorps %xmm0, %xmm0
cvtsi2sd %edx, %xmm0
divsd %xmm2, %xmm0
cvtsd2ss %xmm0, %xmm0
cvtss2sd %xmm0, %xmm0
mulsd %xmm2, %xmm0
addsd %xmm6, %xmm0
xorps %xmm1, %xmm1
cvtsd2ss %xmm0, %xmm1
movss 0xb2832(%rip), %xmm0    # 0xdedec
ucomiss %xmm1, %xmm0
movq 0x28(%rsp), %rsi
ja 0x2c5d8
ucomiss 0xb2825(%rip), %xmm1    # 0xdedf0
movaps %xmm1, %xmm0
jbe 0x2c5d8
movss 0xb2818(%rip), %xmm0    # 0xdedf0
cvttss2si %xmm0, %edx
movw %dx, -0x5(%rax,%rbx)
movb 0x2c(%rcx), %dl
movb %dl, -0x3(%rax,%rbx)
movb 0x2d(%rcx), %dl
movb %dl, -0x2(%rax,%rbx)
movb 0x2e(%rcx), %cl
movb %cl, -0x1(%rax,%rbx)
movq -0x8(%r15,%r13), %rcx
movq (%r15,%r13), %rdx
xorps %xmm0, %xmm0
cvtss2sd 0xc(%rdx), %xmm0
addsd 0x60(%rcx), %xmm0
subsd 0x18(%rsp), %xmm0
cvtsd2ss %xmm0, %xmm0
movss %xmm0, -0x23(%rax,%rbx)
movq 0x20(%rdx), %rcx
movq %rcx, -0xf(%rax,%rbx)
movb 0x2f(%rdx), %cl
andb $0x7f, %cl
movb %cl, (%rax,%rbx)
incq %rsi
movq 0x8(%rsp), %rcx
movslq 0x10(%rcx), %rax
addq $0x30, %rbx
addq $0x10, %r13
cmpq %rax, %rsi
jl 0x2c2c8
addq $0x88, %rsp
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq
jmp 0x2c675
jmp 0x2c675
jmp 0x2c675
jmp 0x2c675
movq %rax, %r14
movq %r13, %rdi
movq %rbx, %rsi
callq 0x139b0
jmp 0x2c678
movq %rax, %r14
movq 0x10(%rsp), %rdi
callq 0x6ede0
movq %r14, %rdi
callq 0x138b0