// File: /workspace/github_cpp_makefile_star2_O3/tomfunkhouser[P]gaps/pkgs/R3Surfels/R3SurfelBlock.cpp
// Function: gaps::R3SurfelBlock::R3SurfelBlock(gaps::R3SurfelPointSet const*)
R3SurfelBlock::
R3SurfelBlock(const R3SurfelPointSet *set)
  : surfels(NULL),
    nsurfels(set->NPoints()),
    position_origin(set->Centroid()),
    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 points
  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();
    }

    // Create 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 $0x78, %rsp
movq %rsi, %r14
movq %rdi, %r15
xorl %ebx, %ebx
movq %rbx, (%rdi)
movl 0x10(%rsi), %eax
movl %eax, 0x8(%rdi)
addq $0x10, %rdi
callq 0x327dc
leaq 0x28(%r15), %rdi
leaq 0x18(%r14), %rsi
movq %rdi, 0x8(%rsp)
callq 0x6d354
movq %rbx, 0x60(%r15)
movq %r15, (%rsp)
leaq 0x68(%r15), %r12
movsd 0xb18cc(%rip), %xmm0    # 0xdd168
movsd 0xb18cc(%rip), %xmm1    # 0xdd170
movq %r12, %rdi
callq 0xab9aa
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 0x2bd13
movups 0x50(%r14), %xmm0
movups %xmm0, (%r12)
movq (%rsp), %rcx
movsd 0x68(%rcx), %xmm0
movsd 0x70(%rcx), %xmm1
ucomisd %xmm1, %xmm0
ja 0x2b935
addsd %xmm1, %xmm0
mulsd 0xb180c(%rip), %xmm0    # 0xdd138
movq (%rsp), %rcx
movsd %xmm0, 0x60(%rcx)
shlq $0x4, %rax
leaq (%rax,%rax,2), %r12
movq %r12, %rdi
callq 0x13030
movq %rax, %r13
xorl %ebx, %ebx
leaq (%rbx,%r13), %rdi
callq 0x2b118
addq $0x30, %rbx
cmpq %rbx, %r12
jne 0x2b94a
movq (%rsp), %rax
movq %r13, (%rax)
cmpl $0x0, 0x10(%r14)
jle 0x2bd13
movl $0x2f, %ebx
movl $0x8, %ebp
xorl %esi, %esi
leaq 0x40(%rsp), %rdi
movq %r14, 0x10(%rsp)
movq %rsi, 0x18(%rsp)
movq 0x8(%r14), %r13
movq -0x8(%r13,%rbp), %rax
movq (%r13,%rbp), %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, %r15
callq 0x83dc2
movq (%rsp), %rax
movsd 0x10(%rax), %xmm0
movsd 0x18(%rax), %xmm1
movsd 0x20(%rax), %xmm2
leaq 0x20(%rsp), %r12
movq %r12, %rdi
callq 0x84856
movq %r15, %r14
leaq 0x60(%rsp), %rdi
movq %r15, %rsi
movq %r12, %rdx
callq 0x847e3
movq (%r13,%rbp), %rax
movswl 0x10(%rax), %ecx
xorps %xmm0, %xmm0
cvtsi2ss %ecx, %xmm0
movss 0xb19f0(%rip), %xmm3    # 0xdd400
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 0x84856
movq (%r13,%rbp), %rax
movswl 0x16(%rax), %ecx
xorps %xmm0, %xmm0
cvtsi2ss %ecx, %xmm0
movss 0xb19a2(%rip), %xmm3    # 0xdd400
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
leaq 0x20(%rsp), %rdi
callq 0x84856
movq (%rsp), %rax
movq (%rax), %rax
xorps %xmm0, %xmm0
cvtsd2ss 0x70(%rsp), %xmm0
cvtpd2ps 0x60(%rsp), %xmm1
movlpd %xmm1, -0x2f(%rax,%rbx)
movss %xmm0, -0x27(%rax,%rbx)
xorps %xmm0, %xmm0
cvtsd2ss 0x50(%rsp), %xmm0
cvtpd2ps 0x40(%rsp), %xmm1
xorps %xmm2, %xmm2
cvtss2sd %xmm0, %xmm2
movsd 0xb22ea(%rip), %xmm5    # 0xdddc0
mulsd %xmm5, %xmm2
movsd 0xb1656(%rip), %xmm6    # 0xdd138
addsd %xmm6, %xmm2
cvttsd2si %xmm2, %ecx
cvtps2pd %xmm1, %xmm2
movapd 0xb228b(%rip), %xmm3    # 0xddd80
mulpd %xmm3, %xmm2
movapd 0xb228f(%rip), %xmm4    # 0xddd90
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 %r15, %rdi
jne 0x2bb38
jp 0x2bb38
shufps $0x55, %xmm1, %xmm1     # xmm1 = xmm1[1,1,1,1]
ucomiss %xmm7, %xmm1
jne 0x2bb38
jp 0x2bb38
ucomiss %xmm7, %xmm0
jne 0x2bb38
jnp 0x2bb3c
orb $0x40, (%rax,%rbx)
xorps %xmm0, %xmm0
cvtsd2ss 0x30(%rsp), %xmm0
cvtpd2ps 0x20(%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
movq 0x10(%rsp), %r14
jne 0x2bb9b
jp 0x2bb9b
shufps $0x55, %xmm1, %xmm1     # xmm1 = xmm1[1,1,1,1]
ucomiss %xmm7, %xmm1
jne 0x2bb9b
jp 0x2bb9b
ucomiss %xmm7, %xmm0
jne 0x2bb9b
jnp 0x2bb9f
orb $0x1, (%rax,%rbx)
movq (%r13,%rbp), %rcx
movzwl 0x1c(%rcx), %edx
xorps %xmm0, %xmm0
cvtsi2ss %edx, %xmm0
movss 0xb2249(%rip), %xmm2    # 0xdde00
mulss %xmm2, %xmm0
cvtss2sd %xmm0, %xmm0
movsd 0xb2201(%rip), %xmm3    # 0xdddc8
mulsd %xmm3, %xmm0
addsd %xmm6, %xmm0
cvtsd2ss %xmm0, %xmm0
movss 0xb21fd(%rip), %xmm4    # 0xdddd8
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 0xb21a3(%rip), %xmm2    # 0xdddd0
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 0xb2159(%rip), %xmm0    # 0xddddc
ucomiss %xmm1, %xmm0
movq 0x18(%rsp), %rsi
ja 0x2bca1
ucomiss 0xb214c(%rip), %xmm1    # 0xddde0
movaps %xmm1, %xmm0
jbe 0x2bca1
movss 0xb213f(%rip), %xmm0    # 0xddde0
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(%r13,%rbp), %rcx
movq (%r13,%rbp), %rdx
xorps %xmm0, %xmm0
cvtss2sd 0xc(%rdx), %xmm0
addsd 0x60(%rcx), %xmm0
movq (%rsp), %rcx
subsd 0x60(%rcx), %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
movslq 0x10(%r14), %rax
addq $0x30, %rbx
addq $0x10, %rbp
cmpq %rax, %rsi
jl 0x2b984
addq $0x78, %rsp
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq
jmp 0x2bd3a
jmp 0x2bd3a
jmp 0x2bd3a
jmp 0x2bd3a
movq %rax, %r14
movq %r13, %rdi
movq %r12, %rsi
callq 0x139b0
jmp 0x2bd3d
movq %rax, %r14
movq 0x8(%rsp), %rdi
callq 0x6e174
movq %r14, %rdi
callq 0x138b0
nop