;

; jfdctfst.asm - fast integer FDCT (MMX)

;

; Copyright 2009 Pierre Ossman <ossman@cendio.se> for Cendio AB</ossman@cendio.se>

; Copyright (C) 2016, D. R. Commander.

;

; Based on the x86 SIMD extension for IJG JPEG library

; Copyright (C) 1999-2006, MIYASAKA Masaru.

; For conditions of distribution and use, see copyright notice in jsimdext.inc

;

; This file should be assembled with NASM (Netwide Assembler),

; can *not* be assembled with Microsoft's MASM or any compatible

; assembler (including Borland's Turbo Assembler).

; NASM is available from http://nasm.sourceforge.net/ or

; http://sourceforge.net/project/showfiles.php?group_id=6208

;

; This file contains a fast, not so accurate integer implementation of

; the forward DCT (Discrete Cosine Transform). The following code is

; based directly on the IJG's original jfdctfst.c; see the jfdctfst.c

; for more details.

%include "jsimdext.inc"

%include "jdct.inc"

; --------------------------------------------------------------------------

%define CONST_BITS  8  ; 14 is also OK.

%if CONST_BITS == 8

F_0_382 equ  98  ; FIX(0.382683433)

F_0_541 equ 139  ; FIX(0.541196100)

F_0_707 equ 181  ; FIX(0.707106781)

F_1_306 equ 334  ; FIX(1.306562965)

%else

; NASM cannot do compile-time arithmetic on floating-point constants.

%define DESCALE(x, n)  (((x) + (1 << ((n) - 1))) >> (n))

F_0_382 equ DESCALE( 410903207, 30 - CONST_BITS)  ; FIX(0.382683433)

F_0_541 equ DESCALE( 581104887, 30 - CONST_BITS)  ; FIX(0.541196100)

F_0_707 equ DESCALE( 759250124, 30 - CONST_BITS)  ; FIX(0.707106781)

F_1_306 equ DESCALE(1402911301, 30 - CONST_BITS)  ; FIX(1.306562965)

%endif

; --------------------------------------------------------------------------

    SECTION     SEG_CONST

; PRE_MULTIPLY_SCALE_BITS <= 2 (to avoid overflow)

; CONST_BITS + CONST_SHIFT + PRE_MULTIPLY_SCALE_BITS == 16 (for pmulhw)

%define PRE_MULTIPLY_SCALE_BITS  2

%define CONST_SHIFT              (16 - PRE_MULTIPLY_SCALE_BITS - CONST_BITS)

    alignz      32

    GLOBAL_DATA(jconst_fdct_ifast_mmx)

EXTN(jconst_fdct_ifast_mmx):

PW_F0707 times 4 dw F_0_707 << CONST_SHIFT

PW_F0382 times 4 dw F_0_382 << CONST_SHIFT

PW_F0541 times 4 dw F_0_541 << CONST_SHIFT

PW_F1306 times 4 dw F_1_306 << CONST_SHIFT

    alignz      32

; --------------------------------------------------------------------------

    SECTION     SEG_TEXT

    BITS        32

;

; Perform the forward DCT on one block of samples.

;

; GLOBAL(void)

; jsimd_fdct_ifast_mmx(DCTELEM *data)

;

%define data(b)       (b) + 8           ; DCTELEM *data

%define original_ebp  ebp + 0

%define wk(i)         ebp - (WK_NUM - (i)) * SIZEOF_MMWORD  ; mmword wk[WK_NUM]

%define WK_NUM        2

    align       32

    GLOBAL_FUNCTION(jsimd_fdct_ifast_mmx)

EXTN(jsimd_fdct_ifast_mmx):

    push        ebp

    mov         eax, esp                    ; eax = original ebp

    sub         esp, byte 4

    and         esp, byte (-SIZEOF_MMWORD)  ; align to 64 bits

    mov         [esp], eax

    mov         ebp, esp                    ; ebp = aligned ebp

    lea         esp, [wk(0)]

    pushpic     ebx

;   push        ecx                     ; need not be preserved

;   push        edx                     ; need not be preserved

;   push        esi                     ; unused

;   push        edi                     ; unused

    get_GOT     ebx                     ; get GOT address

    ; ---- Pass 1: process rows.

    mov         edx, POINTER [data(eax)]  ; (DCTELEM *)

    mov         ecx, DCTSIZE/4

    alignx      16, 7

.rowloop:

    movq        mm0, MMWORD [MMBLOCK(2,0,edx,SIZEOF_DCTELEM)]

    movq        mm1, MMWORD [MMBLOCK(3,0,edx,SIZEOF_DCTELEM)]

    movq        mm2, MMWORD [MMBLOCK(2,1,edx,SIZEOF_DCTELEM)]

    movq        mm3, MMWORD [MMBLOCK(3,1,edx,SIZEOF_DCTELEM)]

    ; mm0=(20 21 22 23), mm2=(24 25 26 27)

    ; mm1=(30 31 32 33), mm3=(34 35 36 37)

    movq        mm4, mm0                ; transpose coefficients(phase 1)

    punpcklwd   mm0, mm1                ; mm0=(20 30 21 31)

    punpckhwd   mm4, mm1                ; mm4=(22 32 23 33)

    movq        mm5, mm2                ; transpose coefficients(phase 1)

    punpcklwd   mm2, mm3                ; mm2=(24 34 25 35)

    punpckhwd   mm5, mm3                ; mm5=(26 36 27 37)

    movq        mm6, MMWORD [MMBLOCK(0,0,edx,SIZEOF_DCTELEM)]

    movq        mm7, MMWORD [MMBLOCK(1,0,edx,SIZEOF_DCTELEM)]

    movq        mm1, MMWORD [MMBLOCK(0,1,edx,SIZEOF_DCTELEM)]

    movq        mm3, MMWORD [MMBLOCK(1,1,edx,SIZEOF_DCTELEM)]

    ; mm6=(00 01 02 03), mm1=(04 05 06 07)

    ; mm7=(10 11 12 13), mm3=(14 15 16 17)

    movq        MMWORD [wk(0)], mm4     ; wk(0)=(22 32 23 33)

    movq        MMWORD [wk(1)], mm2     ; wk(1)=(24 34 25 35)

    movq        mm4, mm6                ; transpose coefficients(phase 1)

    punpcklwd   mm6, mm7                ; mm6=(00 10 01 11)

    punpckhwd   mm4, mm7                ; mm4=(02 12 03 13)

    movq        mm2, mm1                ; transpose coefficients(phase 1)

    punpcklwd   mm1, mm3                ; mm1=(04 14 05 15)

    punpckhwd   mm2, mm3                ; mm2=(06 16 07 17)

    movq        mm7, mm6                ; transpose coefficients(phase 2)

    punpckldq   mm6, mm0                ; mm6=(00 10 20 30)=data0

    punpckhdq   mm7, mm0                ; mm7=(01 11 21 31)=data1

    movq        mm3, mm2                ; transpose coefficients(phase 2)

    punpckldq   mm2, mm5                ; mm2=(06 16 26 36)=data6

    punpckhdq   mm3, mm5                ; mm3=(07 17 27 37)=data7

    movq        mm0, mm7

    movq        mm5, mm6

    psubw       mm7, mm2                ; mm7=data1-data6=tmp6

    psubw       mm6, mm3                ; mm6=data0-data7=tmp7

    paddw       mm0, mm2                ; mm0=data1+data6=tmp1

    paddw       mm5, mm3                ; mm5=data0+data7=tmp0

    movq        mm2, MMWORD [wk(0)]     ; mm2=(22 32 23 33)

    movq        mm3, MMWORD [wk(1)]     ; mm3=(24 34 25 35)

    movq        MMWORD [wk(0)], mm7     ; wk(0)=tmp6

    movq        MMWORD [wk(1)], mm6     ; wk(1)=tmp7

    movq        mm7, mm4                ; transpose coefficients(phase 2)

    punpckldq   mm4, mm2                ; mm4=(02 12 22 32)=data2

    punpckhdq   mm7, mm2                ; mm7=(03 13 23 33)=data3

    movq        mm6, mm1                ; transpose coefficients(phase 2)

    punpckldq   mm1, mm3                ; mm1=(04 14 24 34)=data4

    punpckhdq   mm6, mm3                ; mm6=(05 15 25 35)=data5

    movq        mm2, mm7

    movq        mm3, mm4

    paddw       mm7, mm1                ; mm7=data3+data4=tmp3

    paddw       mm4, mm6                ; mm4=data2+data5=tmp2

    psubw       mm2, mm1                ; mm2=data3-data4=tmp4

    psubw       mm3, mm6                ; mm3=data2-data5=tmp5

    ; -- Even part

    movq        mm1, mm5

    movq        mm6, mm0

    psubw       mm5, mm7                ; mm5=tmp13

    psubw       mm0, mm4                ; mm0=tmp12

    paddw       mm1, mm7                ; mm1=tmp10

    paddw       mm6, mm4                ; mm6=tmp11

    paddw       mm0, mm5

    psllw       mm0, PRE_MULTIPLY_SCALE_BITS

    pmulhw      mm0, [GOTOFF(ebx,PW_F0707)]  ; mm0=z1

    movq        mm7, mm1

    movq        mm4, mm5

    psubw       mm1, mm6                ; mm1=data4

    psubw       mm5, mm0                ; mm5=data6

    paddw       mm7, mm6                ; mm7=data0

    paddw       mm4, mm0                ; mm4=data2

    movq        MMWORD [MMBLOCK(0,1,edx,SIZEOF_DCTELEM)], mm1

    movq        MMWORD [MMBLOCK(2,1,edx,SIZEOF_DCTELEM)], mm5

    movq        MMWORD [MMBLOCK(0,0,edx,SIZEOF_DCTELEM)], mm7

    movq        MMWORD [MMBLOCK(2,0,edx,SIZEOF_DCTELEM)], mm4

    ; -- Odd part

    movq        mm6, MMWORD [wk(0)]     ; mm6=tmp6

    movq        mm0, MMWORD [wk(1)]     ; mm0=tmp7

    paddw       mm2, mm3                ; mm2=tmp10

    paddw       mm3, mm6                ; mm3=tmp11

    paddw       mm6, mm0                ; mm6=tmp12, mm0=tmp7

    psllw       mm2, PRE_MULTIPLY_SCALE_BITS

    psllw       mm6, PRE_MULTIPLY_SCALE_BITS

    psllw       mm3, PRE_MULTIPLY_SCALE_BITS

    pmulhw      mm3, [GOTOFF(ebx,PW_F0707)]  ; mm3=z3

    movq        mm1, mm2                     ; mm1=tmp10

    psubw       mm2, mm6

    pmulhw      mm2, [GOTOFF(ebx,PW_F0382)]  ; mm2=z5

    pmulhw      mm1, [GOTOFF(ebx,PW_F0541)]  ; mm1=MULTIPLY(tmp10,FIX_0_54119610)

    pmulhw      mm6, [GOTOFF(ebx,PW_F1306)]  ; mm6=MULTIPLY(tmp12,FIX_1_30656296)

    paddw       mm1, mm2                     ; mm1=z2

    paddw       mm6, mm2                     ; mm6=z4

    movq        mm5, mm0

    psubw       mm0, mm3                ; mm0=z13

    paddw       mm5, mm3                ; mm5=z11

    movq        mm7, mm0

    movq        mm4, mm5

    psubw       mm0, mm1                ; mm0=data3

    psubw       mm5, mm6                ; mm5=data7

    paddw       mm7, mm1                ; mm7=data5

    paddw       mm4, mm6                ; mm4=data1

    movq        MMWORD [MMBLOCK(3,0,edx,SIZEOF_DCTELEM)], mm0

    movq        MMWORD [MMBLOCK(3,1,edx,SIZEOF_DCTELEM)], mm5

    movq        MMWORD [MMBLOCK(1,1,edx,SIZEOF_DCTELEM)], mm7

    movq        MMWORD [MMBLOCK(1,0,edx,SIZEOF_DCTELEM)], mm4

    add         edx, byte 4*DCTSIZE*SIZEOF_DCTELEM

    dec         ecx

    jnz         near .rowloop

    ; ---- Pass 2: process columns.

    mov         edx, POINTER [data(eax)]  ; (DCTELEM *)

    mov         ecx, DCTSIZE/4

    alignx      16, 7

.columnloop:

    movq        mm0, MMWORD [MMBLOCK(2,0,edx,SIZEOF_DCTELEM)]

    movq        mm1, MMWORD [MMBLOCK(3,0,edx,SIZEOF_DCTELEM)]

    movq        mm2, MMWORD [MMBLOCK(6,0,edx,SIZEOF_DCTELEM)]

    movq        mm3, MMWORD [MMBLOCK(7,0,edx,SIZEOF_DCTELEM)]

    ; mm0=(02 12 22 32), mm2=(42 52 62 72)

    ; mm1=(03 13 23 33), mm3=(43 53 63 73)

    movq        mm4, mm0                ; transpose coefficients(phase 1)

    punpcklwd   mm0, mm1                ; mm0=(02 03 12 13)

    punpckhwd   mm4, mm1                ; mm4=(22 23 32 33)

    movq        mm5, mm2                ; transpose coefficients(phase 1)

    punpcklwd   mm2, mm3                ; mm2=(42 43 52 53)

    punpckhwd   mm5, mm3                ; mm5=(62 63 72 73)

    movq        mm6, MMWORD [MMBLOCK(0,0,edx,SIZEOF_DCTELEM)]

    movq        mm7, MMWORD [MMBLOCK(1,0,edx,SIZEOF_DCTELEM)]

    movq        mm1, MMWORD [MMBLOCK(4,0,edx,SIZEOF_DCTELEM)]

    movq        mm3, MMWORD [MMBLOCK(5,0,edx,SIZEOF_DCTELEM)]

    ; mm6=(00 10 20 30), mm1=(40 50 60 70)

    ; mm7=(01 11 21 31), mm3=(41 51 61 71)

    movq        MMWORD [wk(0)], mm4     ; wk(0)=(22 23 32 33)

    movq        MMWORD [wk(1)], mm2     ; wk(1)=(42 43 52 53)

    movq        mm4, mm6                ; transpose coefficients(phase 1)

    punpcklwd   mm6, mm7                ; mm6=(00 01 10 11)

    punpckhwd   mm4, mm7                ; mm4=(20 21 30 31)

    movq        mm2, mm1                ; transpose coefficients(phase 1)

    punpcklwd   mm1, mm3                ; mm1=(40 41 50 51)

    punpckhwd   mm2, mm3                ; mm2=(60 61 70 71)

    movq        mm7, mm6                ; transpose coefficients(phase 2)

    punpckldq   mm6, mm0                ; mm6=(00 01 02 03)=data0

    punpckhdq   mm7, mm0                ; mm7=(10 11 12 13)=data1

    movq        mm3, mm2                ; transpose coefficients(phase 2)

    punpckldq   mm2, mm5                ; mm2=(60 61 62 63)=data6

    punpckhdq   mm3, mm5                ; mm3=(70 71 72 73)=data7

    movq        mm0, mm7

    movq        mm5, mm6

    psubw       mm7, mm2                ; mm7=data1-data6=tmp6

    psubw       mm6, mm3                ; mm6=data0-data7=tmp7

    paddw       mm0, mm2                ; mm0=data1+data6=tmp1

    paddw       mm5, mm3                ; mm5=data0+data7=tmp0

    movq        mm2, MMWORD [wk(0)]     ; mm2=(22 23 32 33)

    movq        mm3, MMWORD [wk(1)]     ; mm3=(42 43 52 53)

    movq        MMWORD [wk(0)], mm7     ; wk(0)=tmp6

    movq        MMWORD [wk(1)], mm6     ; wk(1)=tmp7

    movq        mm7, mm4                ; transpose coefficients(phase 2)

    punpckldq   mm4, mm2                ; mm4=(20 21 22 23)=data2

    punpckhdq   mm7, mm2                ; mm7=(30 31 32 33)=data3

    movq        mm6, mm1                ; transpose coefficients(phase 2)

    punpckldq   mm1, mm3                ; mm1=(40 41 42 43)=data4

    punpckhdq   mm6, mm3                ; mm6=(50 51 52 53)=data5

    movq        mm2, mm7

    movq        mm3, mm4

    paddw       mm7, mm1                ; mm7=data3+data4=tmp3

    paddw       mm4, mm6                ; mm4=data2+data5=tmp2

    psubw       mm2, mm1                ; mm2=data3-data4=tmp4

    psubw       mm3, mm6                ; mm3=data2-data5=tmp5

    ; -- Even part

    movq        mm1, mm5

    movq        mm6, mm0

    psubw       mm5, mm7                ; mm5=tmp13

    psubw       mm0, mm4                ; mm0=tmp12

    paddw       mm1, mm7                ; mm1=tmp10

    paddw       mm6, mm4                ; mm6=tmp11

    paddw       mm0, mm5

    psllw       mm0, PRE_MULTIPLY_SCALE_BITS

    pmulhw      mm0, [GOTOFF(ebx,PW_F0707)]  ; mm0=z1

    movq        mm7, mm1

    movq        mm4, mm5

    psubw       mm1, mm6                ; mm1=data4

    psubw       mm5, mm0                ; mm5=data6

    paddw       mm7, mm6                ; mm7=data0

    paddw       mm4, mm0                ; mm4=data2

    movq        MMWORD [MMBLOCK(4,0,edx,SIZEOF_DCTELEM)], mm1

    movq        MMWORD [MMBLOCK(6,0,edx,SIZEOF_DCTELEM)], mm5

    movq        MMWORD [MMBLOCK(0,0,edx,SIZEOF_DCTELEM)], mm7

    movq        MMWORD [MMBLOCK(2,0,edx,SIZEOF_DCTELEM)], mm4

    ; -- Odd part

    movq        mm6, MMWORD [wk(0)]     ; mm6=tmp6

    movq        mm0, MMWORD [wk(1)]     ; mm0=tmp7

    paddw       mm2, mm3                ; mm2=tmp10

    paddw       mm3, mm6                ; mm3=tmp11

    paddw       mm6, mm0                ; mm6=tmp12, mm0=tmp7

    psllw       mm2, PRE_MULTIPLY_SCALE_BITS

    psllw       mm6, PRE_MULTIPLY_SCALE_BITS

    psllw       mm3, PRE_MULTIPLY_SCALE_BITS

    pmulhw      mm3, [GOTOFF(ebx,PW_F0707)]  ; mm3=z3

    movq        mm1, mm2                     ; mm1=tmp10

    psubw       mm2, mm6

    pmulhw      mm2, [GOTOFF(ebx,PW_F0382)]  ; mm2=z5

    pmulhw      mm1, [GOTOFF(ebx,PW_F0541)]  ; mm1=MULTIPLY(tmp10,FIX_0_54119610)

    pmulhw      mm6, [GOTOFF(ebx,PW_F1306)]  ; mm6=MULTIPLY(tmp12,FIX_1_30656296)

    paddw       mm1, mm2                     ; mm1=z2

    paddw       mm6, mm2                     ; mm6=z4

    movq        mm5, mm0

    psubw       mm0, mm3                ; mm0=z13

    paddw       mm5, mm3                ; mm5=z11

    movq        mm7, mm0

    movq        mm4, mm5

    psubw       mm0, mm1                ; mm0=data3

    psubw       mm5, mm6                ; mm5=data7

    paddw       mm7, mm1                ; mm7=data5

    paddw       mm4, mm6                ; mm4=data1

    movq        MMWORD [MMBLOCK(3,0,edx,SIZEOF_DCTELEM)], mm0

    movq        MMWORD [MMBLOCK(7,0,edx,SIZEOF_DCTELEM)], mm5

    movq        MMWORD [MMBLOCK(5,0,edx,SIZEOF_DCTELEM)], mm7

    movq        MMWORD [MMBLOCK(1,0,edx,SIZEOF_DCTELEM)], mm4

    add         edx, byte 4*SIZEOF_DCTELEM

    dec         ecx

    jnz         near .columnloop

    emms                                ; empty MMX state

;   pop         edi                     ; unused

;   pop         esi                     ; unused

;   pop         edx                     ; need not be preserved

;   pop         ecx                     ; need not be preserved

    poppic      ebx

    mov         esp, ebp                ; esp <- aligned ebp

    pop         esp                     ; esp <- original ebp

    pop         ebp

    ret

; For some reason, the OS X linker does not honor the request to align the

; segment unless we do this.

    align       32