x3d equ 0 y3d equ 2 z3d equ 4 vec_x equ 0 vec_y equ 4 vec_z equ 8 ; 3d point - triple integer word coordinate ; vector - triple float dword coordinate ;----------------------in: -------------------------------- ;------------------------ esi - pointer to 1st 3d point --- ;------------------------ edi - pointer to 2nd 3d point --- ;------------------------ ebx - pointer to result vector -- ;---------------------- out : none ------------------------ if 0 make_vector: fninit fild word[edi+x3d] ;edi+x3d fisub word[esi+x3d] ;esi+x3d fstp dword[ebx+vec_x] fild word[edi+y3d] fisub word[esi+y3d] fstp dword[ebx+vec_y] fild word[edi+z3d] fisub word[esi+z3d] fstp dword[ebx+vec_z] ret end if reverse_mx_3x3: ; esi - source matrix ; edi - desired reversed matrix push ebp mov ebp,esp sub esp,4 .det equ ebp-4 fninit fld dword[esi] fmul dword[esi+16] fmul dword[esi+32] fld dword[esi+12] fmul dword[esi+28] fmul dword[esi+8] faddp fld dword[esi+24] fmul dword[esi+4] fmul dword[esi+20] faddp fld dword[esi] fmul dword[esi+28] fmul dword[esi+20] fchs faddp fld dword[esi+24] fmul dword[esi+16] fmul dword[esi+8] fchs faddp fld dword[esi+12] fmul dword[esi+4] fmul dword[esi+32] fchs faddp fstp dword[.det] cmp dword[.det],0 jne @f int3 @@: ; fld1 ; fdiv dword[.det] ; fstp dword[.det] fld dword[esi+16] fmul dword[esi+32] fld dword[esi+20] fmul dword[esi+28] fchs faddp fdiv dword[.det] fstp dword[edi] fld dword[esi+8] fmul dword[esi+28] fld dword[esi+4] fmul dword[esi+32] fchs faddp fdiv dword[.det] fstp dword[edi+4] fld dword[esi+4] fmul dword[esi+20] fld dword[esi+8] fmul dword[esi+16] fchs faddp fdiv dword[.det] fstp dword[edi+8] fld dword[esi+20] fmul dword[esi+24] fld dword[esi+12] fmul dword[esi+32] fchs faddp fdiv dword[.det] fstp dword[edi+12] fld dword[esi] fmul dword[esi+32] fld dword[esi+8] fmul dword[esi+24] fchs faddp fdiv dword[.det] fstp dword[edi+16] fld dword[esi+8] fmul dword[esi+12] fld dword[esi] fmul dword[esi+20] fchs faddp fdiv dword[.det] fstp dword[edi+20] fld dword[esi+12] fmul dword[esi+28] fld dword[esi+16] fmul dword[esi+24] fchs faddp fdiv dword[.det] fstp dword[edi+24] fld dword[esi+4] fmul dword[esi+24] fld dword[esi] fmul dword[esi+28] fchs faddp fdiv dword[.det] fstp dword[edi+28] fld dword[esi] fmul dword[esi+16] fld dword[esi+4] fmul dword[esi+12] fchs faddp fdiv dword[.det] fstp dword[edi+32] mov esp,ebp pop ebp ret make_vector_r: if Ext < SSE2 fninit fld dword[edi] ;edi+x3d fsub dword[esi] ;esi+x3d fstp dword[ebx+vec_x] fld dword[edi+4] fsub dword[esi+4] fstp dword[ebx+vec_y] fld dword[edi+8] fsub dword[esi+8] fstp dword[ebx+vec_z] else movups xmm0,[esi] movups xmm1,[edi] subps xmm1,xmm0 movlps [ebx],xmm1 movhlps xmm1,xmm1 movss [ebx+8],xmm1 end if ret ;---------------------- in: ------------------------------- ;--------------------------- esi - pointer to 1st vector -- ;--------------------------- edi - pointer to 2nd vector -- ;--------------------------- ebx - pointer to result vector ;---------------------- out : none cross_product: fninit fld dword [esi+vec_y] fmul dword [edi+vec_z] fld dword [esi+vec_z] fmul dword [edi+vec_y] fsubp ;st1 ,st fstp dword [ebx+vec_x] fld dword [esi+vec_z] fmul dword [edi+vec_x] fld dword [esi+vec_x] fmul dword [edi+vec_z] fsubp ;st1 ,st fstp dword [ebx+vec_y] fld dword [esi+vec_x] fmul dword [edi+vec_y] fld dword [esi+vec_y] fmul dword [edi+vec_x] fsubp ;st1 ,st fstp dword [ebx+vec_z] ret ;----------------------- in: ------------------------------ ;---------------------------- edi - pointer to vector ----- ;----------------------- out : none normalize_vector: fninit fld dword [edi+vec_x] fmul st, st fld dword [edi+vec_y] fmul st, st fld dword [edi+vec_z] fmul st, st faddp st1, st faddp st1, st fsqrt ftst fstsw ax sahf jnz @f fst dword [edi+vec_x] fst dword [edi+vec_y] fstp dword [edi+vec_z] ret @@: fld st fld st fdivr dword [edi+vec_x] fstp dword [edi+vec_x] fdivr dword [edi+vec_y] fstp dword [edi+vec_y] fdivr dword [edi+vec_z] fstp dword [edi+vec_z] ret ;------------------in: ------------------------- ;------------------ esi - pointer to 1st vector ;------------------ edi - pointer to 2nd vector ;------------------out: ------------------------ ;------------------ st0 - dot-product dot_product: fninit fld dword [esi+vec_x] fmul dword [edi+vec_x] fld dword [esi+vec_y] fmul dword [edi+vec_y] fld dword [esi+vec_z] fmul dword [edi+vec_z] faddp faddp ret ; DOS version Coded by Mikolaj Felix aka Majuma ; mfelix@polbox.com ; www.majuma.xt.pl ; into FASM translation by Macgub init_sincos_tab: .counter equ dword [ebp-4] ; cur angle push ebp mov ebp,esp xor eax,eax push eax ; init .counter mov edi,cos_tab mov esi,sin_tab mov ecx,256 fninit fld .counter @@: fld st fsincos fstp dword [edi] fstp dword [esi] ; fadd [piD180] fadd [piD128] add esi,4 add edi,4 loop @b ffree st mov esp,ebp pop ebp ret ;------ ; esi - offset (pointer) to angles, edi offset to 3x3 matrix make_rotation_matrix: .sinx equ dword[ebp-4] .cosx equ dword[ebp-8] .siny equ dword[ebp-12] .cosy equ dword[ebp-16] .sinz equ dword[ebp-20] .cosz equ dword[ebp-24] push ebp mov ebp,esp sub esp,24 movzx ebx,word[esi] shl ebx,2 mov eax,dword[sin_tab+ebx] mov .sinx,eax mov edx,dword[cos_tab+ebx] mov .cosx,edx movzx ebx,word[esi+2] shl ebx,2 mov eax,dword[sin_tab+ebx] mov .siny,eax mov edx,dword[cos_tab+ebx] mov .cosy,edx movzx ebx,word[esi+4] shl ebx,2 mov eax,dword[sin_tab+ebx] mov .sinz,eax mov edx,dword[cos_tab+ebx] mov .cosz,edx fninit fld .cosy fmul .cosz fstp dword[edi] fld .sinx fmul .siny fmul .cosz fld .cosx fmul .sinz fchs faddp fstp dword[edi+12] fld .cosx fmul .siny fmul .cosz fld .sinx fmul .sinz faddp fstp dword[edi+24] fld .cosy fmul .sinz fstp dword[edi+4] fld .sinx fmul .siny fmul .sinz fld .cosx fmul .cosz faddp fstp dword[edi+16] fld .cosx fmul .siny fmul .sinz fld .sinx fchs fmul .cosz faddp fstp dword[edi+28] fld .siny fchs fstp dword[edi+8] fld .cosy fmul .sinx fstp dword[edi+20] fld .cosx fmul .cosy fstp dword[edi+32] mov esp,ebp pop ebp ret ;--------------------- ; in: esi - ptr to points(normals], each point(normal) coeficient as dword ; edi - ptr to rotated points(normals) ; ebx - ptr to 3x3 (9 dwords, 36 bytes) rotation matrix ; ecx - number of points(normals) rotary: if Ext