Subversion Repositories Kolibri OS

R9000       equ 0x4966  ;RV250

R9200       equ 0x5961  ;RV280

R9500       equ 0x4144  ;R300

R9500P      equ 0x4E45  ;R300

R9550       equ 0x4153  ;RV350

R9600       equ 0x4150  ;RV350

R9600XT     equ 0x4152  ;RV360

R9700P      equ 0x4E44  ;R300

R9800       equ 0x4E49  ;R350

R9800P      equ 0x4E48  ;R350

R9800XT     equ 0x4E4A  ;R360

new_app_base    equ 0x60400000;   0x01000000

PROC_BASE       equ OS_BASE+0x0080000

PG_NOCACHE   equ 0x018

{  .handle           dd ?

   .io_code          dd ?

   .input            dd ?

   .inp_size         dd ?

   .output           dd ?

   .out_size         dd ?

}

  IOCTL IOCTL

end virtual

RD_RB3D_CNTL          equ 1c3ch

RD_CRTC_GEN_CNTL           equ 0050h

RD_CRTC_CUR_EN             equ 10000h

RD_DISPLAY_BASE_ADDR       equ 023ch

RD_DEFAULT_OFFSET          equ 16e0h

CUR_HORZ_VERT_OFF          equ 0268h

CUR_HORZ_VERT_POSN         equ 0264h

CUR_OFFSET                 equ 0260h

RD_RB3D_CNTL               equ 1c3ch

RD_RBBM_STATUS             equ 0e40h

RD_RBBM_FIFOCNT_MASK       equ 007fh

RD_RBBM_ACTIVE             equ 80000000h

RD_TIMEOUT                 equ 2000000

RD_DP_BRUSH_BKGD_CLR       equ 01478h

RD_DP_BRUSH_FRGD_CLR       equ 0147ch

RD_DP_SRC_BKGD_CLR         equ 015dch

RD_DP_SRC_FRGD_CLR         equ 015d8h

RD_DP_CNTL                 equ 016c0h

RD_DP_DATATYPE             equ 016c4h

RD_DP_WRITE_MASK           equ 016cch

RD_DP_SRC_SOURCE_MEMORY    equ (2 shl 24)

RD_DP_SRC_SOURCE_HOST_DATA equ (3 shl 24)

RD_DEFAULT_SC_BOTTOM_RIGHT equ 16e8h

RD_GMC_BRUSH_SOLID_COLOR   equ (13 shl 4)

RD_DEFAULT_SC_RIGHT_MAX    equ 1fffh

RD_DEFAULT_SC_BOTTOM_MAX   equ 1fff0000h

RD_GMC_DST_DATATYPE_SHIFT  equ 8

RD_ROP3_P                  equ 00f00000h

RD_RB2D_DSTCACHE_CTLSTAT   equ 0342ch

RD_RB2D_DC_FLUSH_ALL       equ 000fh

RD_RB2D_DC_BUSY            equ 80000000h

RD_GMC_SRC_DATATYPE_COLOR  equ (3 shl 12)

RD_GMC_CLR_CMP_CNTL_DIS    equ (1 shl 28)

RD_GMC_WR_MSK_DIS          equ (1 shl 30)

RD_SRC_PITCH_OFFSET        equ 1428h

RD_DST_Y_TOP_TO_BOTTOM     equ 2

RD_DST_Y_X                 equ 1438h

RD_DST_WIDTH_HEIGHT        equ 1598h

RD_DST_LINE_START          equ 1600h

RD_DST_LINE_END            equ 1604h

R300_MEM_NUM_CHANNELS_MASK equ 0003h

{

     mov edi, [ati_io]

     mov op1, [edi+op2]

}

{

     mov edi, [ati_io]

     mov dword [edi+dest], src

}

public service_proc

extrn PciApi

extrn PciRead32

extrn AllocKernelSpace

extrn MapPage

extrn RegService

extrn SetHwCursor

extrn LFBAddress

extrn LoadFile

DRV_EXIT  equ -1

           cmp eax, 1

           je .entry

           jmp .exit

.entry:

     if DEBUG

           mov esi, msgInit

           call SysMsgBoardStr

     end if

	   test eax, eax

           jz .fail

           test eax, eax

           jz @F

           mov [user_arrow], eax

@@:

           stdcall ati_init_cursor, [user_arrow]

           test eax, eax

           jz .fail

           test eax, eax

           jz .fail

           mov ebx, SetHwCursor

           mov dword [ebx], drvCursorPos ;enable hardware cursor

	   ret

