mirror of
https://github.com/reactos/reactos.git
synced 2024-06-25 15:31:47 +00:00
185 lines
3.2 KiB
ArmAsm
185 lines
3.2 KiB
ArmAsm
/*
|
|
* FreeLoader
|
|
* Copyright (C) 2003 Eric Kohl
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along
|
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
|
*/
|
|
|
|
#include <asm.inc>
|
|
#include <arch/pc/x86common.h>
|
|
|
|
EXTERN i386CallRealMode:PROC
|
|
|
|
.code32
|
|
|
|
/*
|
|
* U32 PnpBiosSupported(VOID);
|
|
*
|
|
* RETURNS:
|
|
*/
|
|
PUBLIC _PnpBiosSupported
|
|
_PnpBiosSupported:
|
|
|
|
push edi
|
|
push esi
|
|
push ecx
|
|
push edx
|
|
|
|
xor edi, edi
|
|
|
|
/* init esi */
|
|
mov esi, HEX(0F0000)
|
|
|
|
pnp_again:
|
|
mov eax, [esi]
|
|
cmp eax, HEX(506E5024) /* "$PnP" */
|
|
je pnp_found
|
|
|
|
cmp esi, HEX(0FFFF0)
|
|
je pnp_not_found
|
|
|
|
pnp_add:
|
|
add esi, 16
|
|
jmp pnp_again
|
|
|
|
pnp_found:
|
|
/* first calculate the checksum */
|
|
push esi
|
|
|
|
push HEX(21)
|
|
pop ecx
|
|
xor edx, edx
|
|
|
|
pnp_loop:
|
|
lodsb
|
|
add dl, al
|
|
loop pnp_loop
|
|
|
|
test dl, dl
|
|
pop esi
|
|
jnz pnp_add
|
|
|
|
mov edi, esi
|
|
|
|
/* Calculate the bios entry point (far pointer) */
|
|
xor eax, eax
|
|
mov ax, [esi + HEX(0F)]
|
|
shl eax, 16
|
|
mov ax, [esi + HEX(0D)]
|
|
mov dword ptr ds:[BSS_PnpBiosEntryPoint], eax
|
|
|
|
/* Store bios data segment */
|
|
mov ax, [esi + HEX(1B)]
|
|
mov word ptr ds:[BSS_PnpBiosDataSegment], ax
|
|
|
|
pnp_not_found:
|
|
mov eax, edi
|
|
|
|
pop edx
|
|
pop ecx
|
|
pop esi
|
|
pop edi
|
|
|
|
ret
|
|
|
|
|
|
/*
|
|
* U32 PnpBiosGetDeviceNodeCount(U32 *NodeSize, U32 *NodeCount);
|
|
*
|
|
* RETURNS:
|
|
*/
|
|
PUBLIC _PnpBiosGetDeviceNodeCount
|
|
_PnpBiosGetDeviceNodeCount:
|
|
|
|
push ebp
|
|
mov ebp, esp
|
|
|
|
pusha
|
|
push es
|
|
|
|
mov bx, FNID_PnpBiosGetDeviceNodeCount
|
|
call i386CallRealMode
|
|
|
|
mov esi, [ebp + 8]
|
|
mov ax, [BSS_PnpNodeSize]
|
|
movzx ecx, ax
|
|
mov [esi], ecx
|
|
|
|
mov esi, [ebp + 12]
|
|
mov ax, [BSS_PnpNodeCount]
|
|
movzx ecx, ax
|
|
mov [esi], ecx
|
|
|
|
pop es
|
|
popa
|
|
|
|
mov esp, ebp
|
|
pop ebp
|
|
|
|
mov eax, dword ptr [BSS_PnpResult]
|
|
|
|
ret
|
|
|
|
|
|
/*
|
|
* U32 PnpBiosGetDeviceNode(U8 *NodeId, U8 *NodeBuffer);
|
|
*
|
|
* RETURNS:
|
|
*/
|
|
PUBLIC _PnpBiosGetDeviceNode
|
|
_PnpBiosGetDeviceNode:
|
|
|
|
push ebp
|
|
mov ebp, esp
|
|
|
|
pusha
|
|
push es
|
|
|
|
/* get current node number */
|
|
mov esi, [ebp + 8]
|
|
mov al, [esi]
|
|
mov byte ptr ds:[BSS_PnpNodeNumber], al
|
|
|
|
/* convert pointer to node buffer to segment/offset */
|
|
mov eax, [ebp + 12]
|
|
shr eax, 4
|
|
and eax, HEX(0f000)
|
|
mov word ptr ds:[BSS_PnpBiosBufferSegment], ax
|
|
mov eax, [ebp + 12]
|
|
and eax, HEX(0ffff)
|
|
mov word ptr ds:[BSS_PnpBiosBufferOffset], ax
|
|
|
|
mov bx, FNID_PnpBiosGetDeviceNode
|
|
call i386CallRealMode
|
|
|
|
/* update node number */
|
|
mov esi, [ebp + 8]
|
|
mov al, byte ptr ds:[BSS_PnpNodeNumber]
|
|
mov [esi], al
|
|
|
|
pop es
|
|
popa
|
|
|
|
mov esp, ebp
|
|
pop ebp
|
|
|
|
mov eax, [BSS_PnpResult]
|
|
|
|
ret
|
|
|
|
END
|
|
|
|
/* EOF */
|