user: 提供的汇编代码用C语言表示会是什么样子：

```asm
<inverseComposePoint>:
  endbr64
  push   %r13
  push   %r12
  push   %rbp
  push   %rbx
  sub    $0xa8,%rsp
  movaps %xmm4,%xmm14
  movaps %xmm5,%xmm15
  mov    %rdi,%r12
  mov    %rsi,%rbp
  mov    %rdx,%rbx
  mov    %r8,%r13
  movaps %xmm4,%xmm9
  mulss  %xmm4,%xmm9
  movaps %xmm9,%xmm4
  movaps %xmm5,%xmm11
  mulss  %xmm5,%xmm11
  movaps %xmm6,%xmm10
  movaps %xmm6,%xmm9
  mulss  %xmm6,%xmm10
  subss  %xmm0,%xmm7
  movss  %xmm7,0x4c(%rsp)
  addss  %xmm7,%xmm7
  movss  %xmm7,0x2c(%rsp)
  movss  0xd0(%rsp),%xmm0
  subss  %xmm1,%xmm0
  movaps %xmm0,%xmm7
  movss  %xmm0,0x50(%rsp)
  addss  %xmm0,%xmm7
  movss  %xmm7,(%rsp)
  movss  0xd8(%rsp),%xmm0
  subss  %xmm2,%xmm0
  movaps %xmm0,%xmm1
  movss  %xmm0,0x54(%rsp)
  addss  %xmm0,%xmm1
  movss  %xmm1,0x10(%rsp)
  movaps %xmm11,%xmm0
  addss  %xmm10,%xmm0
  addss  %xmm0,%xmm0
  movss  D161(%rip),%xmm1
  subss  %xmm0,%xmm1
  movss  %xmm1,(%rcx)
  movaps %xmm3,%xmm1
  movaps %xmm3,%xmm2
  xorps  D162(%rip),%xmm2
  movaps %xmm6,%xmm12
  mulss  %xmm2,%xmm12
  movaps %xmm14,%xmm6
  mulss  %xmm5,%xmm14
  movaps %xmm12,%xmm7
  addss  %xmm14,%xmm7
  movaps %xmm7,%xmm0
  movss  %xmm7,0x58(%rsp)
  addss  %xmm7,%xmm0
  movss  %xmm0,0x4(%rcx)
  movaps %xmm6,%xmm7
  mulss  %xmm9,%xmm7
  movss  %xmm3,0x4(%rsp)
  mulss  %xmm5,%xmm1
  movaps %xmm7,%xmm0
  addss  %xmm1,%xmm0
  movss  %xmm0,0x60(%rsp)
  addss  %xmm0,%xmm0
  movss  %xmm0,0x8(%rcx)
  movss  %xmm14,0x24(%rsp)
  movaps %xmm14,%xmm5
  movss  %xmm12,0x14(%rsp)
  subss  %xmm12,%xmm5
  movaps %xmm5,%xmm0
  movss  %xmm5,0x94(%rsp)
  addss  %xmm5,%xmm0
  movss  %xmm0,0xc(%rcx)
  movaps %xmm4,%xmm0
  addss  %xmm10,%xmm0
  addss  %xmm0,%xmm0
  movss  D161(%rip),%xmm14
  subss  %xmm0,%xmm14
  movss  %xmm14,0x10(%rcx)
  movaps %xmm2,%xmm13
  movss  %xmm6,0x30(%rsp)
  mulss  %xmm6,%xmm13
  movss  %xmm15,0x34(%rsp)
  movaps %xmm15,%xmm14
  movss  %xmm9,0x38(%rsp)
  mulss  %xmm9,%xmm14
  movaps %xmm13,%xmm0
  addss  %xmm14,%xmm0
  movss  %xmm0,0x68(%rsp)
  addss  %xmm0,%xmm0
  movss  %xmm0,0x14(%rcx)
  movaps %xmm1,%xmm9
  xorps  D162(%rip),%xmm9
  movss  %xmm9,0xc(%rsp)
  movss  %xmm7,0x5c(%rsp)
  movaps %xmm7,%xmm15
  subss  %xmm1,%xmm15
  movaps %xmm15,%xmm2
  movss  %xmm15,0x98(%rsp)
  addss  %xmm15,%xmm2
  movss  %xmm2,0x18(%rcx)
  movss  %xmm14,0x64(%rsp)
  movaps %xmm14,%xmm0
  movss  %xmm13,0x8(%rsp)
  subss  %xmm13,%xmm0
  movaps %xmm0,%xmm3
  movss  %xmm0,0x9c(%rsp)
  addss  %xmm0,%xmm3
  movss  %xmm3,0x1c(%rcx)
  movaps %xmm4,%xmm1
  addss  %xmm11,%xmm1
  movss  %xmm1,0x20(%rsp)
  addss  %xmm1,%xmm1
  movss  D161(%rip),%xmm14
  subss  %xmm1,%xmm14
  movss  %xmm14,0x20(%rcx)
  movss  0x4(%rsp),%xmm1
  movaps %xmm1,%xmm3
  mulss  %xmm1,%xmm3
  movss  %xmm3,0x6c(%rsp)
  movss  %xmm4,0x28(%rsp)
  addss  %xmm4,%xmm3
  movss  %xmm3,0x70(%rsp)
  movaps %xmm3,%xmm0
  movss  %xmm11,0x18(%rsp)
  addss  %xmm11,%xmm0
  movaps %xmm0,%xmm14
  movss  %xmm0,0x3c(%rsp)
  movss  %xmm10,0x1c(%rsp)
  addss  %xmm10,%xmm14
  movaps %xmm14,%xmm8
  mulss  %xmm14,%xmm8
  movaps %xmm8,%xmm0
  mulss  %xmm14,%xmm0
  cvtss2sd %xmm0,%xmm0
  mov    $0x1,%eax
  call   <inverseSqrt@plt>
  pxor   %xmm3,%xmm3
  cvtsi2ss %eax,%xmm3
  movss  0x18(%rsp),%xmm11
  movaps %xmm11,%xmm13
  addss  %xmm11,%xmm13
  movaps %xmm13,%xmm0
  movss  0x1c(%rsp),%xmm15
  movaps %xmm15,%xmm11
  addss  %xmm15,%xmm11
  movaps %xmm11,%xmm12
  movss  %xmm13,0x74(%rsp)
  addss  %xmm11,%xmm0
  subss  D161(%rip),%xmm0
  movss  %xmm0,0x0(%r13)
  movss  0x4(%rsp),%xmm7
  mulss  D2(%rip),%xmm7
  movss  0x38(%rsp),%xmm8
  movaps %xmm8,%xmm11
  mulss  %xmm7,%xmm11
  movd   %xmm11,%eax
  movss  0x30(%rsp),%xmm6
  movaps %xmm6,%xmm14
  addss  %xmm6,%xmm14
  movss  0x34(%rsp),%xmm11
  movaps %xmm11,%xmm13
  mulss  %xmm14,%xmm13
  movd   %eax,%xmm1
  movss  %xmm13,0x78(%rsp)
  subss  %xmm13,%xmm1
  movss  %xmm1,0x4(%r13)
  movaps %xmm7,%xmm1
  xorps  D162(%rip),%xmm1
  movaps %xmm11,%xmm13
  mulss  %xmm11,%xmm1
  movd   %xmm1,%edx
  movaps %xmm8,%xmm11
  mulss  %xmm14,%xmm11
  movss  %xmm11,0x7c(%rsp)
  subss  %xmm11,%xmm1
  movss  %xmm1,0x8(%r13)
  movaps %xmm13,%xmm0
  movaps %xmm13,%xmm1
  xorps  D162(%rip),%xmm1
  mulss  0x10(%rsp),%xmm1
  movaps %xmm8,%xmm11
  movss  (%rsp),%xmm2
  mulss  %xmm2,%xmm8
  movss  %xmm8,0x80(%rsp)
  movaps %xmm8,%xmm13
  addss  %xmm1,%xmm13
  movss  0x20(%rsp),%xmm9
  addss  %xmm15,%xmm9
  movaps %xmm9,%xmm5
  movaps %xmm0,%xmm8
  movaps %xmm0,%xmm9
  mulss  %xmm2,%xmm9
  movaps %xmm9,%xmm4
  movaps %xmm11,%xmm9
  movaps %xmm11,%xmm10
  mulss  0x10(%rsp),%xmm10
  movaps %xmm10,%xmm0
  movss  %xmm4,0x84(%rsp)
  movaps %xmm4,%xmm10
  addss  %xmm0,%xmm10
  movaps %xmm6,%xmm2
  mulss  (%rsp),%xmm2
  addss  %xmm8,%xmm8
  movss  0x4(%rsp),%xmm11
  movaps %xmm11,%xmm4
  mulss  0x10(%rsp),%xmm4
  movss  %xmm4,0x48(%rsp)
  movss  %xmm8,0x44(%rsp)
  mulss  0x2c(%rsp),%xmm8
  movaps %xmm8,%xmm4
  movss  %xmm2,0x88(%rsp)
  movaps %xmm2,%xmm8
  subss  %xmm4,%xmm8
  movaps %xmm8,%xmm2
  subss  0x48(%rsp),%xmm2
  movaps %xmm6,%xmm8
  mulss  0x10(%rsp),%xmm8
  movaps %xmm11,%xmm6
  mulss  (%rsp),%xmm6
  movaps %xmm9,%xmm11
  addss  %xmm9,%xmm11
  movss  %xmm6,0x8c(%rsp)
  movaps %xmm6,%xmm9
  addss  %xmm8,%xmm9
  movss  %xmm11,0x90(%rsp)
  mulss  0x2c(%rsp),%xmm11
  subss  %xmm11,%xmm9
  movss  %xmm5,0x40(%rsp)
  movaps %xmm5,%xmm11
  mulss  %xmm13,%xmm11
  movaps %xmm11,%xmm4
  movss  0x8(%rsp),%xmm11
  movaps %xmm11,%xmm5
  mulss  %xmm10,%xmm5
  addss  %xmm4,%xmm5
  movss  0xc(%rsp),%xmm4
  mulss  %xmm2,%xmm4
  addss  %xmm5,%xmm4
  movss  0x14(%rsp),%xmm6
  mulss  %xmm9,%xmm6
  addss  %xmm6,%xmm4
  mulss  %xmm3,%xmm4
  movss  %xmm4,0xc(%r13)
  movss  0x6c(%rsp),%xmm4
  addss  0x18(%rsp),%xmm4
  movaps %xmm4,%xmm5
  addss  %xmm15,%xmm5
  movss  %xmm5,0x20(%rsp)
  movss  0x24(%rsp),%xmm6
  xorps  D162(%rip),%xmm6
  movss  0x5c(%rsp),%xmm15
  xorps  D162(%rip),%xmm15
  movaps %xmm15,%xmm5
  movaps %xmm11,%xmm15
  mulss  %xmm13,%xmm15
  movaps %xmm15,%xmm4
  movss  0x20(%rsp),%xmm15
  mulss  %xmm10,%xmm15
  movaps %xmm15,%xmm11
  addss  %xmm4,%xmm11
  movaps %xmm2,%xmm4
  mulss  %xmm6,%xmm4
  addss  %xmm11,%xmm4
  movaps %xmm9,%xmm15
  mulss  %xmm5,%xmm15
  addss  %xmm15,%xmm4
  mulss  %xmm3,%xmm4
  movss  %xmm4,0x10(%r13)
  movss  0x70(%rsp),%xmm4
  addss  0x1c(%rsp),%xmm4
  movss  %xmm4,0x24(%rsp)
  movss  0x64(%rsp),%xmm4
  xorps  D162(%rip),%xmm4
  movss  0xc(%rsp),%xmm15
  mulss  %xmm13,%xmm15
  movaps %xmm15,%xmm11
  movaps %xmm10,%xmm15
  mulss  %xmm6,%xmm15
  addss  %xmm11,%xmm15
  movss  0x24(%rsp),%xmm11
  mulss  %xmm2,%xmm11
  addss  %xmm15,%xmm11
  movaps %xmm9,%xmm15
  mulss  %xmm4,%xmm15
  addss  %xmm15,%xmm11
  mulss  %xmm3,%xmm11
  movss  %xmm11,0x14(%r13)
  mulss  0x14(%rsp),%xmm13
  mulss  %xmm5,%xmm10
  addss  %xmm13,%xmm10
  mulss  %xmm4,%xmm2
  addss  %xmm10,%xmm2
  mulss  0x3c(%rsp),%xmm9
  addss  %xmm9,%xmm2
  mulss  %xmm3,%xmm2
  movss  %xmm2,0x18(%r13)
  movd   %eax,%xmm10
  xorps  D162(%rip),%xmm10
  movaps %xmm10,%xmm2
  subss  0x78(%rsp),%xmm2
  movss  %xmm2,0x1c(%r13)
  movss  0x28(%rsp),%xmm15
  movaps %xmm15,%xmm9
  addss  %xmm15,%xmm9
  addss  %xmm9,%xmm12
  subss  D161(%rip),%xmm12
  movss  %xmm12,0x20(%r13)
  movss  0x30(%rsp),%xmm13
  mulss  %xmm13,%xmm7
  movss  0x44(%rsp),%xmm10
  movss  0x38(%rsp),%xmm12
  mulss  %xmm12,%xmm10
  movaps %xmm7,%xmm2
  movss  %xmm10,0x30(%rsp)
  subss  %xmm10,%xmm2
  movss  %xmm2,0x24(%r13)
  movss  0x2c(%rsp),%xmm11
  mulss  %xmm11,%xmm12
  movaps %xmm12,%xmm15
  subss  %xmm12,%xmm8
  movss  0x34(%rsp),%xmm12
  mulss  %xmm11,%xmm12
  movd   %xmm12,%eax
  movss  (%rsp),%xmm12
  mulss  %xmm14,%xmm12
  movaps %xmm12,%xmm2
  movd   %eax,%xmm12
  subss  %xmm2,%xmm12
  movaps %xmm12,%xmm10
  addss  0x48(%rsp),%xmm10
  mulss  %xmm11,%xmm13
  movaps %xmm13,%xmm2
  addss  %xmm13,%xmm0
  movss  0x4(%rsp),%xmm12
  mulss  %xmm11,%xmm12
  movaps %xmm12,%xmm13
  xorps  D162(%rip),%xmm1
  movss  0x90(%rsp),%xmm11
  mulss  (%rsp),%xmm11
  subss  %xmm11,%xmm1
  subss  %xmm12,%xmm1
  movss  0x40(%rsp),%xmm11
  mulss  %xmm8,%xmm11
  movss  0x8(%rsp),%xmm12
  mulss  %xmm10,%xmm12
  addss  %xmm11,%xmm12
  movss  0xc(%rsp),%xmm11
  mulss  %xmm0,%xmm11
  addss  %xmm12,%xmm11
  movss  0x14(%rsp),%xmm12
  mulss  %xmm1,%xmm12
  addss  %xmm12,%xmm11
  mulss  %xmm3,%xmm11
  movss  %xmm11,0x28(%r13)
  movss  0x8(%rsp),%xmm12
  mulss  %xmm8,%xmm12
  movaps %xmm12,%xmm11
  movss  0x20(%rsp),%xmm12
  mulss  %xmm10,%xmm12
  addss  %xmm11,%xmm12
  movaps %xmm0,%xmm11
  mulss  %xmm6,%xmm11
  addss  %xmm12,%xmm11
  movaps %xmm5,%xmm12
  mulss  %xmm1,%xmm12
  addss  %xmm12,%xmm11
  mulss  %xmm3,%xmm11
  movss  %xmm11,0x2c(%r13)
  movss  0xc(%rsp),%xmm12
  mulss  %xmm8,%xmm12
  movaps %xmm12,%xmm11
  movaps %xmm10,%xmm12
  mulss  %xmm6,%xmm12
  addss  %xmm11,%xmm12
  movss  0x24(%rsp),%xmm11
  mulss  %xmm0,%xmm11
  addss  %xmm12,%xmm11
  movaps %xmm4,%xmm12
  mulss  %xmm1,%xmm12
  addss  %xmm12,%xmm11
  mulss  %xmm3,%xmm11
  movss  %xmm11,0x30(%r13)
  movss  0x14(%rsp),%xmm12
  mulss  %xmm12,%xmm8
  mulss  %xmm5,%xmm10
  addss  %xmm8,%xmm10
  mulss  %xmm4,%xmm0
  addss  %xmm10,%xmm0
  movss  0x3c(%rsp),%xmm10
  mulss  %xmm10,%xmm1
  addss  %xmm1,%xmm0
  mulss  %xmm3,%xmm0
  movss  %xmm0,0x34(%r13)
  movd   %edx,%xmm1
  xorps  D162(%rip),%xmm1
  movaps %xmm1,%xmm0
  subss  0x7c(%rsp),%xmm0
  movss  %xmm0,0x38(%r13)
  xorps  D162(%rip),%xmm7
  movaps %xmm7,%xmm0
  subss  0x30(%rsp),%xmm0
  movss  %xmm0,0x3c(%r13)
  movss  0x74(%rsp),%xmm0
  addss  %xmm9,%xmm0
  subss  D161(%rip),%xmm0
  movss  %xmm0,0x40(%r13)
  movd   %eax,%xmm1
  subss  0x88(%rsp),%xmm1
  movaps %xmm1,%xmm0
  subss  0x8c(%rsp),%xmm15
  movaps %xmm14,%xmm1
  movss  0x10(%rsp),%xmm9
  mulss  %xmm9,%xmm1
  subss  %xmm1,%xmm15
  movss  0x80(%rsp),%xmm7
  addss  %xmm13,%xmm7
  movss  0x44(%rsp),%xmm8
  mulss  %xmm9,%xmm8
  subss  %xmm8,%xmm7
  addss  0x84(%rsp),%xmm2
  movss  0x40(%rsp),%xmm11
  mulss  %xmm0,%xmm11
  movaps %xmm11,%xmm1
  movss  0x8(%rsp),%xmm9
  movaps %xmm9,%xmm8
  mulss  %xmm15,%xmm8
  addss  %xmm8,%xmm1
  movss  0xc(%rsp),%xmm14
  movaps %xmm14,%xmm8
  mulss  %xmm7,%xmm8
  addss  %xmm8,%xmm1
  movaps %xmm12,%xmm8
  mulss  %xmm2,%xmm8
  addss  %xmm8,%xmm1
  mulss  %xmm3,%xmm1
  movss  %xmm1,0x44(%r13)
  mulss  %xmm0,%xmm9
  movaps %xmm9,%xmm1
  movss  0x20(%rsp),%xmm8
  mulss  %xmm15,%xmm8
  addss  %xmm8,%xmm1
  movaps %xmm6,%xmm8
  mulss  %xmm7,%xmm8
  addss  %xmm8,%xmm1
  movaps %xmm5,%xmm8
  mulss  %xmm2,%xmm8
  addss  %xmm8,%xmm1
  mulss  %xmm3,%xmm1
  movss  %xmm1,0x48(%r13)
  mulss  %xmm0,%xmm14
  mulss  %xmm15,%xmm6
  addss  %xmm14,%xmm6
  movss  0x24(%rsp),%xmm14
  mulss  %xmm7,%xmm14
  addss  %xmm14,%xmm6
  movaps %xmm4,%xmm14
  mulss  %xmm2,%xmm14
  addss  %xmm14,%xmm6
  mulss  %xmm3,%xmm6
  movss  %xmm6,0x4c(%r13)
  mulss  %xmm12,%xmm0
  mulss  %xmm15,%xmm5
  addss  %xmm0,%xmm5
  mulss  %xmm7,%xmm4
  addss  %xmm5,%xmm4
  movaps %xmm10,%xmm0
  mulss  %xmm2,%xmm0
  addss  %xmm0,%xmm4
  mulss  %xmm3,%xmm4
  movss  %xmm4,0x50(%r13)
  movss  0x28(%rsp),%xmm10
  xorps  D162(%rip),%xmm10
  movaps %xmm10,%xmm1
  movss  0x18(%rsp),%xmm11
  movaps %xmm11,%xmm0
  xorps  D162(%rip),%xmm0
  movss  0x1c(%rsp),%xmm15
  subss  %xmm15,%xmm0
  movss  0x4c(%rsp),%xmm4
  mulss  %xmm4,%xmm0
  movss  0x94(%rsp),%xmm2
  movss  0x50(%rsp),%xmm3
  mulss  %xmm3,%xmm2
  addss  %xmm2,%xmm0
  movss  0x98(%rsp),%xmm2
  movss  0x54(%rsp),%xmm6
  mulss  %xmm6,%xmm2
  addss  %xmm2,%xmm0
  addss  %xmm0,%xmm0
  addss  %xmm4,%xmm0
  movss  %xmm0,(%r12)
  movaps %xmm10,%xmm14
  subss  %xmm15,%xmm14
  movaps %xmm14,%xmm0
  mulss  %xmm3,%xmm0
  movss  0x58(%rsp),%xmm2
  mulss  %xmm4,%xmm2
  addss  %xmm2,%xmm0
  movss  0x9c(%rsp),%xmm2
  mulss  %xmm6,%xmm2
  addss  %xmm2,%xmm0
  addss  %xmm0,%xmm0
  addss  %xmm3,%xmm0
  movss  %xmm0,0x0(%rbp)
  mulss  0x60(%rsp),%xmm4
  movaps %xmm4,%xmm0
  mulss  0x68(%rsp),%xmm3
  addss  %xmm3,%xmm0
  subss  %xmm11,%xmm1
  mulss  %xmm6,%xmm1
  addss  %xmm1,%xmm0
  addss  %xmm0,%xmm0
  addss  %xmm6,%xmm0
  movss  %xmm0,(%rbx)
  add    $0xa8,%rsp
  pop    %rbx
  pop    %rbp
  pop    %r12
  pop    %r13
  ret
```

