| 1,6 → 1,6 |
|---|
| ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; |
| ;; ;; |
| ;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;; |
| ;; Copyright (C) KolibriOS team 2004-2014. All rights reserved. ;; |
| ;; Distributed under terms of the GNU General Public License ;; |
| ;; ;; |
| ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; |
| 7,52 → 7,40 |
|---|
| |
| ;driver sceletone |
| |
| format MS COFF |
| format PE DLL native 0.05 |
| entry START |
| |
| DEBUG equ 1 |
| |
| API_VERSION equ 0 ;debug |
| |
| include 'proc32.inc' |
| include 'imports.inc' |
| |
| 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 |
| public version |
| |
| DRV_ENTRY equ 1 |
| DRV_EXIT equ -1 |
| STRIDE equ 4 ;size of row in devices table |
| |
| SRV_GETVERSION equ 0 |
| |
| section '.flat' code readable align 16 |
| section '.flat' code readable writable executable |
| include 'proc32.inc' |
| include 'struct.inc' |
| include 'macros.inc' |
| include 'peimport.inc' |
| |
| proc START stdcall, state:dword |
| proc START c, state:dword, cmdline:dword |
| |
| cmp [state], 1 |
| jne .exit |
| .entry: |
| |
| push esi |
| if DEBUG |
| mov esi, msgInit |
| call SysMsgBoardStr |
| invoke SysMsgBoardStr |
| end if |
| call detect |
| pop esi |
| test eax, eax |
| jz .fail |
| |
| stdcall RegService, my_service, service_proc |
| invoke RegService, my_service, service_proc |
| ret |
| .fail: |
| .exit: |
| 60,25 → 48,17 |
|---|
| 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 ebx, [ioctl] |
| mov eax, [ebx+io_code] |
| mov eax, [ebx+IOCTL.io_code] |
| cmp eax, SRV_GETVERSION |
| jne @F |
| |
| mov eax, [ebx+output] |
| cmp [ebx+out_size], 4 |
| mov eax, [ebx+IOCTL.output] |
| cmp [ebx+IOCTL.out_size], 4 |
| jne .fail |
| mov [eax], dword API_VERSION |
| mov dword [eax], API_VERSION |
| xor eax, eax |
| ret |
| @@: |
| 87,65 → 67,36 |
|---|
| 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 |
| push ebx |
| invoke GetPCIList |
| mov ebx, eax |
| .next_dev: |
| stdcall PciRead32, [bus], [devfn], dword 0 |
| test eax, eax |
| jz .next |
| cmp eax, -1 |
| je .next |
| mov eax, [eax+PCIDEV.fd] |
| cmp eax, ebx |
| jz .err |
| mov edx, [eax+PCIDEV.vendor_device_id] |
| |
| mov edi, devices |
| mov esi, devices |
| @@: |
| mov ebx, [edi] |
| test ebx, ebx |
| jz .next |
| cmp dword [esi], 0 |
| jz .next_dev |
| cmp edx, [esi] |
| jz .found |
| |
| cmp eax, ebx |
| je .found |
| add esi, STRIDE |
| jmp @B |
| |
| 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 |
| pop ebx |
| ret |
| .err: |
| mov esi, msgFail |
| invoke SysMsgBoardStr |
| xor eax, eax |
| pop ebx |
| ret |
| endp |
| |
| 159,15 → 110,11 |
|---|
| devices dd (DEVICE_ID shl 16)+VENDOR_ID |
| dd 0 ;terminator |
| |
| version dd (5 shl 16) or (API_VERSION and 0xFFFF) |
| |
| 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 |
| |
| align 4 |
| data fixups |
| end data |