MIYASAKA Masaru | a2e6a9d | 2006-02-04 00:00:00 +0000 | [diff] [blame] | 1 | ; |
| 2 | ; jcqnt3dn.asm - sample data conversion and quantization (3DNow! & MMX) |
| 3 | ; |
Pierre Ossman | 65d0317 | 2009-03-09 13:28:10 +0000 | [diff] [blame] | 4 | ; Copyright 2009 Pierre Ossman <ossman@cendio.se> for Cendio AB |
| 5 | ; |
| 6 | ; Based on |
MIYASAKA Masaru | a2e6a9d | 2006-02-04 00:00:00 +0000 | [diff] [blame] | 7 | ; x86 SIMD extension for IJG JPEG library |
| 8 | ; Copyright (C) 1999-2006, MIYASAKA Masaru. |
| 9 | ; For conditions of distribution and use, see copyright notice in jsimdext.inc |
| 10 | ; |
| 11 | ; This file should be assembled with NASM (Netwide Assembler), |
| 12 | ; can *not* be assembled with Microsoft's MASM or any compatible |
| 13 | ; assembler (including Borland's Turbo Assembler). |
| 14 | ; NASM is available from http://nasm.sourceforge.net/ or |
| 15 | ; http://sourceforge.net/project/showfiles.php?group_id=6208 |
| 16 | ; |
MIYASAKA Masaru | a2e6a9d | 2006-02-04 00:00:00 +0000 | [diff] [blame] | 17 | ; [TAB8] |
| 18 | |
Pierre Ossman | 3a65ef4 | 2009-03-16 13:34:18 +0000 | [diff] [blame] | 19 | %include "jsimdext.inc" |
| 20 | %include "jdct.inc" |
MIYASAKA Masaru | a2e6a9d | 2006-02-04 00:00:00 +0000 | [diff] [blame] | 21 | |
| 22 | ; -------------------------------------------------------------------------- |
| 23 | SECTION SEG_TEXT |
| 24 | BITS 32 |
| 25 | ; |
| 26 | ; Load data into workspace, applying unsigned->signed conversion |
| 27 | ; |
| 28 | ; GLOBAL(void) |
Pierre Ossman | 65d0317 | 2009-03-09 13:28:10 +0000 | [diff] [blame] | 29 | ; jsimd_convsamp_float_3dnow (JSAMPARRAY sample_data, JDIMENSION start_col, |
| 30 | ; FAST_FLOAT * workspace); |
MIYASAKA Masaru | a2e6a9d | 2006-02-04 00:00:00 +0000 | [diff] [blame] | 31 | ; |
| 32 | |
| 33 | %define sample_data ebp+8 ; JSAMPARRAY sample_data |
| 34 | %define start_col ebp+12 ; JDIMENSION start_col |
| 35 | %define workspace ebp+16 ; FAST_FLOAT * workspace |
| 36 | |
| 37 | align 16 |
Pierre Ossman | 65d0317 | 2009-03-09 13:28:10 +0000 | [diff] [blame] | 38 | global EXTN(jsimd_convsamp_float_3dnow) |
MIYASAKA Masaru | a2e6a9d | 2006-02-04 00:00:00 +0000 | [diff] [blame] | 39 | |
Pierre Ossman | 65d0317 | 2009-03-09 13:28:10 +0000 | [diff] [blame] | 40 | EXTN(jsimd_convsamp_float_3dnow): |
MIYASAKA Masaru | a2e6a9d | 2006-02-04 00:00:00 +0000 | [diff] [blame] | 41 | push ebp |
| 42 | mov ebp,esp |
| 43 | push ebx |
| 44 | ; push ecx ; need not be preserved |
| 45 | ; push edx ; need not be preserved |
| 46 | push esi |
| 47 | push edi |
| 48 | |
| 49 | pcmpeqw mm7,mm7 |
| 50 | psllw mm7,7 |
| 51 | packsswb mm7,mm7 ; mm7 = PB_CENTERJSAMPLE (0x808080..) |
| 52 | |
| 53 | mov esi, JSAMPARRAY [sample_data] ; (JSAMPROW *) |
| 54 | mov eax, JDIMENSION [start_col] |
| 55 | mov edi, POINTER [workspace] ; (DCTELEM *) |
| 56 | mov ecx, DCTSIZE/2 |
| 57 | alignx 16,7 |
| 58 | .convloop: |
| 59 | mov ebx, JSAMPROW [esi+0*SIZEOF_JSAMPROW] ; (JSAMPLE *) |
| 60 | mov edx, JSAMPROW [esi+1*SIZEOF_JSAMPROW] ; (JSAMPLE *) |
| 61 | |
| 62 | movq mm0, MMWORD [ebx+eax*SIZEOF_JSAMPLE] |
| 63 | movq mm1, MMWORD [edx+eax*SIZEOF_JSAMPLE] |
| 64 | |
| 65 | psubb mm0,mm7 ; mm0=(01234567) |
| 66 | psubb mm1,mm7 ; mm1=(89ABCDEF) |
| 67 | |
| 68 | punpcklbw mm2,mm0 ; mm2=(*0*1*2*3) |
| 69 | punpckhbw mm0,mm0 ; mm0=(*4*5*6*7) |
| 70 | punpcklbw mm3,mm1 ; mm3=(*8*9*A*B) |
| 71 | punpckhbw mm1,mm1 ; mm1=(*C*D*E*F) |
| 72 | |
| 73 | punpcklwd mm4,mm2 ; mm4=(***0***1) |
| 74 | punpckhwd mm2,mm2 ; mm2=(***2***3) |
| 75 | punpcklwd mm5,mm0 ; mm5=(***4***5) |
| 76 | punpckhwd mm0,mm0 ; mm0=(***6***7) |
| 77 | |
| 78 | psrad mm4,(DWORD_BIT-BYTE_BIT) ; mm4=(01) |
| 79 | psrad mm2,(DWORD_BIT-BYTE_BIT) ; mm2=(23) |
| 80 | pi2fd mm4,mm4 |
| 81 | pi2fd mm2,mm2 |
| 82 | psrad mm5,(DWORD_BIT-BYTE_BIT) ; mm5=(45) |
| 83 | psrad mm0,(DWORD_BIT-BYTE_BIT) ; mm0=(67) |
| 84 | pi2fd mm5,mm5 |
| 85 | pi2fd mm0,mm0 |
| 86 | |
| 87 | movq MMWORD [MMBLOCK(0,0,edi,SIZEOF_FAST_FLOAT)], mm4 |
| 88 | movq MMWORD [MMBLOCK(0,1,edi,SIZEOF_FAST_FLOAT)], mm2 |
| 89 | movq MMWORD [MMBLOCK(0,2,edi,SIZEOF_FAST_FLOAT)], mm5 |
| 90 | movq MMWORD [MMBLOCK(0,3,edi,SIZEOF_FAST_FLOAT)], mm0 |
| 91 | |
| 92 | punpcklwd mm6,mm3 ; mm6=(***8***9) |
| 93 | punpckhwd mm3,mm3 ; mm3=(***A***B) |
| 94 | punpcklwd mm4,mm1 ; mm4=(***C***D) |
| 95 | punpckhwd mm1,mm1 ; mm1=(***E***F) |
| 96 | |
| 97 | psrad mm6,(DWORD_BIT-BYTE_BIT) ; mm6=(89) |
| 98 | psrad mm3,(DWORD_BIT-BYTE_BIT) ; mm3=(AB) |
| 99 | pi2fd mm6,mm6 |
| 100 | pi2fd mm3,mm3 |
| 101 | psrad mm4,(DWORD_BIT-BYTE_BIT) ; mm4=(CD) |
| 102 | psrad mm1,(DWORD_BIT-BYTE_BIT) ; mm1=(EF) |
| 103 | pi2fd mm4,mm4 |
| 104 | pi2fd mm1,mm1 |
| 105 | |
| 106 | movq MMWORD [MMBLOCK(1,0,edi,SIZEOF_FAST_FLOAT)], mm6 |
| 107 | movq MMWORD [MMBLOCK(1,1,edi,SIZEOF_FAST_FLOAT)], mm3 |
| 108 | movq MMWORD [MMBLOCK(1,2,edi,SIZEOF_FAST_FLOAT)], mm4 |
| 109 | movq MMWORD [MMBLOCK(1,3,edi,SIZEOF_FAST_FLOAT)], mm1 |
| 110 | |
| 111 | add esi, byte 2*SIZEOF_JSAMPROW |
| 112 | add edi, byte 2*DCTSIZE*SIZEOF_FAST_FLOAT |
| 113 | dec ecx |
| 114 | jnz near .convloop |
| 115 | |
| 116 | femms ; empty MMX/3DNow! state |
| 117 | |
| 118 | pop edi |
| 119 | pop esi |
| 120 | ; pop edx ; need not be preserved |
| 121 | ; pop ecx ; need not be preserved |
| 122 | pop ebx |
| 123 | pop ebp |
| 124 | ret |
| 125 | |
| 126 | |
| 127 | ; -------------------------------------------------------------------------- |
| 128 | ; |
| 129 | ; Quantize/descale the coefficients, and store into coef_block |
| 130 | ; |
| 131 | ; GLOBAL(void) |
Pierre Ossman | 65d0317 | 2009-03-09 13:28:10 +0000 | [diff] [blame] | 132 | ; jsimd_quantize_float_3dnow (JCOEFPTR coef_block, FAST_FLOAT * divisors, |
| 133 | ; FAST_FLOAT * workspace); |
MIYASAKA Masaru | a2e6a9d | 2006-02-04 00:00:00 +0000 | [diff] [blame] | 134 | ; |
| 135 | |
| 136 | %define coef_block ebp+8 ; JCOEFPTR coef_block |
| 137 | %define divisors ebp+12 ; FAST_FLOAT * divisors |
| 138 | %define workspace ebp+16 ; FAST_FLOAT * workspace |
| 139 | |
| 140 | align 16 |
Pierre Ossman | 65d0317 | 2009-03-09 13:28:10 +0000 | [diff] [blame] | 141 | global EXTN(jsimd_quantize_float_3dnow) |
MIYASAKA Masaru | a2e6a9d | 2006-02-04 00:00:00 +0000 | [diff] [blame] | 142 | |
Pierre Ossman | 65d0317 | 2009-03-09 13:28:10 +0000 | [diff] [blame] | 143 | EXTN(jsimd_quantize_float_3dnow): |
MIYASAKA Masaru | a2e6a9d | 2006-02-04 00:00:00 +0000 | [diff] [blame] | 144 | push ebp |
| 145 | mov ebp,esp |
| 146 | ; push ebx ; unused |
| 147 | ; push ecx ; unused |
| 148 | ; push edx ; need not be preserved |
| 149 | push esi |
| 150 | push edi |
| 151 | |
| 152 | mov eax, 0x4B400000 ; (float)0x00C00000 (rndint_magic) |
| 153 | movd mm7,eax |
| 154 | punpckldq mm7,mm7 ; mm7={12582912.0F 12582912.0F} |
| 155 | |
| 156 | mov esi, POINTER [workspace] |
| 157 | mov edx, POINTER [divisors] |
| 158 | mov edi, JCOEFPTR [coef_block] |
| 159 | mov eax, DCTSIZE2/16 |
| 160 | alignx 16,7 |
| 161 | .quantloop: |
| 162 | movq mm0, MMWORD [MMBLOCK(0,0,esi,SIZEOF_FAST_FLOAT)] |
| 163 | movq mm1, MMWORD [MMBLOCK(0,1,esi,SIZEOF_FAST_FLOAT)] |
| 164 | pfmul mm0, MMWORD [MMBLOCK(0,0,edx,SIZEOF_FAST_FLOAT)] |
| 165 | pfmul mm1, MMWORD [MMBLOCK(0,1,edx,SIZEOF_FAST_FLOAT)] |
| 166 | movq mm2, MMWORD [MMBLOCK(0,2,esi,SIZEOF_FAST_FLOAT)] |
| 167 | movq mm3, MMWORD [MMBLOCK(0,3,esi,SIZEOF_FAST_FLOAT)] |
| 168 | pfmul mm2, MMWORD [MMBLOCK(0,2,edx,SIZEOF_FAST_FLOAT)] |
| 169 | pfmul mm3, MMWORD [MMBLOCK(0,3,edx,SIZEOF_FAST_FLOAT)] |
| 170 | |
| 171 | pfadd mm0,mm7 ; mm0=(00 ** 01 **) |
| 172 | pfadd mm1,mm7 ; mm1=(02 ** 03 **) |
| 173 | pfadd mm2,mm7 ; mm0=(04 ** 05 **) |
| 174 | pfadd mm3,mm7 ; mm1=(06 ** 07 **) |
| 175 | |
| 176 | movq mm4,mm0 |
| 177 | punpcklwd mm0,mm1 ; mm0=(00 02 ** **) |
| 178 | punpckhwd mm4,mm1 ; mm4=(01 03 ** **) |
| 179 | movq mm5,mm2 |
| 180 | punpcklwd mm2,mm3 ; mm2=(04 06 ** **) |
| 181 | punpckhwd mm5,mm3 ; mm5=(05 07 ** **) |
| 182 | |
| 183 | punpcklwd mm0,mm4 ; mm0=(00 01 02 03) |
| 184 | punpcklwd mm2,mm5 ; mm2=(04 05 06 07) |
| 185 | |
| 186 | movq mm6, MMWORD [MMBLOCK(1,0,esi,SIZEOF_FAST_FLOAT)] |
| 187 | movq mm1, MMWORD [MMBLOCK(1,1,esi,SIZEOF_FAST_FLOAT)] |
| 188 | pfmul mm6, MMWORD [MMBLOCK(1,0,edx,SIZEOF_FAST_FLOAT)] |
| 189 | pfmul mm1, MMWORD [MMBLOCK(1,1,edx,SIZEOF_FAST_FLOAT)] |
| 190 | movq mm3, MMWORD [MMBLOCK(1,2,esi,SIZEOF_FAST_FLOAT)] |
| 191 | movq mm4, MMWORD [MMBLOCK(1,3,esi,SIZEOF_FAST_FLOAT)] |
| 192 | pfmul mm3, MMWORD [MMBLOCK(1,2,edx,SIZEOF_FAST_FLOAT)] |
| 193 | pfmul mm4, MMWORD [MMBLOCK(1,3,edx,SIZEOF_FAST_FLOAT)] |
| 194 | |
| 195 | pfadd mm6,mm7 ; mm0=(10 ** 11 **) |
| 196 | pfadd mm1,mm7 ; mm4=(12 ** 13 **) |
| 197 | pfadd mm3,mm7 ; mm0=(14 ** 15 **) |
| 198 | pfadd mm4,mm7 ; mm4=(16 ** 17 **) |
| 199 | |
| 200 | movq mm5,mm6 |
| 201 | punpcklwd mm6,mm1 ; mm6=(10 12 ** **) |
| 202 | punpckhwd mm5,mm1 ; mm5=(11 13 ** **) |
| 203 | movq mm1,mm3 |
| 204 | punpcklwd mm3,mm4 ; mm3=(14 16 ** **) |
| 205 | punpckhwd mm1,mm4 ; mm1=(15 17 ** **) |
| 206 | |
| 207 | punpcklwd mm6,mm5 ; mm6=(10 11 12 13) |
| 208 | punpcklwd mm3,mm1 ; mm3=(14 15 16 17) |
| 209 | |
| 210 | movq MMWORD [MMBLOCK(0,0,edi,SIZEOF_JCOEF)], mm0 |
| 211 | movq MMWORD [MMBLOCK(0,1,edi,SIZEOF_JCOEF)], mm2 |
| 212 | movq MMWORD [MMBLOCK(1,0,edi,SIZEOF_JCOEF)], mm6 |
| 213 | movq MMWORD [MMBLOCK(1,1,edi,SIZEOF_JCOEF)], mm3 |
| 214 | |
| 215 | add esi, byte 16*SIZEOF_FAST_FLOAT |
| 216 | add edx, byte 16*SIZEOF_FAST_FLOAT |
| 217 | add edi, byte 16*SIZEOF_JCOEF |
| 218 | dec eax |
| 219 | jnz near .quantloop |
| 220 | |
| 221 | femms ; empty MMX/3DNow! state |
| 222 | |
| 223 | pop edi |
| 224 | pop esi |
| 225 | ; pop edx ; need not be preserved |
| 226 | ; pop ecx ; unused |
| 227 | ; pop ebx ; unused |
| 228 | pop ebp |
| 229 | ret |
| 230 | |