WebSVN – Kolibri OS – Diff – /drivers/unfinished/agp.asm

 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 ;;                                                                 ;;
-;; Copyright (C) KolibriOS team 2004-2012. All rights reserved.    ;;
+;; Copyright (C) KolibriOS team 2004-2014. All rights reserved.    ;;
 ;; Distributed under terms of the GNU General Public License       ;;
 ;;                                                                 ;;
 ;; simple AGP driver for KolibriOS                                 ;;
 ;;                                                                 ;;
 ;;    Written by hidnplayr@kolibrios.org                           ;;
 ;;             Version 2, June 1991                                ;;
 ;;                                                                 ;;
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
+format PE DLL native
+entry START
-format MS COFF
-DEBUG                   equ 1
+        CURRENT_API             = 0x0200
-FAST_WRITE              equ 0           ; may cause problems with some motherboards
+        COMPATIBLE_API          = 0x0100
-include 'proc32.inc'
-include 'imports.inc'
-struc IOCTL
-{  .handle      dd ?
-   .io_code     dd ?
+        API_VERSION             = (COMPATIBLE_API shl 16) + CURRENT_API
-   .input       dd ?
-   .inp_size    dd ?
+        FAST_WRITE              = 0     ; may cause problems with some motherboards
-   .output      dd ?
-   .out_size    dd ?
-}
+section '.flat' readable writable executable
-virtual at 0
-  IOCTL IOCTL
-end virtual
+include '../proc32.inc'
-public START
-public service_proc
+include '../struct.inc'
-public version
+include '../macros.inc'
-DRV_ENTRY       equ 1
-DRV_EXIT        equ -1
+include '../pci_pe.inc'
-SRV_GETVERSION  equ 0
+;;;;;;;;;;;;;;;;;;;;;;;;;;;;
-SRV_DETECT      equ 1
+;;                        ;;
-API_VERSION     equ 1
 ;; proc START             ;;
-section '.flat' code readable align 16
+;;                        ;;
+;; (standard driver proc) ;;
+;;;;;;;;;;;;;;;;;;;;;;;;;;;;
-proc START stdcall, state:dword
 proc START c, reason:dword, cmdline:dword
-        cmp     [state], 1
+        cmp     [reason], DRV_ENTRY
-        jne     .exit
-.entry:
+        jne     .fail
+        mov     esi, msgInit
-     if DEBUG
+        invoke  SysMsgBoardStr
-        mov     esi, msgInit
+        invoke  RegService, my_service, service_proc
-        call    SysMsgBoardStr
-     end if
+        call    detect
-        stdcall RegService, my_service, service_proc
+        ret
-        ret
-.fail:
-.exit:
+  .fail:
         xor     eax, eax
         ret
 endp
-handle     equ  IOCTL.handle
-io_code    equ  IOCTL.io_code
-input      equ  IOCTL.input
+;;;;;;;;;;;;;;;;;;;;;;;;;;;;
+;;                        ;;
+;; proc SERVICE_PROC      ;;
+;;                        ;;
+;; (standard driver proc) ;;
-inp_size   equ  IOCTL.inp_size
+;;;;;;;;;;;;;;;;;;;;;;;;;;;;
-output     equ  IOCTL.output
+proc service_proc stdcall, ioctl:dword
 out_size   equ  IOCTL.out_size
-align 4
-proc service_proc stdcall, ioctl:dword
-        mov     ebx, [ioctl]
-        mov     eax, [ebx+io_code]
-        cmp     eax, SRV_GETVERSION
+        mov     edx, [ioctl]
-        jne     @F
+        mov     eax, [edx + IOCTL.io_code]
-        mov     eax, [ebx+output]
+;------------------------------------------------------
-        cmp     [ebx+out_size], 4
-        jne     .fail
-        mov     [eax], dword API_VERSION
-        xor     eax, eax
-        ret
-@@:
-        mov     ebx, [ioctl]
-        mov     eax, [ebx+io_code]
+        cmp     eax, 0 ;SRV_GETVERSION
-        cmp     eax, SRV_DETECT
+        jne     .fail
         jne     @F