.fail:

     if DEBUG

	   mov esi, msgFail

           call SysMsgBoardStr

     end if

           xor eax, eax

           mov ebx, SetHwCursor

           mov dword [ebx], eax    ;force disable hardware cursor

           ret

endp

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

proc service_proc stdcall, ioctl:dword

;           mov eax, [edi+io_code]

	   ret

endp

restore   io_code

restore   input

restore   inp_size

restore   output

restore   out_size

proc detect_ati

	   locals

	     last_bus dd ?

	   endl

	   mov [bus], eax

	   inc eax

           call PciApi

	   cmp eax, -1

           je .err

	   and [devfn], 0

.next_dev:

           stdcall PciRead32, [bus], [devfn], dword 0

	   test eax, eax

	   jz .next

	   cmp eax, -1

	   je .next

@@:

	   mov ebx, [edi]

	   test ebx, ebx

	   jz .next

	   je .found

           add edi, 4

	   jmp @B

	   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

proc init_ati

           test eax, eax

           jz .fail

           and eax, 0xFFFF0000

           mov esi, eax

           mov edx, 16

@@:

           stdcall MapPage,edi,esi,PG_SW+PG_NOCACHE

	   add edi, 0x1000

           add esi, 0x1000

           dec edx

           jnz @B

           mov dword [edi+RD_RB3D_CNTL], 0

           call engRestore

           mov eax, [edi+0x50]

           mov ebx,3

           shl ebx,20

           not ebx

           and eax,ebx

           mov ebx, 2

           shl ebx,20

           or eax, ebx

           mov [edi+0x50], eax

           pushd 0

           call drvCursorPos

           call drvShowCursor

           xor eax, eax

           inc eax

.fail:

           ret

endp

drvShowCursor:

           mov edi, [ati_io]

           bts eax,16

           mov [edi+RD_CRTC_GEN_CNTL], eax

           ret

drvCursorPos:

           push ebp

           mov ebp, esp

           mov eax, 80000000h

           wrr CUR_HORZ_VERT_OFF, eax

           shl eax, 16

           or eax, [ebp+12]

           or eax, 80000000h

           wrr CUR_HORZ_VERT_POSN, eax

           wrr CUR_OFFSET, eax

           leave

           ret 8

proc ati_init_cursor stdcall, arrow:dword

           locals

             rBase    dd ?

             pQuad    dd ?

             pBits    dd ?

             pAnd     dd ?

             width    dd ?

             height   dd ?

             counter  dd ?

           endl

           add esi,[esi+18d]

           add eax, [esi]

           mov [pQuad],eax

           add eax,64

           mov [pBits],eax

           add eax, 0x200

           mov [pAnd],eax

           mov eax,[esi+4]

           mov [width],eax

           mov ebx,[esi+8]

           shr ebx,1

           mov [height],ebx

           add edi, 32*31*4

           mov [rBase],edi

           mov ebx, [pBits]

.l1:

           mov eax, [esi]

           bswap eax

           mov [counter], 16

@@:

           xor edx, edx

           shl eax,1

           setc dl

           dec edx

           and ecx, 0xF0

           shr ecx, 2

           add ecx, [pQuad]

           mov ecx, [ecx]

           and ecx, edx

           and edx, 0xFF000000

           or edx, ecx

           mov [edi], edx

           shl eax,1

           setc dl

           dec edx

           and ecx, 0x0F

           shl ecx, 2

           add ecx, [pQuad]

           mov ecx, [ecx]

           and ecx, edx

           and edx, 0xFF000000

           or edx, ecx

           mov [edi+4], edx

           add edi, 8

           dec [counter]

           jnz @B

           mov edi,[rBase]

           sub edi,128

           mov [rBase],edi

           sub [height],1

           jnz .l1

           add edi, CURSOR_IMAGE_OFFSET

           mov ecx, 64*64

           xor eax,eax

           rep stosd

           mov edi, LFBAddress

           add edi, CURSOR_IMAGE_OFFSET

           mov ebx, 32

lc:

           mov ecx, 32

lb:

           mov eax, [esi]

           mov [edi], eax

           add esi, 4

           add edi, 4

           sub ecx, 1

           jnz lb

           sub ebx, 1

           jnz lc

endp

proc engFlush

           or eax,RD_RB2D_DC_FLUSH_ALL

           mov [edi+RD_RB2D_DSTCACHE_CTLSTAT],eax

