WebSVN – Kolibri OS – Diff – /kernel/trunk/drivers/ati2d.asm

 include 'proc32.inc'
+DEBUG     equ 1
+VID_ATI     equ 0x1002
+LOAD_FROM_FILE  equ 0
+LOAD_FROM_MEM   equ 1
+LOAD_INDIRECT   equ 2
+LOAD_SYSTEM     equ 3
+struc BITMAPINFOHEADER {
+  .biSize          dd ? ; DWORD
+  .biWidth         dd ? ; LONG
+  .biHeight        dd ? ; LONG
+  .biPlanes        dw ? ; WORD
+  .biBitCount      dw ? ; WORD
+  .biCompression   dd ? ; DWORD
+  .biSizeImage     dd ? ; DWORD
+  .biXPelsPerMeter dd ? ; LONG
+  .biYPelsPerMeter dd ? ; LONG
+  .biClrUsed       dd ? ; DWORD
+  .biClrImportant  dd ? ; DWORD
+}
+virtual at 0
+  BI BITMAPINFOHEADER
+end virtual
+struc CURSOR
+{  .magic       dd ?
+   .size        dd ?
+   .pid         dd ?
+   .base        dd ?
+   .hot_x       dd ?
+   .hot_y       dd ?
+}
+virtual at 0
+  CURSOR CURSOR
-DEBUG     equ 0
+end virtual
-VID_ATI     equ 0x1002
+CURSOR_SIZE     equ 24
 R8500       equ 0x514C  ;R200
 public START
+public service_proc
-public service_proc
+public version
 extrn SysMsgBoardStr
 extrn PciApi
 extrn PciRead32
 extrn AllocKernelSpace
 extrn MapPage
+extrn RegService
+extrn SetHwCursor
-extrn RegService
+extrn HwCursorRestore
-extrn SetHwCursor
+extrn HwCursorCreate
 extrn LFBAddress
 section '.flat' code readable align 16
-proc START stdcall, state:dword
+proc START stdcall, state:dword
-           mov eax, [state]
-           cmp eax, 1
-           je .entry
+           cmp [state], 1
-           jmp .exit
+           jne .exit
 .entry:
      if DEBUG
            mov esi, msgInit
            call SysMsgBoardStr
      end if
-           call detect_ati
-	   test eax, eax
-           jz .fail
-           stdcall LoadFile, user_file
-           test eax, eax
-           jz @F
-           mov [user_arrow], eax
+           call detect_ati
-@@:
+           test eax, eax
-           stdcall ati_init_cursor, [user_arrow]
+           jz .fail
+           call init_ati
+           test eax, eax
+           jz .fail
+           xor eax, eax
+           mov edi, cursors
+           mov ecx, CURSOR_SIZE*16
+           cld
+           rep stosd
+           not eax
+           mov [cursor_map], eax
+           mov [cursor_map+4], eax
            mov edx, cursor_map
-           call init_ati
+           mov [cursor_start], edx
-           test eax, eax
+           add edx, 4
+           mov [cursor_end], edx
-           jz .fail
+           stdcall RegService, sz_ati_srv, service_proc
-           stdcall RegService, sz_ati_srv, service_proc
+           test eax, eax
-           test eax, eax
+           jz .fail
-           jz .fail
+           mov dword [SetHwCursor], drvCursorPos ;enable hardware cursor
-           mov ebx, SetHwCursor
+           mov dword [HwCursorRestore], drv_restore
-           mov dword [ebx], drvCursorPos ;enable hardware cursor
+           mov dword [HwCursorCreate], ati_cursor
-	   ret
+           ret
 .fail:
      if DEBUG
-	   mov esi, msgFail
+           mov esi, msgFail
            call SysMsgBoardStr
      end if
 .exit:
            xor eax, eax
-	   je .found
+           je .found
            add edi, 4
-	   jmp @B
+           jmp @B
+.next:
-.next:	   inc [devfn]
+           inc [devfn]
-	   cmp [devfn], 256
+           cmp [devfn], 256
-	   jb  .next_dev
+           jb  .next_dev
-	   mov eax, [bus]
+           mov eax, [bus]
-	   inc eax
+           inc eax
-	   mov [bus], eax
+           mov [bus], eax
            shl ebx,20
            or eax, ebx
            mov [edi+0x50], eax
-           pushd 0
-           pushd 0
-           call drvCursorPos
            call drvShowCursor
            xor eax, eax
            inc eax
 .fail:
            ret
 endp
+align 4
+drv_restore:
+           ret 8
 align 4
 drvShowCursor:
            mov edi, [ati_io]
            mov eax, [edi+RD_CRTC_GEN_CNTL]
            bts eax,16
            mov [edi+RD_CRTC_GEN_CNTL], eax
-           ret
-align 4
+           ret
-drvCursorPos:
+align 4
-           push ebp
+proc drvCursorPos stdcall, hcursor:dword, x:dword, y:dword
-           mov ebp, esp
            mov eax, 80000000h
            wrr CUR_HORZ_VERT_OFF, eax
