user: 请显示与下面列出的汇编代码相匹配的C语言实现：

```asm
<trafontspcmpc>:
  endbr64
  push   %r15
  push   %r14
  push   %r13
  push   %r12
  push   %rbp
  push   %rbx
  sub    $0x38,%rsp
  mov    %rdi,%r12
  mov    %rsi,%rbp
  mov    %rcx,0x28(%rsp)
  mov    %r8,0x20(%rsp)
  mov    0x98(%rsp),%rbx
  mov    0x128(%rsp),%r14
  mov    0x130(%rsp),%r15
  mov    (%r8),%eax
  lea    -0x2(%rax,%rax,1),%eax
  cltq
  lea    0x0(,%rax,4),%rdi
  mov    0xe0(%rsp),%rsi
  mov    (%rsi,%rax,4),%edx
  lea    0x1(%rax),%rsi
  mov    0xe0(%rsp),%rcx
  mov    (%rcx,%rsi,4),%ecx
  cmp    %ecx,%edx
  jge    L149
L158:
  add    $0x1,%edx
  cmp    %ecx,%edx
  jne    L158
L149:
  mov    0xc8(%rsp),%rcx
  mov    (%rcx,%rdi,1),%edx
  cmp    (%rcx,%rsi,4),%edx
  jge    L124
  movslq %edx,%rax
  mov    %rbx,0x98(%rsp)
  mov    %r14,0x128(%rsp)
  mov    %rax,%r14
  mov    %r15,0x130(%rsp)
  mov    0x20(%rsp),%r15
  jmp    L203
L265:
  movslq %ebx,%rbx
  mov    D18(%rip),%rax
  mov    %rax,-0x8(%rbp,%rbx,8)
  movsd  0x0(%rbp),%xmm1
  movsd  (%r12),%xmm4
  movsd  0x8(%r12),%xmm3
  movsd  0x10(%r12),%xmm2
  movapd %xmm3,%xmm0
  mulsd  0x8(%rbp),%xmm0
  movapd %xmm1,%xmm5
  mulsd  %xmm4,%xmm5
  addsd  %xmm5,%xmm0
  movapd %xmm2,%xmm5
  mulsd  0x10(%rbp),%xmm5
  addsd  %xmm5,%xmm0
  mulsd  %xmm0,%xmm1
  subsd  %xmm1,%xmm4
  movq   %xmm4,%r13
  movsd  %xmm4,(%r12)
  movapd %xmm0,%xmm1
  mulsd  0x8(%rbp),%xmm1
  subsd  %xmm1,%xmm3
  movq   %xmm3,%rbx
  movsd  %xmm3,0x8(%r12)
  mulsd  0x10(%rbp),%xmm0
  movapd %xmm2,%xmm4
  subsd  %xmm0,%xmm4
  movsd  %xmm4,0x8(%rsp)
  movq   %r13,%xmm0
  mulsd  %xmm0,%xmm0
  movapd %xmm3,%xmm1
  mulsd  %xmm3,%xmm1
  addsd  %xmm1,%xmm0
  movapd %xmm4,%xmm1
  mulsd  %xmm4,%xmm1
  addsd  %xmm1,%xmm0
  pxor   %xmm7,%xmm7
  ucomisd %xmm0,%xmm7
  ja     L414
  sqrtsd %xmm0,%xmm0
L406:
  movq   %r13,%xmm1
  divsd  %xmm0,%xmm1
  movsd  %xmm1,(%r12)
  movq   %rbx,%xmm1
  divsd  %xmm0,%xmm1
  movsd  %xmm1,0x8(%r12)
  movsd  0x8(%rsp),%xmm1
  divsd  %xmm0,%xmm1
  movsd  %xmm1,0x10(%r12)
  mov    (%r15),%eax
  lea    -0x2(%rax,%rax,1),%eax
  cltq
  add    $0x1,%r14
  mov    0xc8(%rsp),%rsi
  cmp    %r14d,0x4(%rsi,%rax,4)
  jle    L439
L203:
  mov    %r14d,%esi
  movq   $0x0,0x0(%rbp)
  movq   $0x0,0x8(%rbp)
  movq   $0x0,0x10(%rbp)
  mov    0xd0(%rsp),%rax
  mov    (%rax,%r14,8),%edx
  movslq %edx,%rax
  shl    $0x2,%rax
  mov    0x70(%rsp),%rdi
  mov    -0x4(%rdi,%rax,1),%ebx
  mov    0x128(%rsp),%rdi
  cmpl   $0x1,(%rdi)
  jne    L265
  mov    0x78(%rsp),%rdi
  mov    -0x4(%rdi,%rax,1),%r8d
  mov    %ebx,%ecx
  lea    D52(%rip),%rdi
  mov    $0x0,%eax
  call   <printf@plt>
  jmp    L265
L414:
  call   <sqrt@plt>
  jmp    L406
L439:
  mov    0x98(%rsp),%rbx
  mov    0x128(%rsp),%r14
  mov    0x130(%rsp),%r15
L124:
  mov    0xe0(%rsp),%rsi
  mov    (%rsi,%rax,4),%esi
  mov    0x20(%rsp),%rax
  mov    (%rax),%eax
  lea    -0x2(%rax,%rax,1),%eax
  cltq
  lea    0x1(%rax),%rdx
  lea    0x0(,%rdx,4),%rcx
  mov    0xe0(%rsp),%rdi
  mov    (%rdi,%rdx,4),%edx
  cmp    %edx,%esi
  jge    L411
  movslq %esi,%rax
  mov    %rax,0x8(%rsp)
  jmp    L267
L313:
  mov    %esi,%ecx
  mov    %edi,%esi
  lea    D6(%rip),%rdi
  mov    $0x1,%eax
  call   <printf@plt>
  jmp    L289
L268:
  mov    0x8(%rbx,%rax,4),%r13d
  cmpl   $0x1,(%r14)
  je     L31
L364:
  test   %r13d,%r13d
  je     L336
L144:
  lea    -0x3(%r13,%r13,2),%eax
  cltq
  mov    (%rbx,%rax,4),%edi
  cmp    %edi,(%r15)
  jne    L268
  movslq %r13d,%r13
  mov    0xa0(%rsp),%rsi
  movsd  -0x8(%rsi,%r13,8),%xmm0
  movslq 0x4(%rbx,%rax,4),%rdx
  movsd  %xmm0,-0x8(%rbp,%rdx,8)
  jmp    L268
L31:
  mov    %r13d,%esi
  lea    D13(%rip),%rdi
  mov    $0x0,%eax
  call   <printf@plt>
  jmp    L364
L336:
  mov    0x0(%rbp),%r13
  movsd  0x8(%rbp),%xmm3
  movsd  %xmm3,0x10(%rsp)
  movsd  0x10(%rbp),%xmm6
  movsd  %xmm6,0x18(%rsp)
  movq   %r13,%xmm0
  mulsd  %xmm0,%xmm0
  movapd %xmm3,%xmm1
  mulsd  %xmm3,%xmm1
  addsd  %xmm1,%xmm0
  movapd %xmm6,%xmm1
  mulsd  %xmm6,%xmm1
  addsd  %xmm1,%xmm0
  pxor   %xmm2,%xmm2
  ucomisd %xmm0,%xmm2
  ja     L92
  sqrtsd %xmm0,%xmm0
L11:
  cvttsd2si %xmm0,%eax
  pxor   %xmm0,%xmm0
  cvtsi2sd %eax,%xmm0
  movq   %r13,%xmm1
  divsd  %xmm0,%xmm1
  movsd  %xmm1,0x0(%rbp)
  movsd  0x10(%rsp),%xmm3
  divsd  %xmm0,%xmm3
  movsd  %xmm3,0x8(%rbp)
  movsd  0x18(%rsp),%xmm2
  divsd  %xmm0,%xmm2
  movsd  %xmm2,0x10(%rbp)
  movsd  (%r12),%xmm6
  movsd  0x8(%r12),%xmm5
  movsd  0x10(%r12),%xmm4
  movapd %xmm1,%xmm0
  mulsd  %xmm6,%xmm0
  mulsd  %xmm5,%xmm3
  addsd  %xmm3,%xmm0
  mulsd  %xmm4,%xmm2
  addsd  %xmm2,%xmm0
  mulsd  %xmm0,%xmm1
  subsd  %xmm1,%xmm6
  movsd  %xmm6,0x10(%rsp)
  movsd  %xmm6,(%r12)
  movapd %xmm0,%xmm1
  mulsd  0x8(%rbp),%xmm1
  subsd  %xmm1,%xmm5
  movq   %xmm5,%r13
  movsd  %xmm5,0x8(%r12)
  mulsd  0x10(%rbp),%xmm0
  movapd %xmm4,%xmm5
  subsd  %xmm0,%xmm5
  movsd  %xmm5,0x18(%rsp)
  movapd %xmm6,%xmm0
  mulsd  %xmm6,%xmm0
  movq   %r13,%xmm1
  mulsd  %xmm1,%xmm1
  addsd  %xmm1,%xmm0
  movapd %xmm5,%xmm1
  mulsd  %xmm5,%xmm1
  addsd  %xmm1,%xmm0
  pxor   %xmm1,%xmm1
  ucomisd %xmm0,%xmm1
  ja     L135
  sqrtsd %xmm0,%xmm0
L279:
  movsd  0x10(%rsp),%xmm1
  divsd  %xmm0,%xmm1
  movsd  %xmm1,(%r12)
  movq   %r13,%xmm1
  divsd  %xmm0,%xmm1
  movsd  %xmm1,0x8(%r12)
  movsd  0x18(%rsp),%xmm1
  divsd  %xmm0,%xmm1
  movsd  %xmm1,0x10(%r12)
  mov    0x20(%rsp),%rax
  mov    (%rax),%eax
  lea    -0x2(%rax,%rax,1),%eax
  cltq
  lea    0x1(%rax),%rdx
  lea    0x0(,%rdx,4),%rcx
  mov    0xe0(%rsp),%rsi
  mov    (%rsi,%rdx,4),%edx
  addq   $0x1,0x8(%rsp)
  mov    0x8(%rsp),%rsi
  cmp    %esi,%edx
  jle    L411
L267:
  mov    0x8(%rsp),%rax
  mov    %eax,%edi
  movq   $0x0,0x0(%rbp)
  movq   $0x0,0x8(%rbp)
  movq   $0x0,0x10(%rbp)
  mov    0xe8(%rsp),%rsi
  mov    (%rsi,%rax,8),%edx
  lea    -0x3(%rdx,%rdx,2),%eax
  cltq
  lea    0x1(%rax),%rcx
  mov    (%rbx,%rcx,4),%esi
  movslq %edx,%r8
  mov    0xa0(%rsp),%r10
  movsd  -0x8(%r10,%r8,8),%xmm0
  mov    0x4(%rbx,%rcx,4),%r13d
  mov    (%rbx,%rax,4),%r8d
  movslq %esi,%rax
  movsd  %xmm0,-0x8(%rbp,%rax,8)
  cmpl   $0x1,(%r14)
  je     L313
L289:
  test   %r13d,%r13d
  jne    L144
  jmp    L336
L92:
  call   <sqrt@plt>
  jmp    L11
L135:
  call   <sqrt@plt>
  jmp    L279
L411:
  mov    0xc8(%rsp),%rsi
  mov    (%rsi,%rax,4),%edi
  cmp    %edi,(%rsi,%rcx,1)
  jle    L459
L210:
  movsd  0x10(%rbp),%xmm2
  movsd  0x8(%rbp),%xmm0
  movapd %xmm2,%xmm1
  mulsd  0x8(%r12),%xmm1
  movapd %xmm0,%xmm3
  mulsd  0x10(%r12),%xmm3
  subsd  %xmm3,%xmm1
  movsd  %xmm1,0x18(%rbp)
  movsd  0x0(%rbp),%xmm1
  movapd %xmm1,%xmm3
  mulsd  0x10(%r12),%xmm3
  mulsd  (%r12),%xmm2
  subsd  %xmm2,%xmm3
  movsd  %xmm3,0x20(%rbp)
  mulsd  (%r12),%xmm0
  mulsd  0x8(%r12),%xmm1
  subsd  %xmm1,%xmm0
  movsd  %xmm0,0x28(%rbp)
  mov    $0x0,%eax
  mov    0x28(%rsp),%rdx
L359:
  movsd  0x0(%rbp,%rax,1),%xmm0
  movsd  %xmm0,(%rdx,%rax,1)
  add    $0x8,%rax
  cmp    $0x30,%rax
  jne    L359
  mov    0x20(%rsp),%r13
  mov    0x0(%r13),%eax
  lea    -0x2(%rax,%rax,1),%eax
  cltq
  mov    0xe0(%rsp),%rsi
  mov    (%rsi,%rax,4),%esi
  mov    0xe0(%rsp),%rdi
  cmp    0x4(%rdi,%rax,4),%esi
  jge    L183
  movslq %esi,%rsi
  mov    0xa0(%rsp),%r9
  mov    %r14,0x128(%rsp)
  mov    0xe8(%rsp),%r14
  jmp    L319
L459:
  mov    0xe0(%rsp),%rsi
  cmp    (%rsi,%rax,4),%edx
  jg     L210
  jmp    L66
L133:
  mov    0x8(%rbx,%rax,4),%edx
  test   %edx,%edx
  je     L12
L21:
  lea    -0x3(%rdx,%rdx,2),%eax
  cltq
  mov    (%rbx,%rax,4),%ecx
  cmp    %ecx,(%r15)
  jne    L133
  movslq 0x4(%rbx,%rax,4),%rcx
  lea    0x10(,%rcx,8),%rcx
  lea    0x0(%rbp,%rcx,1),%rdi
  movslq %edx,%rdx
  lea    -0x8(%r9,%rdx,8),%rdx
  movsd  (%rdx),%xmm0
  mulsd  (%r11),%xmm0
  divsd  %xmm2,%xmm0
  movsd  (%rdi),%xmm1
  subsd  %xmm0,%xmm1
  movsd  %xmm1,(%rdi)
  lea    -0x18(%r12,%rcx,1),%rcx
  movsd  (%rdx),%xmm0
  mulsd  (%r10),%xmm0
  divsd  %xmm2,%xmm0
  movsd  (%rcx),%xmm1
  subsd  %xmm0,%xmm1
  movsd  %xmm1,(%rcx)
  jmp    L133
L12:
  movslq %r8d,%r8
  add    $0x2,%r8
  movq   $0x0,0x0(%rbp,%r8,8)
  movq   $0x0,-0x18(%r12,%r8,8)
  add    $0x1,%rsi
  mov    0x0(%r13),%eax
  lea    -0x2(%rax,%rax,1),%eax
  cltq
  mov    0xe0(%rsp),%rdi
  cmp    %esi,0x4(%rdi,%rax,4)
  jle    L72
L319:
  mov    (%r14,%rsi,8),%edx
  lea    -0x3(%rdx,%rdx,2),%eax
  cltq
  add    $0x1,%rax
  mov    (%rbx,%rax,4),%r8d
  movslq %edx,%rdx
  movsd  -0x8(%r9,%rdx,8),%xmm2
  mov    0x4(%rbx,%rax,4),%edx
  test   %edx,%edx
  je     L12
  movslq %r8d,%rax
  lea    0x10(,%rax,8),%rax
  lea    0x0(%rbp,%rax,1),%r11
  lea    -0x18(%r12,%rax,1),%r10
  jmp    L21
L72:
  mov    0x128(%rsp),%r14
L183:
  mov    (%r12),%rbx
  mov    0x8(%r12),%r13
  mov    0x10(%r12),%r15
  movq   %rbx,%xmm0
  mulsd  %xmm0,%xmm0
  movq   %r13,%xmm1
  mulsd  %xmm1,%xmm1
  addsd  %xmm1,%xmm0
  movq   %r15,%xmm1
  mulsd  %xmm1,%xmm1
  addsd  %xmm1,%xmm0
  pxor   %xmm1,%xmm1
  ucomisd %xmm0,%xmm1
  ja     L111
L280:
  movsd  0x0(%rbp),%xmm0
  movsd  0x8(%rbp),%xmm2
  movsd  0x10(%rbp),%xmm1
  mulsd  %xmm0,%xmm0
  mulsd  %xmm2,%xmm2
  addsd  %xmm2,%xmm0
  mulsd  %xmm1,%xmm1
  addsd  %xmm1,%xmm0
  pxor   %xmm1,%xmm1
  ucomisd %xmm0,%xmm1
  ja     L297
L137:
  movsd  0x18(%rbp),%xmm0
  movsd  0x20(%rbp),%xmm2
  movsd  0x28(%rbp),%xmm1
  mulsd  %xmm0,%xmm0
  mulsd  %xmm2,%xmm2
  addsd  %xmm2,%xmm0
  mulsd  %xmm1,%xmm1
  addsd  %xmm1,%xmm0
  pxor   %xmm1,%xmm1
  ucomisd %xmm0,%xmm1
  ja     L76
L123:
  cmpl   $0x1,(%r14)
  je     L250
L121:
  add    $0x38,%rsp
  pop    %rbx
  pop    %rbp
  pop    %r12
  pop    %r13
  pop    %r14
  pop    %r15
  ret
L111:
  call   <sqrt@plt>
  jmp    L280
L297:
  call   <sqrt@plt>
  jmp    L137
L76:
  call   <sqrt@plt>
  jmp    L123
L250:
  movq   %r15,%xmm2
  movq   %r13,%xmm1
  movq   %rbx,%xmm0
  lea    D50(%rip),%rdi
  mov    $0x3,%eax
  call   <printf@plt>
  movsd  0x10(%rbp),%xmm2
  movsd  0x8(%rbp),%xmm1
  movsd  0x0(%rbp),%xmm0
  lea    D59(%rip),%rdi
  mov    $0x3,%eax
  call   <printf@plt>
  movsd  0x18(%rbp),%xmm0
  movsd  0x28(%rbp),%xmm2
  movsd  0x20(%rbp),%xmm1
  lea    D11(%rip),%rdi
  mov    $0x3,%eax
  call   <printf@plt>
L66:
  cmpl   $0x1,(%r14)
  jne    L121
  movsd  0x10(%r12),%xmm2
  movsd  0x8(%r12),%xmm1
  movsd  (%r12),%xmm0
  lea    D50(%rip),%rdi
  mov    $0x3,%eax
  call   <printf@plt>
  movsd  0x10(%rbp),%xmm2
  movsd  0x8(%rbp),%xmm1
  movsd  0x0(%rbp),%xmm0
  lea    D59(%rip),%rdi
  mov    $0x3,%eax
  call   <printf@plt>
  movsd  0x18(%rbp),%xmm0
  movsd  0x28(%rbp),%xmm2
  movsd  0x20(%rbp),%xmm1
  lea    D11(%rip),%rdi
  mov    $0x3,%eax
  call   <printf@plt>
  jmp    L121
```

