wok annotate linld/stuff/src/MEMCPY32.ASM @ rev 20534

Add util-linux-losetup
author Pascal Bellard <pascal.bellard@slitaz.org>
date Mon Nov 26 09:46:23 2018 +0100 (2018-11-26)
parents f0d71e920c5a
children 04ffefac5707
rev   line source
pascal@19515 1 ;***************************************************************
pascal@19515 2 ;****** This file is distributed under GPL
pascal@19515 3 ;***************************************************************
pascal@19515 4 ideal
pascal@19515 5 %crefref
pascal@19515 6 %noincl
pascal@19515 7 %nomacs
pascal@19636 8 ifdef NO386
pascal@19636 9 p8086
pascal@19636 10 else
pascal@19515 11 p386
pascal@19636 12 endif
pascal@19515 13
pascal@20477 14 group DGROUP _TEXT
pascal@19515 15 assume cs:DGROUP,ds:DGROUP
pascal@19515 16
pascal@19515 17 segment _TEXT byte public use16 'CODE'
pascal@19515 18
pascal@19515 19 ;***************************************************************
pascal@19538 20 ;void memcpy32(u32 dstofs,u16 srcseg,u32 srcofs,u32 size);
pascal@19515 21 ;***************************************************************
pascal@19515 22 ;****** Uses: Flags
pascal@19515 23 ;***************************************************************
pascal@20528 24 global memcpy32:near
pascal@20528 25 proc memcpy32 near
pascal@19515 26
pascal@19515 27 ; rm32,imm16 helper
pascal@19515 28 macro addzx_e rm,i
pascal@19515 29 db 66h
pascal@19515 30 add rm,i
pascal@19515 31 dw 0
pascal@19515 32 endm
pascal@19538 33 arg dstofs :dword, \
pascal@19515 34 srcseg :word, \
pascal@19515 35 srcofs :dword, \
pascal@19515 36 sz :dword = PARAM_SIZE
pascal@19515 37
pascal@19515 38 local GDTR :pword, \
pascal@19515 39 oldGDTR :pword = TEMP_SIZE
pascal@19515 40
pascal@19515 41 ;****** Init ***************************************************
pascal@19634 42
pascal@19903 43 ifndef NO386
pascal@19634 44
pascal@19634 45 enter TEMP_SIZE,0
pascal@19571 46 ;cld
pascal@19515 47 pushf
pascal@19538 48 push ds es
pascal@20534 49 pushad ; struct declared in VCPI.ASM
pascal@19571 50 mov cl,4
pascal@19515 51 movzx esi,[srcseg]
pascal@19571 52 shl esi,cl
pascal@19571 53 add esi,[srcofs]
pascal@19571 54 mov [srcofs],esi ; for memcpy_vcpi
pascal@19538 55 mov edi,[dstofs]
pascal@19538 56
pascal@19515 57 ifndef pm_only
pascal@19538 58 mov eax,esi
pascal@19571 59 shr eax,cl
pascal@19515 60 mov edx,edi
pascal@19571 61 shr edx,cl
pascal@19571 62 mov ecx,esi
pascal@19571 63 or ecx,edi
pascal@19571 64 shr ecx,20 ; >1mb ?
pascal@19571 65 jnz @@pmcopy
pascal@19515 66 @@movlp:
pascal@19515 67 mov ds,ax
pascal@19515 68 mov es,dx
pascal@19515 69 inc ax
pascal@19515 70 inc dx
pascal@19538 71 mov cl,0Fh
pascal@19538 72 and si,cx
pascal@19538 73 and di,cx
pascal@19538 74 inc cx
pascal@19538 75 sub [sz],ecx
pascal@20534 76 jae @@movpara
pascal@20534 77 add ecx,[sz]
pascal@20534 78 @@movpara:
pascal@19538 79 rep movsb
pascal@19515 80 ja @@movlp
pascal@19571 81 jmp @@done
pascal@19515 82 endif
pascal@19571 83 @@pmcopy:
pascal@19538 84 else
pascal@19538 85
pascal@19634 86 push bp
pascal@19634 87 mov bp,sp
pascal@19634 88 sub sp,TEMP_SIZE
pascal@19634 89 ;cld
pascal@19634 90 pushf
pascal@19634 91 push ds es
pascal@19538 92 push si
pascal@19538 93 xor bx,bx
pascal@19538 94 xor si,si
pascal@19903 95 mov ax,[srcseg]
pascal@20527 96 xor dx,dx
pascal@20528 97 extrn N_LXLSH@4:near
pascal@20528 98 call near ptr N_LXLSH@4
pascal@19903 99 add [word srcofs],ax
pascal@19903 100 adc [word srcofs+2],dx
pascal@19538 101 @@2flat:
pascal@19903 102 mov ax,[word si+srcofs] ; srcofs, dstofs lo
pascal@19903 103 mov dx,[word si+srcofs+2] ; srcofs, dstofs hi
pascal@19884 104 extrn N_LXURSH@4:near
pascal@19538 105 call near N_LXURSH@4
pascal@19538 106 or bx,dx ; >=1mb flag
pascal@19538 107 push ax ; srcseg, dstseg
pascal@19538 108 xor si,-6
pascal@19538 109 jnz @@2flat
pascal@19538 110 pop dx ; dstseg
pascal@19538 111 pop ax ; srcseg
pascal@19903 112 dec bx ; <1mb ?
pascal@19903 113 jns @@pmcopy
pascal@19538 114 push di
pascal@19538 115 @@movlp:
pascal@19538 116 mov ds,ax
pascal@19538 117 mov es,dx
pascal@19538 118 inc ax
pascal@19538 119 inc dx
pascal@19538 120 mov cl,0Fh
pascal@19538 121 mov si,cx
pascal@19538 122 mov di,cx
pascal@19538 123 and si,[word srcofs]
pascal@19538 124 and di,[word dstofs]
pascal@19538 125 inc cx
pascal@19538 126 sub [word sz],cx
pascal@20520 127 ;jae @@movpara
pascal@20520 128 sbb [word sz+2],0
pascal@20520 129 jae @@movpara
pascal@20520 130 add cx,[word sz]
pascal@20520 131 ;stc
pascal@20520 132 @@movpara:
pascal@19538 133 rep movsb
pascal@20485 134 jae @@movlp
pascal@20520 135 dec cx ; set S
pascal@19571 136 pop di
pascal@19571 137 @@pmcopy:
pascal@19538 138 pop si
pascal@19571 139 js @@done16
pascal@19636 140 p386
pascal@20534 141 pushad ; struct declared in VCPI.ASM
pascal@19538 142 mov esi,[srcofs]
pascal@19538 143 mov edi,[dstofs]
pascal@19538 144
pascal@19538 145 endif
pascal@19538 146
pascal@19515 147 mov ecx,[sz]
pascal@19571 148 jecxz @@done
pascal@19538 149
pascal@19538 150 smsw ax
pascal@20453 151 and al,1 ;MSW_PE
pascal@19538 152 jz @@real_mode
pascal@19538 153 ; Note: bp points to std stack frame now. bp will be passed to
pascal@19538 154 ; pm routine. This allows params to be passed on stack
pascal@20534 155 extrn vcpi_pm_copy_routine:near
pascal@20534 156 call near vcpi_pm_copy_routine ; Call pm copy routine via vcpi pm
pascal@19571 157 jmp @@done
pascal@19538 158 @@real_mode:
pascal@19515 159 cmp esi,edi
pascal@19515 160 jae @@do_copy
pascal@19515 161 add esi,ecx ;src<dst: we must do
pascal@19515 162 dec esi ; copy backwards to avoid
pascal@19515 163 add edi,ecx ; overwrite bug
pascal@19515 164 dec edi ;
pascal@19515 165 std ;
pascal@19515 166 @@do_copy:
pascal@19515 167 cli
pascal@19515 168 sgdt [oldGDTR]
pascal@19515 169
pascal@19515 170 ;****** Load gdtr **********************************************
pascal@19515 171 mov eax,cs
pascal@19515 172 shl eax,4
pascal@19515 173 addzx_e ax,<offset GDT>
pascal@19634 174 or [word GDTR],-1 ;GDT limit = 0FFFFh
pascal@19515 175 mov [dword GDTR+2],eax ;GDT base
pascal@19515 176 lgdt [GDTR]
pascal@19515 177
pascal@19515 178 ;****** Go into pm *********************************************
pascal@19515 179 mov eax,cr0
pascal@19571 180 inc ax ;CR0_PE on
pascal@19515 181 mov cr0,eax
pascal@19515 182 jmp short $+2 ;*Required*!
pascal@19515 183 ;3+ NOPs also work fine (chkd on 386)
pascal@19515 184 ;****** Move data **********************************************
pascal@19515 185 push 0008h
pascal@19515 186 pop ds ;base=0, lim = 4gb
pascal@19515 187 push ds ;
pascal@19515 188 pop es ;
pascal@19634 189 ;db 66h ;operand width override for ecx
pascal@19515 190 db 67h ;address width override for esi/edi
pascal@19515 191 rep movsb
pascal@19883 192 ;cld
pascal@19515 193
pascal@19515 194 ;****** Return to rm *******************************************
pascal@19515 195 dec ax ;CR0_PE off
pascal@19515 196 mov cr0,eax ;ds/es limits are *not* reset to 64kb
pascal@19515 197 ; but who cares :-)
pascal@19515 198 jmp short $+2
pascal@19515 199
pascal@19515 200 ;****** Return *************************************************
pascal@19515 201 lgdt [oldGDTR]
pascal@19571 202 @@done:
pascal@19538 203 popad
pascal@19636 204 p8086
pascal@19571 205 @@done16:
pascal@19538 206 pop es ds
pascal@20534 207 popf ; restore I & D
pascal@19634 208 ifndef NO386
pascal@19636 209 p386
pascal@19634 210 leave
pascal@19634 211 else
pascal@19538 212 mov sp,bp
pascal@19538 213 pop bp
pascal@19634 214 endif
pascal@20528 215 ret 14
pascal@19515 216
pascal@19515 217 ;****** Const data *********************************************
pascal@19515 218 org $-8 ;save 8 bytes - they are unused anyway
pascal@19515 219 ;0000: unused
pascal@19515 220 GDT dd ?,?
pascal@19515 221 ;0008: Data seg [0,FFFFFFFF]
pascal@19515 222 ; lim_lo base_lo
pascal@19515 223 dw 1111111111111111b, 0000000000000000b
pascal@19515 224 db 00000000b,10010010b,10001111b,00000000b
pascal@19515 225 ; base_med P S D A G ??l_hi base_hi
pascal@19515 226 ; Pl E W D
pascal@19515 227
pascal@20528 228 endp memcpy32
pascal@19515 229
pascal@19515 230 ends _TEXT
pascal@19515 231
pascal@19515 232 end
pascal@19515 233
pascal@19515 234 ;###### END OF FILE ############################################