| 1 | ; $Id: d32hlp.asm,v 1.6 2001-07-08 02:53:52 bird Exp $ | 
|---|
| 2 | ; | 
|---|
| 3 | ; d32hlp - 32-bit Device Driver Helper Function. | 
|---|
| 4 | ; | 
|---|
| 5 | ; Copyright (c) 1999 knut st. osmundsen | 
|---|
| 6 | ; | 
|---|
| 7 | ; Project Odin Software License can be found in LICENSE.TXT | 
|---|
| 8 | ; | 
|---|
| 9 | .386p | 
|---|
| 10 |  | 
|---|
| 11 |  | 
|---|
| 12 | ; | 
|---|
| 13 | ; Include files | 
|---|
| 14 | ; | 
|---|
| 15 | include devsegdf.inc | 
|---|
| 16 | include devhlp.inc | 
|---|
| 17 |  | 
|---|
| 18 |  | 
|---|
| 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 |  | 
|---|
| 34 |  | 
|---|
| 35 | ; | 
|---|
| 36 | ; extrns | 
|---|
| 37 | ; | 
|---|
| 38 | extrn _Device_Help:dword | 
|---|
| 39 |  | 
|---|
| 40 |  | 
|---|
| 41 | CODE32 segment | 
|---|
| 42 | assume cs:CODE32, ds:flat, ss:nothing, es:nothing | 
|---|
| 43 | .386p | 
|---|
| 44 |  | 
|---|
| 45 | ;PVOID  D32HLPCALL D32Hlp_VirtToLin(ULONG  ulPtr16); /* eax */ | 
|---|
| 46 | ; Sideeffect: edx holds the error code on error. | 
|---|
| 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 | 
|---|
| 56 | mov     edx, eax | 
|---|
| 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 */ | 
|---|
| 67 | ; Sideeffect: edx holds the error code on error. | 
|---|
| 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 | 
|---|
| 76 | mov     edx, eax | 
|---|
| 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 |  | 
|---|
| 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 |  | 
|---|
| 130 | ;PVOID  D32HLPCALL D32Hlp_GetDOSVar(ULONG ulVarNumber,  /* eax */ | 
|---|
| 131 | ;                                   ULONG ulVarMember); /* edx */ | 
|---|
| 132 | ; | 
|---|
| 133 | ; Note that we do post processing of the value....! | 
|---|
| 134 | ; | 
|---|
| 135 | D32Hlp_GetDOSVar proc near | 
|---|
| 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 | 
|---|
| 144 | mov     ecx, edx | 
|---|
| 145 | mov     dl, DevHlp_GetDOSVar | 
|---|
| 146 | jmp     far ptr CODE16:Thunk16_GetDOSVar | 
|---|
| 147 | Thunk32_GetDOSVar:: | 
|---|
| 148 | jc  Error | 
|---|
| 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 | 
|---|
| 182 | shl     eax, 16 | 
|---|
| 183 | mov     ax, bx | 
|---|
| 184 |  | 
|---|
| 185 | ; Thunks 16:16 ptr in eax | 
|---|
| 186 | ThunkIt:: | 
|---|
| 187 | pop     ds | 
|---|
| 188 | call    D32Hlp_VirtToLin | 
|---|
| 189 | jmp Finished2 | 
|---|
| 190 |  | 
|---|
| 191 | Error: | 
|---|
| 192 | add     esp, 4 | 
|---|
| 193 | xor     eax, eax | 
|---|
| 194 |  | 
|---|
| 195 | Finished: | 
|---|
| 196 | pop     ds | 
|---|
| 197 | Finished2: | 
|---|
| 198 | pop     es | 
|---|
| 199 | pop     ebx | 
|---|
| 200 | ret | 
|---|
| 201 | D32Hlp_GetDOSVar endp | 
|---|
| 202 |  | 
|---|
| 203 |  | 
|---|
| 204 |  | 
|---|
| 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 |  | 
|---|
| 214 |  | 
|---|
| 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 | 
|---|
| 362 | CODE16 segment | 
|---|
| 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 | 
|---|
| 410 |  | 
|---|
| 411 | end | 
|---|