tool_calls: name: parse_data
arguments: label: D18
type: f64
name: parse_data
arguments: label: D52
type: string
name: parse_data
arguments: label: D6
type: string
name: parse_data
arguments: label: D13
type: string
name: parse_data
arguments: label: D50
type: string
name: parse_data
arguments: label: D59
type: string
name: parse_data
arguments: label: D11
type: string

tool: D18: 1

tool: D52: jj %d ist %d dir %d node %d


tool: D6: jj %d ist %d dir %d node %d coef %e


tool: D13: index %d 


tool: D50: n= %e %e %e 


tool: D59: t1= %e %e %e 


tool: D11: t2= %e %e %e 


assistant: ```c
void trafontspcmpc(double *n, double *t, double *n2, double *that, int *islavnodeentry, int *nboun, int *ndirboun, int *nodeboun, double *xboun, int *nmpc, int *ipompc, int *nodempc, double *coefmpc, int *ikboun, int *ilboun, int *ikmpc, int *ilmpc, int *nslavspc, int *islavspc, int *nsspc, int *nslavmpc, int *islavmpc, int *nsmpc, int *nmastspc, int *imastspc, int *nmspc, int *nmastmpc, int *imastmpc, int *nmmpc, int *debug, int *node) {
  int i, j, jj, j2, k, kk, l, m, dirblock, ist, dir, node1, index, dirind, dirdep, nt1, nt2;
  double dist, nn, coefdep;
  dirblock = 0;
  for (jj = nslavmpc[2 * (*islavnodeentry - 1)]; jj < nslavmpc[2 * (*islavnodeentry - 1) + 1]; jj++) {
    if (islavmpc[2 * jj + 1] == 1) {
      dirblock = 1;
    }
  }
  for (jj = nslavspc[2 * (*islavnodeentry - 1)]; jj < nslavspc[2 * (*islavnodeentry - 1) + 1]; jj++) {
    t[0] = 0;
    t[1] = 0;
    t[2] = 0;
    ist = islavspc[2 * jj];
    dir = ndirboun[ist - 1];
    node1 = nodeboun[ist - 1];
    if (*debug == 1) {
      printf("jj %"
             "d"
             " ist %"
             "d"
             " dir %"
             "d"
             " node %"
             "d"
             "\n",
             jj, ist, dir, node1);
    }
    t[dir - 1] = 1.0;
    dist = t[0] * n[0] + t[1] * n[1] + t[2] * n[2];
    n[0] = n[0] - dist * t[0];
    n[1] = n[1] - dist * t[1];
    n[2] = n[2] - dist * t[2];
    nn = sqrt(n[0] * n[0] + n[1] * n[1] + n[2] * n[2]);
    n[0] = n[0] / nn;
    n[1] = n[1] / nn;
    n[2] = n[2] / nn;
  }
  for (jj = nslavmpc[2 * (*islavnodeentry - 1)]; jj < nslavmpc[2 * (*islavnodeentry - 1) + 1]; jj++) {
    t[0] = 0;
    t[1] = 0;
    t[2] = 0;
    ist = islavmpc[2 * jj];
    dirdep = nodempc[3 * (ist - 1) + 1];
    coefdep = coefmpc[ist - 1];
    index = nodempc[3 * (ist - 1) + 2];
    node1 = nodempc[3 * (ist - 1)];
    t[dirdep - 1] = coefdep;
    if (*debug == 1) {
      printf("jj %"
             "d"
             " ist %"
             "d"
             " dir %"
             "d"
             " node %"
             "d"
             " coef %e\n",
             jj, ist, dirdep, node1, coefdep);
    }
    while (index != 0) {
      dirind = nodempc[3 * (index - 1) + 1];
      node1 = nodempc[3 * (index - 1)];
      if (node1 == *node)
        t[dirind - 1] = coefmpc[index - 1];
      index = nodempc[3 * (index - 1) + 2];
      if (*debug == 1) {
        printf("index %"
               "d"
               " \n",
               index);
      }
    }
    nt1 = sqrt(t[0] * t[0] + t[1] * t[1] + t[2] * t[2]);
    t[0] = t[0] / nt1;
    t[1] = t[1] / nt1;
    t[2] = t[2] / nt1;
    dist = t[0] * n[0] + t[1] * n[1] + t[2] * n[2];
    n[0] = n[0] - dist * t[0];
    n[1] = n[1] - dist * t[1];
    n[2] = n[2] - dist * t[2];
    nn = sqrt(n[0] * n[0] + n[1] * n[1] + n[2] * n[2]);
    n[0] = n[0] / nn;
    n[1] = n[1] / nn;
    n[2] = n[2] / nn;
  }
  if (nslavspc[2 * (*islavnodeentry - 1) + 1] - nslavspc[2 * (*islavnodeentry - 1)] > 0 || nslavmpc[2 * (*islavnodeentry - 1) + 1] - nslavmpc[2 * (*islavnodeentry - 1)] > 0) {
    t[3] = n[1] * t[2] - n[2] * t[1];
    t[4] = n[2] * t[0] - n[0] * t[2];
    t[5] = n[0] * t[1] - n[1] * t[0];
    for (kk = 0; kk < 6; kk++) {
      that[kk] = t[kk];
    }
    for (jj = nslavmpc[2 * (*islavnodeentry - 1)]; jj < nslavmpc[2 * (*islavnodeentry - 1) + 1]; jj++) {
      ist = islavmpc[2 * jj];
      dirdep = nodempc[3 * (ist - 1) + 1];
      coefdep = coefmpc[ist - 1];
      index = nodempc[3 * (ist - 1) + 2];
      node1 = nodempc[3 * (ist - 1)];
      while (index != 0) {
        dirind = nodempc[3 * (index - 1) + 1];
        node1 = nodempc[3 * (index - 1)];
        if (node1 == *node) {
          t[dirind - 1 + 3] = t[dirind - 1 + 3] - coefmpc[index - 1] * t[dirdep - 1 + 3] / coefdep;
          n[dirind - 1] = n[dirind - 1] - coefmpc[index - 1] * n[dirdep - 1] / coefdep;
        }
        index = nodempc[3 * (index - 1) + 2];
      }
      t[dirdep - 1 + 3] = 0.0;
      n[dirdep - 1] = 0.0;
    }
    nn = sqrt(n[0] * n[0] + n[1] * n[1] + n[2] * n[2]);
    nt1 = sqrt(t[0] * t[0] + t[1] * t[1] + t[2] * t[2]);
    nt2 = sqrt(t[3] * t[3] + t[4] * t[4] + t[5] * t[5]);
    if (*debug == 1) {
      printf("n= %e %e %e \n", n[0], n[1], n[2]);
      printf("t1= %e %e %e \n", t[0], t[1], t[2]);
      printf("t2= %e %e %e \n", t[3], t[4], t[5]);
    }
  }
  if (*debug == 1) {
    printf("n= %e %e %e \n", n[0], n[1], n[2]);
    printf("t1= %e %e %e \n", t[0], t[1], t[2]);
    printf("t2= %e %e %e \n", t[3], t[4], t[5]);
  }
  return;
}
```