# Pure Data Packet mmx routine. # Copyright (c) by Tom Schouten # # This program is free software; you can redistribute it and/or modify # it under the terms of the GNU General Public License as published by # the Free Software Foundation; either version 2 of the License, or # (at your option) any later version. # # This program is distributed in the hope that it will be useful, # but WITHOUT ANY WARRANTY; without even the implied warranty of # MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the # GNU General Public License for more details. # # You should have received a copy of the GNU General Public License # along with this program; if not, write to the Free Software # Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. # # TODO: COUPLED CASCADE SECOND ORDER SECTION # # s1[k] = ar * s1[k-1] + ai * s2[k-1] + x[k] # s2[k] = ar * s2[k-1] - ai * s1[k-1] # y[k] = c0 * x[k] + c1 * s1[k-1] + c2 * s2[k-1] # MACRO: df2 # # computes a coupled cascade # # input: %mm0 == input # %mm1 == state 1 # %mm2 == state 2 # (%esi) == cascade coefs (ar ai c0 c1 c2) in s0.15 # output: %mm0 == output # %mm1 == state 1 # %mm2 == state 2 .macro coupled pmovq %mm1, %mm3 # mm3 == s1[k-1] pmovq %mm1, %mm4 # mm4 == s1[k-1] pmovq %mm2, %mm5 # mm5 == s2[k-1] pmovq %mm2, %mm6 # mm5 == s2[k-1] pmulhw (%esi), %mm1 # mm1 == s1[k-1] * ar pmulhw 8(%esi), %mm3 # mm3 == s1[k-1] * ai pmulhw 24(%esi), %mm4 # mm4 == s1[k-1] * c1 pmulhw (%esi), %mm2 # mm2 == s2[k-1] * ar pmulhw 8(%esi), %mm5 # mm5 == s2[k-1] * ai pmulhw 32(%esi), %mm6 # mm6 == s2[k-1] * c2 paddw %mm5, %mm1 # mm1 == s1[k-1] * ar + s2[k-1] * ai psubw %mm3, %mm2 # mm2 == s2[k-1] * ar - s1[k-1] * ai == s2[k] paddw %mm0, %mm1 # mm1 == s1[k] pmulhw 16(%esi), %mm0 # mm0 == x[k] * c0 paddw %mm6, %mm4 # mm4 == s1[k-1] * c1 + s2[k-1] * c2 paddw %mm4, %mm0 # mm0 == y[k] .endm # in order to use the 4 line parallel cascade routine on horizontal # lines, we need to reorder (rotate or transpose) the matrix, since # images are scanline encoded, and we want to work in parallell # on 4 lines. # # since the 4 lines are independent, it doesnt matter in which order # the the vector elements are present. # # this allows us to use the same routine for left->right and right->left # processing. # # some comments on the non-abelean group of square isometries consisting of # (I) identity # (H) horizontal axis mirror # (V) vertical axis mirror # (T) transpose (diagonal axis mirror) # (A) antitranspose (antidiagonal axis mirror) # (R1) 90deg anticlockwize rotation # (R2) 180deg rotation # (R3) 90deg clockwize rotation # # # we basicly have two options: (R1,R3) or (T,A) # we opt for T and A because they are self inverting, which improves locality # # use antitranspose for right to left an transpose # for left to right (little endian) # antitranspose 4x4 # input # %mm3 == {d0 d1 d2 d3} # %mm2 == {c0 c1 c2 c3} # %mm1 == {b0 b1 b2 b3} # %mm0 == {a0 a1 a2 a3} # output # %mm3 == {a3 b3 c3 d3} # %mm2 == {a2 b2 c2 d2} # %mm1 == {a1 b1 c1 d1} # %mm0 == {a0 b0 c0 d0} .macro antitranspose_4x4: movq %mm3, %mm4 punpcklwd %mm1, %mm4 # mm4 <- {b2 d2 b3 d3} movq %mm3, %mm5 punpckhwd %mm1, %mm5 # mm5 <- {b0 d0 b1 d1} movq %mm2, %mm6 punpcklwd %mm0, %mm6 # mm6 <- {a2 c2 a3 c3} movq %mm2, %mm7 punpckhwd %mm0, %mm7 # mm7 <- {a0 c0 a1 c1} movq %mm4, %mm3 punpcklwd %mm6, %mm3 # mm3 <- {a3 b3 c3 d3} movq %mm4, %mm2 punpckhwd %mm6, %mm2 # mm2 <- {a2 b2 c2 d2} movq %mm5, %mm1 punpcklwd %mm7, %mm1 # mm1 <- {a1 b1 c1 d1} movq %mm5, %mm0 punpckhwd %mm7, %mm0 # mm0 <- {a0 b0 c0 d0} .endm # transpose 4x4 # input # %mm3 == {d3 d2 d1 d0} # %mm2 == {c3 c2 c1 c0} # %mm1 == {b3 b2 b1 b0} # %mm0 == {a3 a2 a1 a0} # output # %mm3 == {d3 c3 b3 a3} # %mm2 == {d2 c2 b2 a2} # %mm1 == {d1 c1 b1 a1} # %mm0 == {d0 c0 b0 a0} .macro transpose_4x4: movq %mm0, %mm4 punpcklwd %mm2, %mm4 # mm4 <- {c1 a1 c0 a0} movq %mm0, %mm5 punpckhwd %mm2, %mm5 # mm5 <- {c3 a3 c2 a2} movq %mm1, %mm6 punpcklwd %mm3, %mm6 # mm6 <- {d1 b1 d0 b0} movq %mm1, %mm7 punpckhwd %mm3, %mm7 # mm7 <- {d3 b3 d2 b2} movq %mm4, %mm0 punpcklwd %mm6, %mm0 # mm0 <- {d0 c0 b0 a0} movq %mm4, %mm1 punpckhwd %mm6, %mm1 # mm1 <- {d1 c1 b1 a1} movq %mm5, %mm2 punpcklwd %mm7, %mm2 # mm2 <- {d2 c2 b2 a2} movq %mm5, %mm3 punpckhwd %mm7, %mm3 # mm3 <- {d3 c3 b3 a3} .endm .globl pixel_cascade_vertb_s16 .type pixel_cascade_vertb_s16,@function # pixel_cascade_vertbr_s16(char *pixel_array, int nb_rows, int linewidth, short int coef[20], short int state[8]) pixel_cascade_vertb_s16: pushl %ebp movl %esp, %ebp push %ebx push %esi push %edi movl 8(%ebp), %ebx # pixel array offset movl 12(%ebp), %ecx # nb of 4x4 pixblocks movl 16(%ebp), %edx # line with movl 20(%ebp), %esi # coefs movl 24(%ebp), %edi # state shll $1, %edx # short int addressing subl %edx, %ebx movq 0(%edi), %mm1 # s1[k-1] movq 8(%edi), %mm2 # s2[k-1] .align 16 .cascade_vertb_line_loop: movq (%ebx,%edx,1), %mm3 movq %mm3, %mm0 addl %edx, %ebx coupled movq %mm0, (%ebx) movq (%ebx,%edx,1), %mm3 movq %mm3, %mm0 addl %edx, %ebx coupled movq %mm0, (%ebx) movq (%ebx,%edx,1), %mm3 movq %mm3, %mm0 addl %edx, %ebx coupled movq %mm0, (%ebx) movq (%ebx,%edx,1), %mm3 movq %mm3, %mm0 addl %edx, %ebx coupled movq %mm0, (%ebx) decl %ecx jnz .cascade_vertb_line_loop movq %mm1, 0(%edi) # s1[k-1] movq %mm2, 8(%edi) # s2[k-1] emms pop %edi pop %esi pop %ebx leave ret .globl pixel_cascade_horlr_s16 .type pixel_cascade_horlr_s16,@function # pixel_cascade_hor_s16(char *pixel_array, int nb_rows, int linewidth, short int coef[20], short int state[8]) pixel_cascade_horlr_s16: pushl %ebp movl %esp, %ebp push %ebx push %esi push %edi movl 8(%ebp), %ebx # pixel array offset movl 12(%ebp), %ecx # nb of 4x4 pixblocks movl 16(%ebp), %edx # line with movl 20(%ebp), %esi # coefs movl 24(%ebp), %edi # state shll $1, %edx # short int addressing movl %edx, %eax shll $1, %eax addl %edx, %eax # eax = 3 * edx .align 16 .cascade_horlr_line_loop: movq (%edi), %mm1 movq 8(%edi), %mm2 movq (%ebx), %mm0 movq (%ebx,%edx,1), %mm1 movq (%ebx,%edx,2), %mm2 movq (%ebx,%eax,1), %mm3 transpose_4x4 movq %mm1, (%ebx,%edx,1) movq %mm2, (%ebx,%edx,2) movq %mm3, (%ebx,%eax,1) coupled movq %mm0, (%ebx) movq (%ebx,%edx,1), %mm3 movq %mm3, %mm0 coupled movq %mm0, (%ebx, %edx,1) movq (%ebx,%edx,2), %mm3 movq %mm3, %mm0 coupled movq %mm0, (%ebx, %edx,2) movq (%ebx,%eax,1), %mm3 movq %mm3, %mm0 coupled movq %mm1, 0(%edi) # s1[k-1] movq %mm2, 8(%edi) # s2[k-1] movq %mm0, %mm3 movq (%ebx), %mm0 movq (%ebx,%edx,1), %mm1 movq (%ebx,%edx,2), %mm2 transpose_4x4 movq %mm0, (%ebx) movq %mm1, (%ebx,%edx,1) movq %mm2, (%ebx,%edx,2) movq %mm3, (%ebx,%eax,1) addl $8, %ebx decl %ecx jnz .cascade_horlr_line_loop emms pop %edi pop %esi pop %ebx leave ret