[6216] | 1 | ; $Id: d32hlp.asm,v 1.6 2001-07-08 02:53:52 bird Exp $
|
---|
[847] | 2 | ;
|
---|
| 3 | ; d32hlp - 32-bit Device Driver Helper Function.
|
---|
| 4 | ;
|
---|
| 5 | ; Copyright (c) 1999 knut st. osmundsen
|
---|
| 6 | ;
|
---|
[1467] | 7 | ; Project Odin Software License can be found in LICENSE.TXT
|
---|
| 8 | ;
|
---|
[847] | 9 | .386p
|
---|
| 10 |
|
---|
| 11 |
|
---|
| 12 | ;
|
---|
| 13 | ; Include files
|
---|
| 14 | ;
|
---|
| 15 | include devsegdf.inc
|
---|
| 16 | include devhlp.inc
|
---|
| 17 |
|
---|
[5204] | 18 |
|
---|
[847] | 19 | ;
|
---|
| 20 | ; Exported symbols
|
---|
| 21 | ;
|
---|
| 22 | public D32Hlp_VirtToLin
|
---|
| 23 | public D32Hlp_VirtToLin2
|
---|
| 24 | public D32Hlp_VirtToLin3
|
---|
| 25 | public D32Hlp_GetDOSVar
|
---|
| 26 | public D32Hlp_Yield
|
---|
| 27 | public D32Hlp_VMAlloc
|
---|
| 28 | public D32Hlp_VMFree
|
---|
| 29 | public D32Hlp_VMSetMem
|
---|
| 30 | public D32Hlp_VMLock
|
---|
| 31 | public D32Hlp_VMLock2
|
---|
| 32 | public D32Hlp_VMUnLock
|
---|
| 33 |
|
---|
[5204] | 34 |
|
---|
[847] | 35 | ;
|
---|
| 36 | ; extrns
|
---|
| 37 | ;
|
---|
[4164] | 38 | extrn _Device_Help:dword
|
---|
[847] | 39 |
|
---|
[5204] | 40 |
|
---|
[4164] | 41 | CODE32 segment
|
---|
[847] | 42 | assume cs:CODE32, ds:flat, ss:nothing, es:nothing
|
---|
[1535] | 43 | .386p
|
---|
[847] | 44 |
|
---|
| 45 | ;PVOID D32HLPCALL D32Hlp_VirtToLin(ULONG ulPtr16); /* eax */
|
---|
[4164] | 46 | ; Sideeffect: edx holds the error code on error.
|
---|
[847] | 47 | D32Hlp_VirtToLin proc near
|
---|
| 48 | push esi
|
---|
| 49 |
|
---|
| 50 | movzx esi, ax
|
---|
| 51 | shr eax, 16
|
---|
| 52 | mov dl, DevHlp_VirtToLin
|
---|
| 53 | jmp far ptr CODE16:Thunk16_VirtToLin
|
---|
| 54 | Thunk32_VirtToLin::
|
---|
| 55 | jnc Finished
|
---|
[4164] | 56 | mov edx, eax
|
---|
[847] | 57 | xor eax, eax
|
---|
| 58 |
|
---|
| 59 | Finished:
|
---|
| 60 | pop esi
|
---|
| 61 | ret
|
---|
| 62 | D32Hlp_VirtToLin endp
|
---|
| 63 |
|
---|
| 64 |
|
---|
| 65 | ;PVOID D32HLPCALL D32Hlp_VirtToLin2(USHORT usSelector, /* ax */
|
---|
| 66 | ; ULONG ulOffset); /* edx */
|
---|
[4164] | 67 | ; Sideeffect: edx holds the error code on error.
|
---|
[847] | 68 | D32Hlp_VirtToLin2 proc near
|
---|
| 69 | push esi
|
---|
| 70 |
|
---|
| 71 | mov esi, edx
|
---|
| 72 | mov dl, DevHlp_VirtToLin
|
---|
| 73 | jmp far ptr CODE16:Thunk16_VirtToLin2
|
---|
| 74 | Thunk32_VirtToLin2::
|
---|
| 75 | jnc Finished
|
---|
[4164] | 76 | mov edx, eax
|
---|
[847] | 77 | xor eax, eax
|
---|
| 78 |
|
---|
| 79 | Finished:
|
---|
| 80 | pop esi
|
---|
| 81 | ret
|
---|
| 82 | D32Hlp_VirtToLin2 endp
|
---|
| 83 |
|
---|
| 84 |
|
---|
| 85 | ;D32RET D32HLPCALL D32Hlp_VirtToLin3(USHORT usSelector, /* ax */
|
---|
| 86 | ; ULONG ulOffset, /* edx */
|
---|
| 87 | ; PPVOID ppvLinAddress); /* ecx */
|
---|
| 88 | D32Hlp_VirtToLin3 proc near
|
---|
| 89 | push esi
|
---|
| 90 |
|
---|
| 91 | mov esi, edx
|
---|
| 92 | mov dl, DevHlp_VirtToLin
|
---|
| 93 | jmp far ptr CODE16:Thunk16_VirtToLin3
|
---|
| 94 | Thunk32_VirtToLin3::
|
---|
| 95 | jc Finished
|
---|
| 96 | mov [ecx], eax
|
---|
| 97 | xor eax, eax
|
---|
| 98 |
|
---|
| 99 | Finished:
|
---|
| 100 | pop esi
|
---|
| 101 | ret
|
---|
| 102 | D32Hlp_VirtToLin3 endp
|
---|
| 103 |
|
---|
| 104 |
|
---|
[6216] | 105 | ;
|
---|
| 106 | ; Jump table used by D32Hlp_GetDOSVar
|
---|
| 107 | ;
|
---|
| 108 | DosVarThunkTab LABEL DWORD
|
---|
| 109 | dd 0 ; 0 - Reserved
|
---|
| 110 | dd FLAT:Load1600Thunk ; 1 - GIS
|
---|
| 111 | dd FLAT:Load1616Thunk ; 2 - LIS
|
---|
| 112 | dd 0 ; 3 - Reserved
|
---|
| 113 | dd FLAT:Load1616 ; 4 - VectorSDF
|
---|
| 114 | dd FLAT:Load1616 ; 5 - VectorReboot
|
---|
| 115 | dd FLAT:Load1616 ; 6 - VectorMSATS
|
---|
| 116 | dd FLAT:ThunkPtr ; 7 - YieldFlag (Resched)
|
---|
| 117 | dd FLAT:ThunkPtr ; 8 - TCYieldFlag (TCResched)
|
---|
| 118 | dd FLAT:ThunkPtr ; 9 - DOSTable (yeah, reserved)
|
---|
| 119 | dd FLAT:Load1616 ; a - VectorDEKKO (yeah, reserved)
|
---|
| 120 | dd FLAT:ThunkPtr ; b - CodePgBuff
|
---|
| 121 | dd FLAT:Load1616 ; c - VectorRIPL
|
---|
| 122 | dd FLAT:ThunkPtr ; d - InterruptLevel
|
---|
| 123 | dd FLAT:ThunkPtr ; e - DevClassTables
|
---|
| 124 | dd FLAT:ThunkPtr ; f - DMQS_Sel
|
---|
| 125 | dd FLAT:ThunkPtr ;10 - APMInfo
|
---|
| 126 | dd FLAT:LoadWord ;11 - APM_Length (length of above structure)
|
---|
| 127 | DosVarThunkTabSize equ ($ - DosVarThunkTab) / 4
|
---|
| 128 |
|
---|
| 129 |
|
---|
[847] | 130 | ;PVOID D32HLPCALL D32Hlp_GetDOSVar(ULONG ulVarNumber, /* eax */
|
---|
| 131 | ; ULONG ulVarMember); /* edx */
|
---|
[6216] | 132 | ;
|
---|
| 133 | ; Note that we do post processing of the value....!
|
---|
| 134 | ;
|
---|
[847] | 135 | D32Hlp_GetDOSVar proc near
|
---|
[6216] | 136 | ASSUME DS:FLAT, ES:NOTHING
|
---|
| 137 | push ebx
|
---|
| 138 | push es
|
---|
| 139 | push ds
|
---|
| 140 | push ds
|
---|
| 141 | pop es ; paranoia
|
---|
| 142 | ASSUME es:FLAT
|
---|
| 143 | push eax
|
---|
[1535] | 144 | mov ecx, edx
|
---|
[847] | 145 | mov dl, DevHlp_GetDOSVar
|
---|
| 146 | jmp far ptr CODE16:Thunk16_GetDOSVar
|
---|
| 147 | Thunk32_GetDOSVar::
|
---|
| 148 | jc Error
|
---|
[6216] | 149 | mov ds, ax
|
---|
| 150 | pop eax ; Index...
|
---|
| 151 | cmp eax, DosVarThunkTabSize
|
---|
| 152 | jg Error
|
---|
| 153 | and ebx, 0000ffffh ; (ds:ebx is ptr to be processed)
|
---|
| 154 | jmp es:DosVarThunkTab[eax*4]
|
---|
| 155 |
|
---|
| 156 | ; Load Word at ds:bx
|
---|
| 157 | LoadWord::
|
---|
| 158 | xor eax, eax
|
---|
| 159 | mov ax, word ptr [bx]
|
---|
| 160 | jmp Finished
|
---|
| 161 |
|
---|
| 162 | ; Load selector at ds:bx and thunk it.
|
---|
| 163 | Load1600Thunk::
|
---|
| 164 | xor eax, eax
|
---|
| 165 | mov ax, word ptr [bx]
|
---|
| 166 | rol ax, 16
|
---|
| 167 | jmp ThunkIt
|
---|
| 168 |
|
---|
| 169 | ; Load 16:16 ptr at ds:bx and thunk it.
|
---|
| 170 | Load1616Thunk::
|
---|
| 171 | mov eax, dword ptr [ebx]
|
---|
| 172 | jmp ThunkIt
|
---|
| 173 |
|
---|
| 174 | ; Load 16:16 ptr at ds:bx and return it.
|
---|
| 175 | Load1616::
|
---|
| 176 | mov eax, dword ptr [ebx]
|
---|
| 177 | jmp Finished
|
---|
| 178 |
|
---|
| 179 | ; Thunk the ds:bx ptr.
|
---|
| 180 | ThunkPtr::
|
---|
| 181 | mov ax, ds
|
---|
[4164] | 182 | shl eax, 16
|
---|
[6216] | 183 | mov ax, bx
|
---|
| 184 |
|
---|
| 185 | ; Thunks 16:16 ptr in eax
|
---|
| 186 | ThunkIt::
|
---|
| 187 | pop ds
|
---|
[847] | 188 | call D32Hlp_VirtToLin
|
---|
[6216] | 189 | jmp Finished2
|
---|
[847] | 190 |
|
---|
| 191 | Error:
|
---|
[6216] | 192 | add esp, 4
|
---|
[1535] | 193 | xor eax, eax
|
---|
[847] | 194 |
|
---|
| 195 | Finished:
|
---|
[6216] | 196 | pop ds
|
---|
| 197 | Finished2:
|
---|
| 198 | pop es
|
---|
| 199 | pop ebx
|
---|
[847] | 200 | ret
|
---|
| 201 | D32Hlp_GetDOSVar endp
|
---|
| 202 |
|
---|
| 203 |
|
---|
[6216] | 204 |
|
---|
[847] | 205 | ;VOID D32HLPCALL D32Hlp_Yield(VOID);
|
---|
| 206 | D32Hlp_Yield proc near
|
---|
| 207 | mov dl, DevHlp_Yield
|
---|
| 208 | jmp far ptr CODE16:Thunk16_Yield
|
---|
| 209 | Thunk32_Yield::
|
---|
| 210 | ret
|
---|
| 211 | D32Hlp_Yield endp
|
---|
| 212 |
|
---|
| 213 |
|
---|
[5204] | 214 |
|
---|
[847] | 215 | ;PVOID D32HLPCALL D32Hlp_VMAlloc(ULONG flFlags, /* eax */
|
---|
| 216 | ; ULONG cbSize, /* edx */
|
---|
| 217 | ; ULONG ulPhysAddr);/* ecx */
|
---|
| 218 | D32Hlp_VMAlloc proc near
|
---|
| 219 | push edi
|
---|
| 220 |
|
---|
| 221 | mov edi, ecx
|
---|
| 222 | mov ecx, edx
|
---|
| 223 |
|
---|
| 224 | mov dl, DevHlp_VMAlloc
|
---|
| 225 | jmp far ptr CODE16:Thunk16_VMAlloc
|
---|
| 226 | Thunk32_VMAlloc::
|
---|
| 227 | jnc Finished
|
---|
| 228 | xor eax, eax
|
---|
| 229 |
|
---|
| 230 | Finished:
|
---|
| 231 | pop edi
|
---|
| 232 | ret
|
---|
| 233 | D32Hlp_VMAlloc endp
|
---|
| 234 |
|
---|
| 235 |
|
---|
| 236 | ;D32RET D32HLPCALL D32Hlp_VMFree(PVOID pvAddress); /* eax */
|
---|
| 237 | D32Hlp_VMFree proc near
|
---|
| 238 | mov dl, DevHlp_VMFree
|
---|
| 239 | jmp far ptr CODE16:Thunk16_VMFree
|
---|
| 240 | Thunk32_VMFree::
|
---|
| 241 | jc Finished
|
---|
| 242 | xor eax, eax
|
---|
| 243 | Finished:
|
---|
| 244 | ret
|
---|
| 245 | D32Hlp_VMFree endp
|
---|
| 246 |
|
---|
| 247 |
|
---|
| 248 | ;D32RET D32HLPCALL D32Hlp_VMSetMem(PVOID pvAddress, /* eax */
|
---|
| 249 | ; ULONG cbSize, /* edx */
|
---|
| 250 | ; ULONG flFlags); /* ecx */
|
---|
| 251 | D32Hlp_VMSetMem proc near
|
---|
| 252 | push ebx
|
---|
| 253 |
|
---|
| 254 | mov ebx, eax
|
---|
| 255 | mov eax, ecx
|
---|
| 256 | mov ecx, edx
|
---|
| 257 |
|
---|
| 258 | mov dl, DevHlp_VMSetMem
|
---|
| 259 | jmp far ptr CODE16:Thunk16_VMSetMem
|
---|
| 260 | Thunk32_VMSetMem::
|
---|
| 261 |
|
---|
| 262 | pop ebx
|
---|
| 263 | ret
|
---|
| 264 | D32Hlp_VMSetMem endp
|
---|
| 265 |
|
---|
| 266 |
|
---|
| 267 | ;D32RET D32HLPCALL D32Hlp_VMLock(PVOID pvAddress, /* eax (ebp + 08h) */
|
---|
| 268 | ; ULONG ulLength, /* edx (ebp + 0Ch)*/
|
---|
| 269 | ; ULONG flFlags, /* ecx (ebp + 10h)*/
|
---|
| 270 | ; PVOID pvPagelist, /* ebp + 14h */
|
---|
| 271 | ; PLOCKHANDLE pLockHandle, /* ebp + 18h */
|
---|
| 272 | ; PULONG pulPageListCount); /* ebp + 1Ch */
|
---|
| 273 | D32Hlp_VMLock proc near
|
---|
| 274 | push ebp
|
---|
| 275 | mov ebp, esp
|
---|
| 276 | push esi
|
---|
| 277 | push edi
|
---|
| 278 | push ebx
|
---|
| 279 |
|
---|
| 280 | mov edi, [ebp + 14h]
|
---|
| 281 | mov esi, [ebp + 18h]
|
---|
| 282 | mov ebx, eax
|
---|
| 283 | mov eax, ecx
|
---|
| 284 | mov ecx, edx
|
---|
| 285 |
|
---|
| 286 | mov dl, DevHlp_VMLock
|
---|
| 287 | jmp far ptr CODE16:Thunk16_VMLock
|
---|
| 288 | Thunk32_VMLock::
|
---|
| 289 | jc Finished
|
---|
| 290 | mov ebx, [ebp + 1Ch]
|
---|
| 291 | or ebx, ebx
|
---|
| 292 | jz Success
|
---|
| 293 | mov [ebx], eax
|
---|
| 294 |
|
---|
| 295 | Success:
|
---|
| 296 | xor eax, eax
|
---|
| 297 |
|
---|
| 298 | Finished:
|
---|
| 299 | pop ebx
|
---|
| 300 | pop edi
|
---|
| 301 | pop esi
|
---|
| 302 | pop ebp
|
---|
| 303 | ret
|
---|
| 304 | D32Hlp_VMLock endp
|
---|
| 305 |
|
---|
| 306 |
|
---|
| 307 | ;D32RET D32HLPCALL D32Hlp_VMLock2(PVOID pvAddress, /* eax (ebp + 08h) */
|
---|
| 308 | ; ULONG ulLength, /* edx (ebp + 0Ch)*/
|
---|
| 309 | ; ULONG flFlags, /* ecx (ebp + 10h)*/
|
---|
| 310 | ; PLOCKHANDLE pLockHandle); /* ebp + 14h */
|
---|
| 311 | D32Hlp_VMLock2 proc near
|
---|
| 312 | push ebp
|
---|
| 313 | mov ebp, esp
|
---|
| 314 | push esi
|
---|
| 315 | push edi
|
---|
| 316 | push ebx
|
---|
| 317 |
|
---|
| 318 | mov edi, 0ffffffffh
|
---|
| 319 | mov esi, [ebp + 14h]
|
---|
| 320 | mov ebx, eax
|
---|
| 321 | mov eax, ecx
|
---|
| 322 | mov ecx, edx
|
---|
| 323 |
|
---|
| 324 | mov dl, DevHlp_VMLock
|
---|
| 325 | jmp far ptr CODE16:Thunk16_VMLock2
|
---|
| 326 | Thunk32_VMLock2::
|
---|
| 327 | jc Finished
|
---|
| 328 | xor eax, eax
|
---|
| 329 |
|
---|
| 330 | Finished:
|
---|
| 331 | pop ebx
|
---|
| 332 | pop edi
|
---|
| 333 | pop esi
|
---|
| 334 | pop ebp
|
---|
| 335 | ret
|
---|
| 336 | D32Hlp_VMLock2 endp
|
---|
| 337 |
|
---|
| 338 |
|
---|
| 339 | ;D32RET D32HLPCALL D32Hlp_VMUnLock(PLOCKHANDLE pLockHandle); /* eax */
|
---|
| 340 | D32Hlp_VMUnLock proc near
|
---|
| 341 | push esi
|
---|
| 342 |
|
---|
| 343 | mov esi, eax
|
---|
| 344 | mov dl, DevHlp_VMUnlock
|
---|
| 345 | jmp far ptr CODE16:Thunk16_VMUnLock
|
---|
| 346 | Thunk32_VMUnLock::
|
---|
| 347 | jc Finished
|
---|
| 348 | xor eax, eax
|
---|
| 349 |
|
---|
| 350 | Finished:
|
---|
| 351 | pop esi
|
---|
| 352 | ret
|
---|
| 353 | D32Hlp_VMUnLock endp
|
---|
| 354 |
|
---|
| 355 | CODE32 ends
|
---|
| 356 |
|
---|
| 357 |
|
---|
| 358 |
|
---|
| 359 |
|
---|
| 360 |
|
---|
| 361 | ;CODE16 segment
|
---|
[4164] | 362 | CODE16 segment
|
---|
[847] | 363 | assume cs:CODE16, ds:FLAT
|
---|
| 364 |
|
---|
| 365 | Thunk16_VirtToLin:
|
---|
| 366 | call [_Device_Help]
|
---|
| 367 | jmp far ptr FLAT:Thunk32_VirtToLin
|
---|
| 368 |
|
---|
| 369 | Thunk16_VirtToLin2:
|
---|
| 370 | call [_Device_Help]
|
---|
| 371 | jmp far ptr FLAT:Thunk32_VirtToLin2
|
---|
| 372 |
|
---|
| 373 | Thunk16_VirtToLin3:
|
---|
| 374 | call [_Device_Help]
|
---|
| 375 | jmp far ptr FLAT:Thunk32_VirtToLin3
|
---|
| 376 |
|
---|
| 377 | Thunk16_GetDOSVar:
|
---|
| 378 | call [_Device_Help]
|
---|
| 379 | jmp far ptr FLAT:Thunk32_GetDOSVar
|
---|
| 380 |
|
---|
| 381 | Thunk16_Yield:
|
---|
| 382 | call [_Device_Help]
|
---|
| 383 | jmp far ptr FLAT:Thunk32_Yield
|
---|
| 384 |
|
---|
| 385 | Thunk16_VMAlloc:
|
---|
| 386 | call [_Device_Help]
|
---|
| 387 | jmp far ptr FLAT:Thunk32_VMAlloc
|
---|
| 388 |
|
---|
| 389 | Thunk16_VMFree:
|
---|
| 390 | call [_Device_Help]
|
---|
| 391 | jmp far ptr FLAT:Thunk32_VMFree
|
---|
| 392 |
|
---|
| 393 | Thunk16_VMLock:
|
---|
| 394 | call [_Device_Help]
|
---|
| 395 | jmp far ptr FLAT:Thunk32_VMLock
|
---|
| 396 |
|
---|
| 397 | Thunk16_VMLock2:
|
---|
| 398 | call [_Device_Help]
|
---|
| 399 | jmp far ptr FLAT:Thunk32_VMLock2
|
---|
| 400 |
|
---|
| 401 | Thunk16_VMUnLock:
|
---|
| 402 | call [_Device_Help]
|
---|
| 403 | jmp far ptr FLAT:Thunk32_VMUnLock
|
---|
| 404 |
|
---|
| 405 | Thunk16_VMSetMem:
|
---|
| 406 | call [_Device_Help]
|
---|
| 407 | jmp far ptr FLAT:Thunk32_VMSetMem
|
---|
| 408 |
|
---|
| 409 | CODE16 ends
|
---|
[5204] | 410 |
|
---|
[847] | 411 | end
|
---|