| 0,0 → 1,173 |
|---|
| |
| ;driver sceletone |
| |
| format MS COFF |
| |
| include 'proc32.inc' |
| |
| |
| OS_BASE equ 0; |
| new_app_base equ 0x60400000 |
| PROC_BASE equ OS_BASE+0x0080000 |
| |
| struc IOCTL |
| { .handle dd ? |
| .io_code dd ? |
| .input dd ? |
| .inp_size dd ? |
| .output dd ? |
| .out_size dd ? |
| } |
| |
| virtual at 0 |
| IOCTL IOCTL |
| end virtual |
| |
| public START |
| public service_proc |
| |
| extrn AttachIntHandler |
| extrn SysMsgBoardStr |
| extrn PciApi |
| extrn PciRead32 |
| extrn PciRead8 |
| extrn PciWrite8 |
| extrn AllocKernelSpace |
| extrn KernelAlloc |
| extrn MapPage |
| extrn GetPgAddr |
| extrn RegService |
| extrn ServiceHandler |
| extrn SetHwCursor |
| extrn LFBAddress |
| extrn LoadFile |
| extrn FpuSave |
| extrn FpuRestore |
| |
| DEBUG equ 1 |
| |
| DRV_ENTRY equ 1 |
| DRV_EXIT equ -1 |
| STRIDE equ 4 ;size of row in devices table |
| |
| section '.flat' code readable align 16 |
| |
| proc START stdcall, state:dword |
| |
| mov eax, [state] |
| cmp eax, 1 |
| je .entry |
| jmp .exit |
| .entry: |
| if DEBUG |
| mov esi, msgInit |
| call SysMsgBoardStr |
| end if |
| |
| stdcall RegService, my_service, service_proc |
| ret |
| .fail: |
| .exit: |
| xor eax, eax |
| ret |
| endp |
| |
| handle equ IOCTL.handle |
| io_code equ IOCTL.io_code |
| input equ IOCTL.input |
| inp_size equ IOCTL.inp_size |
| output equ IOCTL.output |
| out_size equ IOCTL.out_size |
| |
| align 4 |
| proc service_proc stdcall, ioctl:dword |
| |
| ; mov edi, [ioctl] |
| ; mov eax, [edi+io_code] |
| |
| xor eax, eax |
| ret |
| endp |
| |
| restore handle |
| restore io_code |
| restore input |
| restore inp_size |
| restore output |
| restore out_size |
| |
| align 4 |
| proc detect |
| locals |
| last_bus dd ? |
| endl |
| |
| xor eax, eax |
| mov [bus], eax |
| inc eax |
| call PciApi |
| cmp eax, -1 |
| je .err |
| |
| mov [last_bus], eax |
| |
| .next_bus: |
| and [devfn], 0 |
| .next_dev: |
| stdcall PciRead32, [bus], [devfn], dword 0 |
| test eax, eax |
| jz .next |
| cmp eax, -1 |
| je .next |
| |
| mov edi, devices |
| @@: |
| mov ebx, [edi] |
| test ebx, ebx |
| jz .next |
| |
| cmp eax, ebx |
| je .found |
| add edi, STRIDE |
| jmp @B |
| |
| .next: inc [devfn] |
| cmp [devfn], 256 |
| jb .next_dev |
| mov eax, [bus] |
| inc eax |
| mov [bus], eax |
| cmp eax, [last_bus] |
| jna .next_bus |
| xor eax, eax |
| ret |
| .found: |
| xor eax, eax |
| inc eax |
| ret |
| .err: |
| xor eax, eax |
| ret |
| endp |
| |
| |
| ;DEVICE_ID equ ; pci device id |
| ;VENDOR_ID equ ; device vendor id |
| |
| |
| ;all initialized data place here |
| |
| align 4 |
| devices dd (DEVICE_ID shl 16)+VENDOR_ID |
| dd 0 ;terminator |
| |
| my_service db 'MY_SERVICE',0 ;max 16 chars include zero |
| |
| msgInit db 'detect hardware...',13,10,0 |
| msgPCI db 'PCI accsess not supported',13,10,0 |
| msgFail db 'device not found',13,10,0 |
| |
| section '.data' data readable writable align 16 |
| |
| ;all uninitialized data place here |
| |