-        call    detect
+        cmp     [edx + IOCTL.out_size], 4
-@@:
+        jb      .fail
-.fail:
+        mov     eax, [edx + IOCTL.output]
-        or      eax, -1
+        mov     [eax], dword API_VERSION
         ret
-endp
+        xor     eax, eax
         ret
-restore   handle
-restore   io_code
+  .fail:
-restore   input
+        or      eax, -1
-restore   inp_size
+        ret
 restore   output
-restore   out_size
+endp
 align 4
-proc detect
-           locals
+proc detect
-            last_bus dd ?
+           locals
-           endl
             last_bus dd ?
-        mov     esi, msgSearch
+           endl
-        call    SysMsgBoardStr
-        xor     eax, eax
+        mov     esi, msgSearch
-        mov     [bus], eax
+        invoke  SysMsgBoardStr
         inc     eax
         cmp     eax, [last_bus]
         jna     .next_bus
   .error:
         mov     esi, msgFail
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
         xor     eax, eax
         inc     eax
         ret
   .found:
-        stdcall PciRead8, [bus], [devfn], dword 0x06    ; read prog IF
+        invoke  PciRead8, [bus], [devfn], PCI_header00.prog_if
         test    al, 1 shl 4                             ; got capabilities list?
         jnz     .got_capabilities_list
         ; TODO: Do it the old way: detect device and check with a list of known capabilities
         ; stupid pre PCI 2.2 board....
         jmp     .next
   .got_capabilities_list:
-        stdcall PciRead8, [bus], [devfn], dword 0x34    ; read capabilities offset
+        invoke  PciRead8, [bus], [devfn], PCI_header00.cap_ptr
         and     eax, 11111100b                          ; always dword aligned
         mov     edi, eax
         cmp     al, 0x30
         je      .agp_3
   .agp_2:
         mov     esi, msgAGP2
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
-        stdcall PciRead32, [bus], [devfn], edi          ; read AGP status
+        invoke  PciRead32, [bus], [devfn], edi          ; read AGP status
   .agp_2_:
-        test    al, 100b
-        jnz     .100b
+        test    al, 100b
         jnz     .100b
-        test    al, 10b
-        jnz     .010b
+        test    al, 10b
         jnz     .010b
         test    al, 1b
         jz      .error
   .001b:
         mov     [cmd], 001b
         mov     esi, msg1
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
         jmp     .agp_go
   .010b:
         mov     [cmd], 010b
         mov     esi, msg2
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
         jmp     .agp_go
   .100b:
         mov     [cmd], 100b
         mov     esi, msg4
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
         jmp     .agp_go
   .agp_2m:
         mov     esi, msgAGP2m
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
         jmp     .agp_2_
   .agp_3:
         mov     esi, msgAGP3
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
-        stdcall PciRead32, [bus], [devfn], edi          ; read AGP status
+        invoke  PciRead32, [bus], [devfn], edi          ; read AGP status
         test    al, 1 shl 3
         jz      .agp_2m
         test    eax, 10b
         jnz     .8x
         mov     [cmd], 01b
         mov     esi, msg4
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
         jmp     .agp_go
   .8x:
         mov     [cmd], 10b
         mov     esi, msg8
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
   .agp_go:
 if FAST_WRITE
         test    ax, 1 shl 4
         jz      @f
         or      [cmd], 1 shl 4
         mov     esi, msgfast
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
   @@:
 end if
         test    ax, 1 shl 9     ; Side band addressing
         jz      @f
         or      [cmd], 1 shl 9
+        mov     esi, msgside
+        invoke  SysMsgBoardStr
-        mov     esi, msgside
+  @@:
         call    SysMsgBoardStr
-  @@:
+        add     edi, 4
         mov     eax, [cmd]
 msg2            db '2x speed', 13, 10, 0
 msg1            db '1x speed', 13, 10, 0
 msgfast         db 'Fast Write', 13, 10, 0
 msgside         db 'Side band addressing', 13, 10, 0
-section '.data' data readable writable align 16
 ; uninitialized data
 revision        db ?

Subversion Repositories Kolibri OS

(root)/drivers/unfinished/agp.asm – Rev 2902 → 5066