@@:

           mov eax,[edi+RD_RB2D_DSTCACHE_CTLSTAT]

           and eax, RD_RB2D_DC_BUSY

           jz .exit

           jnz @B

.exit:

           ret

endp

engWaitForFifo:

cnt equ bp+8

           push ebp

           mov ebp, esp

@@:

           mov eax, [edi+RD_RBBM_STATUS]

           and eax, RD_RBBM_FIFOCNT_MASK

           cmp eax, [ebp+8]

           jae .exit

           jmp @B

           leave

           ret 4

proc engWaitForIdle

               call engWaitForFifo

               mov ecx ,RD_TIMEOUT

@@:

               mov eax, [edi+RD_RBBM_STATUS]

               and eax,RD_RBBM_ACTIVE

               jz .exit

               jnz @B

.exit:

               call engFlush

               ret

endp

proc engRestore

;             call engWaitForFifo

             call engWaitForFifo

           shr eax, 10d

           or eax,(64d shl 22d)

           mov [edi+RD_DEFAULT_OFFSET],eax

           mov [edi+RD_SRC_PITCH_OFFSET],eax

           mov [edi+RD_DST_PITCH_OFFSET],eax

           call engWaitForFifo

           mov eax, [edi+RD_DP_DATATYPE]

           btr eax, 29d

           mov [edi+RD_DP_DATATYPE],eax

           call engWaitForFifo

           mov dword [edi+RD_DEFAULT_SC_BOTTOM_RIGHT],\

                     (RD_DEFAULT_SC_RIGHT_MAX or RD_DEFAULT_SC_BOTTOM_MAX)

           call engWaitForFifo

           mov dword [edi+RD_DP_GUI_MASTER_CNTL],\

                     (RD_GMC_BRUSH_SOLID_COLOR or \

                      RD_GMC_SRC_DATATYPE_COLOR or \

                     (6 shl RD_GMC_DST_DATATYPE_SHIFT) or \

                      RD_GMC_CLR_CMP_CNTL_DIS or \

                      RD_ROP3_P or \

                      RD_GMC_WR_MSK_DIS)

           call engWaitForFifo

           mov dword [edi+RD_DST_LINE_END], 0

           mov dword [edi+RD_DP_BRUSH_FRGD_CLR], 808000ffh

           mov dword [edi+RD_DP_BRUSH_BKGD_CLR], 002020ffh

           mov dword [edi+RD_DP_SRC_FRGD_CLR],   808000ffh

           mov dword [edi+RD_DP_SRC_BKGD_CLR],   004000ffh

           mov dword [edi+RD_DP_WRITE_MASK],0ffffffffh

endp

engSetupSolidFill:

           push ebp

           mov ebp, esp

           call engWaitForFifo

           wrr RD_DP_BRUSH_FRGD_CLR,eax

           mov dword [edi+RD_DP_CNTL],(RD_DST_X_LEFT_TO_RIGHT or RD_DST_Y_TOP_TO_BOTTOM)

           leave

           ret 4

drvSolidFill:

;x:word,y:word,w:word,h:word,color:dword

            push ebp

            mov ebp, esp

x equ ebp+8

y equ ebp+12

w equ ebp+16

h equ ebp+20

color equ ebp+24

            call engSetupSolidFill

            call engWaitForFifo

            mov ebx, [x]

            shl eax,16

            or eax, ebx

            mov edx,  [h]

            shl ecx,16

            or ecx, edx

            mov [edi+RD_DST_Y_X], eax

            mov [edi+RD_DST_WIDTH_HEIGHT], ecx

	    call engFlush

            leave

            ret 20

devices dd (R8500   shl 16)+VID_ATI

        dd (R9000   shl 16)+VID_ATI

        dd (R9200   shl 16)+VID_ATI

        dd (R9500   shl 16)+VID_ATI

        dd (R9500P  shl 16)+VID_ATI

        dd (R9550   shl 16)+VID_ATI

        dd (R9600   shl 16)+VID_ATI

        dd (R9600XT shl 16)+VID_ATI

        dd (R9700P  shl 16)+VID_ATI

        dd (R9800   shl 16)+VID_ATI

        dd (R9800P  shl 16)+VID_ATI

        dd (R9800XT shl 16)+VID_ATI

        dd 0    ;terminator

sz_ati_srv   db 'ATI2D',0

user_file    db '/rd/1/user.cur',0

msgPCI       db 'PCI accsess not supported',13,10,0

msgFail      db 'device not found',13,10,0

pArrow:

  file 'arrow.cur'

devfn      dd ?

ati_io     dd ?