tool_calls: name: parse_data
arguments: label: D161
datatype: byte[4]
name: parse_data
arguments: label: D162
datatype: byte[16]
name: parse_data
arguments: label: D2
datatype: byte[4]

tool: {"D161": [0x00,0x00,0x80,0x3f]}

tool: {"D162": [0x00,0x00,0x00,0x80,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00]}

tool: {"D2": [0x00,0x00,0x00,0xc0]}

assistant: ```c
void inverseComposePoint(const float m_coord_x, const float m_coord_y, const float m_coord_z, const float m_quat_r, const float m_quat_x, const float m_quat_y, const float m_quat_z, const float gx, const float gy, const float gz, float lx[1], float ly[1], float lz[1], float out_jacobian_df_dpoint[3][3], float out_jacobian_df_dpose[3][7]) {
  const float qr = m_quat_r;
  const float qx = m_quat_x;
  const float qy = m_quat_y;
  const float qz = m_quat_z;
  const float qx2 = qx * qx;
  const float qy2 = qy * qy;
  const float qz2 = qz * qz;
  const float Ax = 2 * (gx - m_coord_x);
  const float Ay = 2 * (gy - m_coord_y);
  const float Az = 2 * (gz - m_coord_z);
  out_jacobian_df_dpoint[0][0] = 1 - 2 * (qy2 + qz2);
  out_jacobian_df_dpoint[0][1] = 2 * (-qr * qz + qx * qy);
  out_jacobian_df_dpoint[0][2] = 2 * (qx * qz + qr * qy);
  out_jacobian_df_dpoint[1][0] = 2 * (qx * qy + qr * qz);
  out_jacobian_df_dpoint[1][1] = 1 - 2 * (qx2 + qz2);
  out_jacobian_df_dpoint[1][2] = 2 * (-qr * qx + qy * qz);
  out_jacobian_df_dpoint[2][0] = 2 * (-qr * qy + qx * qz);
  out_jacobian_df_dpoint[2][1] = 2 * (qy * qz + qr * qx);
  out_jacobian_df_dpoint[2][2] = 1 - 2 * (qx2 + qy2);
  float normSqr = qr * qr + qx * qx + qy * qy + qz * qz;
  const float n = inverseSqrt(normSqr * normSqr * normSqr);
  out_jacobian_df_dpose[0][0] = 2 * qy2 + 2 * qz2 - 1;
  out_jacobian_df_dpose[0][1] = -2 * qr * qz - 2 * qx * qy;
  out_jacobian_df_dpose[0][2] = 2 * qr * qy - 2 * qx * qz;
  out_jacobian_df_dpose[0][3] = n * ((-qy * Az + qz * Ay) * (qx * qx + qy * qy + qz * qz) + (qy * Ay + qz * Az) * (-qx * qr) + (qx * Ay - 2 * qy * Ax - qr * Az) * (-qy * qr) + (qx * Az + qr * Ay - 2 * qz * Ax) * (-qz * qr));
  out_jacobian_df_dpose[0][4] = n * ((-qy * Az + qz * Ay) * (-qr * qx) + (qy * Ay + qz * Az) * (qr * qr + qy * qy + qz * qz) + (qx * Ay - 2 * qy * Ax - qr * Az) * (-qy * qx) + (qx * Az + qr * Ay - 2 * qz * Ax) * (-qz * qx));
  out_jacobian_df_dpose[0][5] = n * ((-qy * Az + qz * Ay) * (-qr * qy) + (qy * Ay + qz * Az) * (-qx * qy) + (qx * Ay - 2 * qy * Ax - qr * Az) * (qr * qr + qx * qx + qz * qz) + (qx * Az + qr * Ay - 2 * qz * Ax) * (-qz * qy));
  out_jacobian_df_dpose[0][6] = n * ((-qy * Az + qz * Ay) * (-qr * qz) + (qy * Ay + qz * Az) * (-qx * qz) + (qx * Ay - 2 * qy * Ax - qr * Az) * (-qy * qz) + (qx * Az + qr * Ay - 2 * qz * Ax) * (qr * qr + qx * qx + qy * qy));
  out_jacobian_df_dpose[1][0] = 2 * qr * qz - 2 * qx * qy;
  out_jacobian_df_dpose[1][1] = 2 * qx2 + 2 * qz2 - 1;
  out_jacobian_df_dpose[1][2] = -2 * qr * qx - 2 * qy * qz;
  out_jacobian_df_dpose[1][3] = n * ((qx * Az - qz * Ax) * (qx * qx + qy * qy + qz * qz) + (qy * Ax - 2 * qx * Ay + qr * Az) * (-qx * qr) + (qx * Ax + qz * Az) * (-qy * qr) + (qy * Az - 2 * qz * Ay - qr * Ax) * (-qz * qr));
  out_jacobian_df_dpose[1][4] = n * ((qx * Az - qz * Ax) * (-qr * qx) + (qy * Ax - 2 * qx * Ay + qr * Az) * (qr * qr + qy * qy + qz * qz) + (qx * Ax + qz * Az) * (-qy * qx) + (qy * Az - 2 * qz * Ay - qr * Ax) * (-qz * qx));
  out_jacobian_df_dpose[1][5] = n * ((qx * Az - qz * Ax) * (-qr * qy) + (qy * Ax - 2 * qx * Ay + qr * Az) * (-qx * qy) + (qx * Ax + qz * Az) * (qr * qr + qx * qx + qz * qz) + (qy * Az - 2 * qz * Ay - qr * Ax) * (-qz * qy));
  out_jacobian_df_dpose[1][6] = n * ((qx * Az - qz * Ax) * (-qr * qz) + (qy * Ax - 2 * qx * Ay + qr * Az) * (-qx * qz) + (qx * Ax + qz * Az) * (-qy * qz) + (qy * Az - 2 * qz * Ay - qr * Ax) * (qr * qr + qx * qx + qy * qy));
  out_jacobian_df_dpose[2][0] = -2 * qr * qy - 2 * qx * qz;
  out_jacobian_df_dpose[2][1] = 2 * qr * qx - 2 * qy * qz;
  out_jacobian_df_dpose[2][2] = 2 * qx2 + 2 * qy2 - 1;
  out_jacobian_df_dpose[2][3] = n * ((qy * Ax - qx * Ay) * (qx * qx + qy * qy + qz * qz) + (qz * Ax - qr * Ay - 2 * qx * Az) * (-qx * qr) + (qr * Ax + qz * Ay - 2 * qy * Az) * (-qy * qr) + (qx * Ax + qy * Ay) * (-qz * qr));
  out_jacobian_df_dpose[2][4] = n * ((qy * Ax - qx * Ay) * (-qr * qx) + (qz * Ax - qr * Ay - 2 * qx * Az) * (qr * qr + qy * qy + qz * qz) + (qr * Ax + qz * Ay - 2 * qy * Az) * (-qy * qx) + (qx * Ax + qy * Ay) * (-qz * qx));
  out_jacobian_df_dpose[2][5] = n * ((qy * Ax - qx * Ay) * (-qr * qy) + (qz * Ax - qr * Ay - 2 * qx * Az) * (-qx * qy) + (qr * Ax + qz * Ay - 2 * qy * Az) * (qr * qr + qx * qx + qz * qz) + (qx * Ax + qy * Ay) * (-qz * qy));
  out_jacobian_df_dpose[2][6] = n * ((qy * Ax - qx * Ay) * (-qr * qz) + (qz * Ax - qr * Ay - 2 * qx * Az) * (-qx * qz) + (qr * Ax + qz * Ay - 2 * qy * Az) * (-qy * qz) + (qx * Ax + qy * Ay) * (qr * qr + qx * qx + qy * qy));
  const float t2 = -qr * qx;
  const float t3 = -qr * qy;
  const float t4 = -qr * qz;
  const float t5 = -qx * qx;
  const float t6 = qx * qy;
  const float t7 = qx * qz;
  const float t8 = -qy * qy;
  const float t9 = qy * qz;
  const float t10 = -qz * qz;
  *lx = 2 * ((t8 + t10) * (gx - m_coord_x) + (t6 - t4) * (gy - m_coord_y) + (t3 + t7) * (gz - m_coord_z)) + (gx - m_coord_x);
  *ly = 2 * ((t4 + t6) * (gx - m_coord_x) + (t5 + t10) * (gy - m_coord_y) + (t9 - t2) * (gz - m_coord_z)) + (gy - m_coord_y);
  *lz = 2 * ((t7 - t3) * (gx - m_coord_x) + (t2 + t9) * (gy - m_coord_y) + (t5 + t8) * (gz - m_coord_z)) + (gz - m_coord_z);
}
```