// File: /workspace/github_cpp_makefile_star2_O1/DavidLBruce[P]sim3dof/build/../src/FcTseO.cpp
// Function: FcTseO::FcTseO()
FcTseO::FcTseO()
{
  //
  // Input parameter defaults
  //
  frameTimeStep = 1.0/64.0;
  initFrameTime = 0.0;

  initOmega = 4.0;
  initPosY = 0.0;
  initPosYsigScale = 1.4;
  initVelY = 0.0;
  initVelYsig = 5.0;
  initWsig = 2.0;
//  procNoise = 0.1e-3;
  procNoise = 0.0128;

  //
  // Set matrix sizes.
  //
  eye.Eye(3);
  HH.Resize(1,3);
  HT.Resize(3,1);
  innovation.Resize(3,1);
  KK.Resize(3,1);
  phi.Resize(3,3);
  PP.Resize(3,3);
  QQ.Resize(3,3);
  stateVec.Resize(3,1);

}

// Assembly:
pushq %rbp
movq %rsp, %rbp
pushq %r15
pushq %r14
pushq %r13
pushq %r12
pushq %rbx
subq $0x38, %rsp
movq %rdi, %rbx
callq 0xa084
leaq 0x19a18(%rip), %rax     # 0x1d960
movq %rax, (%rbx)
leaq 0x158(%rbx), %rdi
xorps %xmm0, %xmm0
movq %rdi, -0x58(%rbp)
movl $0x1, %esi
movl $0x1, %edx
callq 0x13504
leaq 0x170(%rbx), %rdi
xorps %xmm0, %xmm0
movq %rdi, -0x50(%rbp)
movl $0x1, %esi
movl $0x1, %edx
callq 0x13504
leaq 0x188(%rbx), %rdi
xorps %xmm0, %xmm0
movq %rdi, -0x48(%rbp)
movl $0x1, %esi
movl $0x1, %edx
callq 0x13504
leaq 0x1a8(%rbx), %rdi
xorps %xmm0, %xmm0
movq %rdi, -0x40(%rbp)
movl $0x1, %esi
movl $0x1, %edx
callq 0x13504
leaq 0x1c0(%rbx), %rdi
xorps %xmm0, %xmm0
movq %rdi, -0x38(%rbp)
movl $0x1, %esi
movl $0x1, %edx
callq 0x13504
leaq 0x1e0(%rbx), %r15
xorps %xmm0, %xmm0
movq %r15, %rdi
movl $0x1, %esi
movl $0x1, %edx
callq 0x13504
leaq 0x1f8(%rbx), %r12
xorps %xmm0, %xmm0
movq %r12, %rdi
movl $0x1, %esi
movl $0x1, %edx
callq 0x13504
leaq 0x228(%rbx), %r13
xorps %xmm0, %xmm0
movq %r13, %rdi
movl $0x1, %esi
movl $0x1, %edx
callq 0x13504
leaq 0x248(%rbx), %r14
xorps %xmm0, %xmm0
movq %r14, %rdi
movl $0x1, %esi
movl $0x1, %edx
callq 0x13504
movabsq $0x3f90000000000000, %rax # imm = 0x3F90000000000000
movq %rax, 0x8(%rbx)
xorl %eax, %eax
movq %rax, 0xf8(%rbx)
movabsq $0x4010000000000000, %rcx # imm = 0x4010000000000000
movq %rcx, 0x100(%rbx)
movq %rax, 0x108(%rbx)
movabsq $0x3ff6666666666666, %rcx # imm = 0x3FF6666666666666
movq %rcx, 0x110(%rbx)
movq %rax, 0x118(%rbx)
movabsq $0x4014000000000000, %rax # imm = 0x4014000000000000
movq %rax, 0x120(%rbx)
movabsq $0x4000000000000000, %rax # imm = 0x4000000000000000
movq %rax, 0x128(%rbx)
movabsq $0x3f8a36e2eb1c432d, %rax # imm = 0x3F8A36E2EB1C432D
movq %rax, 0x130(%rbx)
movq -0x58(%rbp), %rdi
movl $0x3, %esi
callq 0x15484
xorps %xmm0, %xmm0
movq -0x50(%rbp), %rdi
movl $0x1, %esi
movl $0x3, %edx
callq 0x13668
xorps %xmm0, %xmm0
movq -0x48(%rbp), %rdi
movl $0x3, %esi
movl $0x1, %edx
callq 0x13668
xorps %xmm0, %xmm0
movq -0x40(%rbp), %rdi
movl $0x3, %esi
movl $0x1, %edx
callq 0x13668
xorps %xmm0, %xmm0
movq -0x38(%rbp), %rdi
movl $0x3, %esi
movl $0x1, %edx
callq 0x13668
xorps %xmm0, %xmm0
movq %r15, %rdi
movl $0x3, %esi
movl $0x3, %edx
callq 0x13668
xorps %xmm0, %xmm0
movq %r12, %rdi
movl $0x3, %esi
movl $0x3, %edx
callq 0x13668
xorps %xmm0, %xmm0
movq %r13, %rdi
movl $0x3, %esi
movl $0x3, %edx
callq 0x13668
xorps %xmm0, %xmm0
movq %r14, %rdi
movl $0x3, %esi
movl $0x1, %edx
callq 0x13668
addq $0x38, %rsp
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq
movq %rax, -0x30(%rbp)
jmp 0x41d1
movq %rax, -0x30(%rbp)
jmp 0x41d9
movq %rax, -0x30(%rbp)
jmp 0x41e1
movq %rax, -0x30(%rbp)
jmp 0x41e9
movq %rax, -0x30(%rbp)
jmp 0x41f2
movq %rax, -0x30(%rbp)
jmp 0x41fb
movq %rax, -0x30(%rbp)
jmp 0x4204
movq %rax, -0x30(%rbp)
jmp 0x420d
movq %rax, -0x30(%rbp)
jmp 0x4216
movq %rax, -0x30(%rbp)
movq %r14, %rdi
callq 0x13642
movq %r13, %rdi
callq 0x13642
movq %r12, %rdi
callq 0x13642
movq %r15, %rdi
callq 0x13642
movq -0x38(%rbp), %rdi
callq 0x13642
movq -0x40(%rbp), %rdi
callq 0x13642
movq -0x48(%rbp), %rdi
callq 0x13642
movq -0x50(%rbp), %rdi
callq 0x13642
movq -0x58(%rbp), %rdi
callq 0x13642
movq %rbx, %rdi
callq 0xa1e4
movq -0x30(%rbp), %rdi
callq 0x32d0
nop