-           mov eax, [ebp+8]
+           mov eax, [x]
+           shl eax, 16
-           shl eax, 16
+           or eax, [y]
+           or eax, 80000000h
-           or eax, [ebp+12]
+           wrr CUR_HORZ_VERT_POSN, eax
+           mov esi, [hcursor]
+           mov eax, [esi+CURSOR.base]
+           sub eax, LFBAddress
+           wrr CUR_OFFSET, eax
+           ret
+endp
+align 4
+proc video_alloc
+           pushfd
+           cli
+           mov ebx, [cursor_start]
+           mov ecx, [cursor_end]
+.l1:
+           bsf eax,[ebx];
+           jnz .found
+           add ebx,4
+           cmp ebx, ecx
+           jb .l1
+           popfd
+           xor eax,eax
+           ret
+.found:
+           btr [ebx], eax
+           popfd
+           mov [cursor_start],ebx
+           sub ebx, cursor_map
+           shl ebx, 3
+           add eax,ebx
+           shl eax,14
+           add eax, LFBAddress+CURSOR_IMAGE_OFFSET
+           ret
+endp
+align 4
+proc ati_cursor stdcall, hcursor:dword, src:dword, flags:dword
+           stdcall video_alloc
+           mov edi, [hcursor]
+           mov [edi+CURSOR.base], eax
+           mov esi, [src]
+           mov ebx, [flags]
+           cmp bx, LOAD_INDIRECT
+           je .indirect
+           movzx ecx, word [esi+10]
+           movzx edx, word [esi+12]
+           mov [edi+CURSOR.hot_x], ecx
-           or eax, 80000000h
+           mov [edi+CURSOR.hot_y], edx
+           stdcall ati_init_cursor, eax, esi
+           mov eax, [hcursor]
+.fail:
+           ret
+.indirect:
+           shr ebx, 16
+           movzx ecx, bh
+           movzx edx, bl
+           mov [eax+CURSOR.hot_x], ecx
+           mov [eax+CURSOR.hot_y], edx
+           xchg edi, eax
+           push edi
+           mov ecx, 64*64
+           xor eax,eax
+           rep stosd
+           mov esi, [src]
+           pop edi
+           mov ebx, 32
+           cld
+@@:
+           mov ecx, 32
-           wrr CUR_HORZ_VERT_POSN, eax
+           rep movsd
+           add edi, 128
            dec ebx
-           mov eax, CURSOR_IMAGE_OFFSET
+           jnz @B
-           wrr CUR_OFFSET, eax
+           mov eax, [hcursor]
-           leave
+           ret
-           ret 8
+endp
 align 4
-proc ati_init_cursor stdcall, arrow:dword
+proc ati_init_cursor stdcall, dst:dword, src:dword
            locals
              rBase    dd ?
              pQuad    dd ?
-             pBits    dd ?
-             pAnd     dd ?
-             width    dd ?
+             pBits    dd ?
-             height   dd ?
+             pAnd     dd ?
-             counter  dd ?
-           endl
+             width    dd ?
+             height   dd ?
+             counter  dd ?
+           endl
            mov esi, [src]
-           cld
+           add esi,[esi+18]
            mov eax,esi
            mov esi, [arrow]
-           add esi,[esi+18d]
+           cmp [esi+BI.biBitCount], 24
            sub edi,128
            mov [rBase],edi
            sub [height],1
            jnz .l1
            jmp .copy
+.img_24:
+           add eax, [esi]
+           mov [pQuad],eax
+           add eax, 0xC00
+           mov [pAnd],eax
+           mov eax,[esi+BI.biWidth]
+           mov [width],eax
+           mov ebx,[esi+BI.biHeight]
+           shr ebx,1
+           mov [height],ebx
+           mov edi, pCursor
+           add edi, 32*31*4
+           mov [rBase],edi
+           mov esi,[pAnd]
+           mov ebx, [pQuad]
+.row_24:
+           mov eax, [esi]
+           bswap eax
+           mov [counter], 32
+@@:
+           xor edx, edx
+           shl eax,1
+           setc dl
+           dec edx
+           mov ecx, [ebx]
+           and ecx, 0x00FFFFFF
+           and ecx, edx
+           and edx, 0xFF000000
+           or edx, ecx
+           mov [edi], edx
+           add ebx, 3
+           add edi, 4
+           dec [counter]
+           jnz @B
+           add esi, 4
-           mov edi, LFBAddress
+           mov edi,[rBase]
+           sub edi,128
+           mov [rBase],edi
+           sub [height],1
+           jnz .row_24
+.copy:
-           add edi, CURSOR_IMAGE_OFFSET
+           mov edi, [dst]
            mov ecx, 64*64
            xor eax,eax
            rep stosd
            mov esi, pCursor
-           mov edi, LFBAddress
-           add edi, CURSOR_IMAGE_OFFSET
+           mov edi, [dst]
+           mov ebx, 32
-           mov ebx, 32
+           cld
-lc:
+@@:
-           mov ecx, 32
-lb:
-           mov eax, [esi]
-           mov [edi], eax
-           add esi, 4
-           add edi, 4
-           sub ecx, 1
+           mov ecx, 32
-           jnz lb
            rep movsd
            add edi, 128
-           sub ebx, 1
+           dec ebx
-           jnz lc
+           jnz @B
            ret
            ret
 endp
 align 4
 engSetupSolidFill:
            push ebp
         dd (R9800P  shl 16)+VID_ATI
         dd (R9800XT shl 16)+VID_ATI
         dd 0    ;terminator
-;szKernel     db 'KERNEL', 0
-sz_ati_srv   db 'ATI2D',0
+version dd 0x00010001
-user_file    db '/rd/1/user.cur',0
 sz_ati_srv   db 'HWCURSOR',0
 msgInit      db 'detect hardware...',13,10,0
-msgPCI       db 'PCI accsess not supported',13,10,0
-msgFail      db 'device not found',13,10,0
-user_arrow   dd pArrow
-align 16
+msgPCI       db 'PCI accsess not supported',13,10,0
-pArrow:
+msgFail      db 'device not found',13,10,0
+section '.data' data readable writable align 16
+pCursor  db 4096 dup(?)
   file 'arrow.cur'
 cursors        rb CURSOR_SIZE*64
-section '.data' data readable writable align 16
+cursor_map     rd 2

Subversion Repositories Kolibri OS

(root)/kernel/trunk/drivers/ati2d.asm – Rev 214 → 227