// File: /workspace/github_cpp_makefile_star2_O2/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 0x9cd8
leaq 0x18a34(%rip), %rax     # 0x1c960
movq %rax, (%rbx)
leaq 0x158(%rbx), %rdi
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq %rdi, -0x58(%rbp)
movl %edx, %esi
callq 0x12cf8
leaq 0x170(%rbx), %rdi
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq %rdi, -0x50(%rbp)
movl %edx, %esi
callq 0x12cf8
leaq 0x188(%rbx), %rdi
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq %rdi, -0x48(%rbp)
movl %edx, %esi
callq 0x12cf8
leaq 0x1a8(%rbx), %rdi
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq %rdi, -0x40(%rbp)
movl %edx, %esi
callq 0x12cf8
leaq 0x1c0(%rbx), %rdi
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq %rdi, -0x38(%rbp)
movl %edx, %esi
callq 0x12cf8
leaq 0x1e0(%rbx), %r15
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq %r15, %rdi
movl %edx, %esi
callq 0x12cf8
leaq 0x1f8(%rbx), %r12
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq %r12, %rdi
movl %edx, %esi
callq 0x12cf8
leaq 0x228(%rbx), %r13
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq %r13, %rdi
movl %edx, %esi
callq 0x12cf8
leaq 0x248(%rbx), %r14
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq %r14, %rdi
movl %edx, %esi
callq 0x12cf8
movabsq $0x3f90000000000000, %rax # imm = 0x3F90000000000000
movq %rax, 0x8(%rbx)
andq $0x0, 0xf8(%rbx)
movabsq $0x4010000000000000, %rax # imm = 0x4010000000000000
movq %rax, 0x100(%rbx)
andq $0x0, 0x108(%rbx)
movabsq $0x3ff6666666666666, %rax # imm = 0x3FF6666666666666
movq %rax, 0x110(%rbx)
andq $0x0, 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)
pushq $0x3
popq %rsi
movq -0x58(%rbp), %rdi
callq 0x14970
pushq $0x1
popq %rsi
pushq $0x3
popq %rdx
xorps %xmm0, %xmm0
movq -0x50(%rbp), %rdi
callq 0x12dfc
pushq $0x3
popq %rsi
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq -0x48(%rbp), %rdi
callq 0x12dfc
pushq $0x3
popq %rsi
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq -0x40(%rbp), %rdi
callq 0x12dfc
pushq $0x3
popq %rsi
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq -0x38(%rbp), %rdi
callq 0x12dfc
pushq $0x3
popq %rdx
xorps %xmm0, %xmm0
movq %r15, %rdi
movl %edx, %esi
callq 0x12dfc
pushq $0x3
popq %rdx
xorps %xmm0, %xmm0
movq %r12, %rdi
movl %edx, %esi
callq 0x12dfc
pushq $0x3
popq %rdx
xorps %xmm0, %xmm0
movq %r13, %rdi
movl %edx, %esi
callq 0x12dfc
pushq $0x3
popq %rsi
pushq $0x1
popq %rdx
xorps %xmm0, %xmm0
movq %r14, %rdi
callq 0x12dfc
addq $0x38, %rsp
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq
movq %rax, -0x30(%rbp)
jmp 0x4164
movq %rax, -0x30(%rbp)
jmp 0x416c
movq %rax, -0x30(%rbp)
jmp 0x4174
movq %rax, -0x30(%rbp)
jmp 0x417c
movq %rax, -0x30(%rbp)
jmp 0x4185
movq %rax, -0x30(%rbp)
jmp 0x418e
movq %rax, -0x30(%rbp)
jmp 0x4197
movq %rax, -0x30(%rbp)
jmp 0x41a0
movq %rax, -0x30(%rbp)
jmp 0x41a9
movq %rax, -0x30(%rbp)
movq %r14, %rdi
callq 0x12dd8
movq %r13, %rdi
callq 0x12dd8
movq %r12, %rdi
callq 0x12dd8
movq %r15, %rdi
callq 0x12dd8
movq -0x38(%rbp), %rdi
callq 0x12dd8
movq -0x40(%rbp), %rdi
callq 0x12dd8
movq -0x48(%rbp), %rdi
callq 0x12dd8
movq -0x50(%rbp), %rdi
callq 0x12dd8
movq -0x58(%rbp), %rdi
callq 0x12dd8
movq %rbx, %rdi
callq 0x9dd6
movq -0x30(%rbp), %rdi
callq 0x3320