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

Fix loram dos boot
author Pascal Bellard <pascal.bellard@slitaz.org>
date Thu Aug 01 15:16:29 2019 +0200 (2019-08-01)
parents af959ebf1305
children 6e3d30b3031f
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@20528 96 extrn N_LXLSH@4:near
pascal@20528 97 call near ptr N_LXLSH@4
pascal@19903 98 add [word srcofs],ax
pascal@19903 99 adc [word srcofs+2],dx
pascal@19538 100 @@2flat:
pascal@21791 101 les ax,[dword si+srcofs] ; srcofs, dstofs
pascal@21791 102 mov dx,es
pascal@21791 103 mov cl,4
pascal@21791 104 @@loop:
pascal@21791 105 shr dx,1
pascal@21791 106 rcr ax,1
pascal@21791 107 loop @@loop
pascal@19538 108 or bx,dx ; >=1mb flag
pascal@19538 109 push ax ; srcseg, dstseg
pascal@19538 110 xor si,-6
pascal@19538 111 jnz @@2flat
pascal@19538 112 pop dx ; dstseg
pascal@19538 113 pop ax ; srcseg
pascal@19903 114 dec bx ; <1mb ?
pascal@19903 115 jns @@pmcopy
pascal@19538 116 push di
pascal@19538 117 @@movlp:
pascal@19538 118 mov ds,ax
pascal@19538 119 mov es,dx
pascal@19538 120 inc ax
pascal@19538 121 inc dx
pascal@19538 122 mov cl,0Fh
pascal@19538 123 mov si,cx
pascal@19538 124 mov di,cx
pascal@19538 125 and si,[word srcofs]
pascal@19538 126 and di,[word dstofs]
pascal@19538 127 inc cx
pascal@19538 128 sub [word sz],cx
pascal@20520 129 ;jae @@movpara
pascal@20520 130 sbb [word sz+2],0
pascal@20520 131 jae @@movpara
pascal@20520 132 add cx,[word sz]
pascal@20520 133 ;stc
pascal@20520 134 @@movpara:
pascal@19538 135 rep movsb
pascal@20485 136 jae @@movlp
pascal@20520 137 dec cx ; set S
pascal@19571 138 pop di
pascal@19571 139 @@pmcopy:
pascal@19538 140 pop si
pascal@19571 141 js @@done16
pascal@19636 142 p386
pascal@20534 143 pushad ; struct declared in VCPI.ASM
pascal@19538 144 mov esi,[srcofs]
pascal@19538 145 mov edi,[dstofs]
pascal@19538 146
pascal@19538 147 endif
pascal@19538 148
pascal@19515 149 mov ecx,[sz]
pascal@19571 150 jecxz @@done
pascal@19538 151
pascal@19538 152 smsw ax
pascal@20453 153 and al,1 ;MSW_PE
pascal@19538 154 jz @@real_mode
pascal@19538 155 ; Note: bp points to std stack frame now. bp will be passed to
pascal@19538 156 ; pm routine. This allows params to be passed on stack
pascal@20534 157 extrn vcpi_pm_copy_routine:near
pascal@20534 158 call near vcpi_pm_copy_routine ; Call pm copy routine via vcpi pm
pascal@19571 159 jmp @@done
pascal@19538 160 @@real_mode:
pascal@19515 161 cmp esi,edi
pascal@19515 162 jae @@do_copy
pascal@19515 163 add esi,ecx ;src<dst: we must do
pascal@19515 164 dec esi ; copy backwards to avoid
pascal@19515 165 add edi,ecx ; overwrite bug
pascal@19515 166 dec edi ;
pascal@19515 167 std ;
pascal@19515 168 @@do_copy:
pascal@19515 169 cli
pascal@19515 170 sgdt [oldGDTR]
pascal@19515 171
pascal@19515 172 ;****** Load gdtr **********************************************
pascal@19515 173 mov eax,cs
pascal@19515 174 shl eax,4
pascal@19515 175 addzx_e ax,<offset GDT>
pascal@19634 176 or [word GDTR],-1 ;GDT limit = 0FFFFh
pascal@19515 177 mov [dword GDTR+2],eax ;GDT base
pascal@19515 178 lgdt [GDTR]
pascal@19515 179
pascal@19515 180 ;****** Go into pm *********************************************
pascal@19515 181 mov eax,cr0
pascal@19571 182 inc ax ;CR0_PE on
pascal@19515 183 mov cr0,eax
pascal@19515 184 jmp short $+2 ;*Required*!
pascal@19515 185 ;3+ NOPs also work fine (chkd on 386)
pascal@19515 186 ;****** Move data **********************************************
pascal@19515 187 push 0008h
pascal@19515 188 pop ds ;base=0, lim = 4gb
pascal@19515 189 push ds ;
pascal@19515 190 pop es ;
pascal@19634 191 ;db 66h ;operand width override for ecx
pascal@19515 192 db 67h ;address width override for esi/edi
pascal@19515 193 rep movsb
pascal@19883 194 ;cld
pascal@19515 195
pascal@19515 196 ;****** Return to rm *******************************************
pascal@19515 197 dec ax ;CR0_PE off
pascal@19515 198 mov cr0,eax ;ds/es limits are *not* reset to 64kb
pascal@19515 199 ; but who cares :-)
pascal@19515 200 jmp short $+2
pascal@19515 201
pascal@19515 202 ;****** Return *************************************************
pascal@19515 203 lgdt [oldGDTR]
pascal@19571 204 @@done:
pascal@19538 205 popad
pascal@19636 206 p8086
pascal@19571 207 @@done16:
pascal@19538 208 pop es ds
pascal@20534 209 popf ; restore I & D
pascal@19634 210 ifndef NO386
pascal@19636 211 p386
pascal@19634 212 leave
pascal@19634 213 else
pascal@19538 214 mov sp,bp
pascal@19538 215 pop bp
pascal@19634 216 endif
pascal@20528 217 ret 14
pascal@19515 218
pascal@19515 219 ;****** Const data *********************************************
pascal@19515 220 org $-8 ;save 8 bytes - they are unused anyway
pascal@19515 221 ;0000: unused
pascal@19515 222 GDT dd ?,?
pascal@19515 223 ;0008: Data seg [0,FFFFFFFF]
pascal@19515 224 ; lim_lo base_lo
pascal@19515 225 dw 1111111111111111b, 0000000000000000b
pascal@19515 226 db 00000000b,10010010b,10001111b,00000000b
pascal@19515 227 ; base_med P S D A G ??l_hi base_hi
pascal@19515 228 ; Pl E W D
pascal@19515 229
pascal@20528 230 endp memcpy32
pascal@19515 231
pascal@19515 232 ends _TEXT
pascal@19515 233
pascal@19515 234 end
pascal@19515 235
pascal@19515 236 ;###### END OF FILE ############################################