12 |
|
posangle(a) : if(-a, a + 2*PI, a) / DEGREE; |
13 |
|
Atan2(y,x) : posangle(atan2(y,x)); |
14 |
|
|
15 |
< |
kqpola(r) : select(r, 9, 27, 46, 66, 90); |
16 |
< |
kqnaz(r) : select(r, 1, 88, 12, 12, 8); |
15 |
> |
kqpola(r) : select(r, 9, 27, 45, 63, 90); |
16 |
> |
kqnaz(r) : select(r, 1, 8, 12, 12, 8); |
17 |
|
kqaccum(r) : if(r-.5, kqnaz(r) + kqaccum(r-1), 0); |
18 |
|
kqfindrow(r, pol) : if(r-kqpola(0)+.5, r, |
19 |
|
if(pol-kqpola(r), kqfindrow(r+1, pol), r) ); |
29 |
|
kqaccum(4) + kqazn(azi,360/kqnaz(5)) |
30 |
|
) ); |
31 |
|
|
32 |
+ |
RHS = 1; { set to -1 for left-handed system } |
33 |
+ |
|
34 |
|
kqbin(Nx,Ny,Nz,Ux,Uy,Uz) = kqbin2(Acos(-Dx*Nx-Dy*Ny-Dz*Nz), |
35 |
< |
Atan2(-Dx*Ux-Dy*Uy-Dz*Uz, |
36 |
< |
-Dx*(Uy*Nz-Uz*Ny) - Dy*(Uz*Nx-Ux*Nz) - Dz*(Ux*Ny-Uy*Nx))); |
35 |
> |
Atan2(-Dx*Ux-Dy*Uy-Dz*Uz + (Nx*Dx+Ny*Dy+Nz*Dz)*(Nx*Ux+Ny*Uy+Nz*Uz), |
36 |
> |
-RHS*(Dx*(Uy*Nz-Uz*Ny) + Dy*(Uz*Nx-Ux*Nz) + Dz*(Ux*Ny-Uy*Nx)))); |
37 |
|
|
38 |
|
Nkqbins : kqaccum(kqnaz(0)); { Number of bins for one elevation } |