kolibrios-fun/kernel/branches/kolibri_pe/video/vesa12.inc

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;;                                                              ;;
;; Copyright (C) KolibriOS team 2004-2007. All rights reserved. ;;
;; Distributed under terms of the GNU General Public License    ;;
;;                                                              ;;
;;  VESA12.INC                                                  ;;
;;                                                              ;;
;;  Vesa 1.2 functions for MenuetOS                             ;;
;;                                                              ;;
;;  Copyright 2002 Ville Turjanmaa                              ;;
;;                                                              ;;
;;  quickcode@mail.ru - bankswitch for S3 cards                 ;;
;;                                                              ;;
;;  See file COPYING for details                                ;;
;;                                                              ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

$Revision$


TRIDENT       equ 0
S3_VIDEO      equ 0
INTEL_VIDEO   equ 0

if TRIDENT
  if S3_VIDEO or INTEL_VIDEO
    stop
  end if
end if

if S3_VIDEO
  if TRIDENT or INTEL_VIDEO
    stop
  end if
end if

if INTEL_VIDEO
  if S3_VIDEO or TRIDENT
    stop
  end if
end if


; A complete video driver should include the following types of function
;
; Putpixel
; Getpixel
;
; Drawimage
; Drawbar
;
; Drawbackground
;
;
; Modifying the set_bank -function is mostly enough
; for different Vesa 1.2 setups.

;!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
; set_bank for Trident videocards, work on Trident 9440
; modified by Mario79

if TRIDENT
set_bank:
           pushfd
           cli
           cmp al,[BANK_RW]
           je .retsb

           mov [BANK_RW],al
           push dx
           mov dx,3D8h
           out  dx,al
           pop dx
.retsb:
           popfd
           ret
end if

;!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
; set_bank for S3 videocards, work on S3 ViRGE PCI (325)
; modified by kmeaw

if S3_VIDEO
set_bank:
           pushfd
           cli
           cmp al,[BANK_RW]
           je .retsb

           mov [BANK_RW],al
           push ax
           push dx
           push cx
           mov cl, al
           mov dx, 0x3D4
           mov al, 0x38
           out dx, al     ;CR38 Register Lock 1 ;Note: Traditionally 48h is used to
                          ;unlock and 00h to lock
           inc dx
           mov al, 0x48
           out dx, al     ;3d5 -?
           dec dx
           mov al, 0x31
           out dx, al     ;CR31 Memory Configuration Register
;0  Enable Base Address Offset (CPUA BASE). Enables bank operation if set, ;disables if clear.
;4-5  Bit 16-17 of the Display Start Address. For the 801/5,928 see index 51h,
;for the 864/964 see index 69h.

           inc dx
           in al, dx
           dec dx
           mov ah, al
           mov al, 0x31
           out dx, ax
           mov al, ah
           or al, 9
           inc dx
           out dx, al
           dec dx
           mov al, 0x35
           out dx, al   ;CR35 CRT Register Lock
           inc dx
           in al, dx
           dec dx
           and al, 0xF0
           mov ch, cl
           and ch, 0x0F
           or ch, al
           mov al, 0x35
           out dx, al
           inc dx
           mov al, ch
           out dx, ax
           dec dx
           mov al, 0x51  ;Extended System Control 2 Register
           out dx, al
           inc dx
           in al, dx
           dec dx
           and al, 0xF3
           shr cl, 2
           and cl, 0x0C
           or cl, al
           mov al, 0x51
           out dx, al
           inc dx
           mov al, cl
           out dx, al
           dec dx
           mov al, 0x38
           out dx, al
           inc dx
           xor al, al
           out dx, al
           dec dx
           pop cx
           pop dx
           pop ax
.retsb:
           popfd
           ret
end if

;Set bank function for Intel 810/815 chipsets
; *****Modified by Protopopius, Russia.*****
; ********* http://menuetos.hut.ru **************
; ************************************************

if INTEL_VIDEO

set_bank:
           pushfd
           cli

           cmp al,[BANK_RW]
           je .retsb

           mov [BANK_RW],al
           push ax
           push dx
           mov dx,3CEh
           mov ah,al            ; Save value for later use
           mov al,10h           ; Index GR10 (Address Mapping)
           out dx,al            ; Select GR10
           inc dl
           mov al,3             ; Set bits 0 and 1 (Enable linear page mapping)
           out dx,al            ; Write value
           dec dl
           mov al,11h           ; Index GR11 (Page Selector)
           out dx,al            ; Select GR11
           inc dl
           mov al,ah            ; Write address
           out dx,al            ; Write the value
           pop dx
           pop ax
.retsb:
           popfd
           ret
end if

;!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!}

if (TRIDENT or S3_VIDEO or INTEL_VIDEO)
else
set_bank:
           pushfd
           cli

           cmp al,[BANK_RW]
           je .retsb

           mov [BANK_RW],al
           push ax
           push dx
           mov ah,al
           mov dx,0x03D4
           mov al,0x39
           out dx,al
           inc dl
           mov al,0xA5
           out dx,al
           dec dl
           mov al,6Ah
           out dx,al
           inc dl
           mov al,ah
           out dx,al
           dec dl
           mov al,0x39
           out dx,al
           inc dl
           mov al,0x5A
           out dx,al
           dec dl
           pop dx
           pop ax

.retsb:
           popfd
           ret
end if

vesa12_drawbackground:

        call  [disable_mouse]

        push  eax
        push  ebx
        push  ecx
        push  edx

        xor   edx,edx
        mov   eax,dword[BgrDataWidth]
        mov   ebx,dword[BgrDataHeight]
        mul   ebx
        mov   ebx,3
        mul   ebx
        mov   [imax],eax
        mov   eax,[draw_data+32+RECT.left]
        mov   ebx,[draw_data+32+RECT.top]
        mov   edi,0 ;no force

      v12dp3:

        push  eax
        push  ebx

        cmp   [BgrDrawMode],dword 1     ; tiled background
        jne   no_vesa12_tiled_bgr

        push  edx

        xor   edx,edx
        div   dword [BgrDataWidth]

        push  edx
        mov   eax,ebx
        xor   edx,edx
        div   dword [BgrDataHeight]
        mov   ebx,edx
        pop   eax

        pop   edx

      no_vesa12_tiled_bgr:

        cmp   [BgrDrawMode],dword 2     ; stretched background
        jne   no_vesa12_stretched_bgr

        push  edx

        mul   dword [BgrDataWidth]
        mov   ecx,[Screen_Max_X]
        inc   ecx
        div   ecx

        push  eax
        mov   eax,ebx
        mul   dword [BgrDataHeight]
        mov   ecx,[Screen_Max_Y]
        inc   ecx
        div   ecx
        mov   ebx,eax
        pop   eax

        pop   edx

      no_vesa12_stretched_bgr:


        mov   esi,ebx
        imul  esi, dword [BgrDataWidth]
        add   esi,eax
        lea   esi,[esi*3]
        add   esi,[img_background]   ;IMG_BACKGROUND
        pop   ebx
        pop   eax

      v12di4:

        mov   cl,[esi+2]
        shl   ecx,16
        mov   cx,[esi]
        pusha
        mov   esi,eax
        mov   edi,ebx
        mov   eax,[Screen_Max_X]
        add   eax,1
        mul   ebx
        mov   ebx, [_display_data]
        add   ebx, esi
        cmp   [eax+ebx],byte 1
        jnz   v12nbgp
        mov   eax,[BytesPerScanLine]
        mov   ebx,edi
        mul   ebx
        add   eax, esi
        lea   eax, [VGABasePtr+eax+esi*2]
        cmp   [ScreenBPP],byte 24
        jz    v12bgl3
        add   eax,esi

      v12bgl3:

        push ebx
        push eax

        sub  eax,VGABasePtr

        shr  eax,16
        call set_bank
        pop  eax
        and  eax,65535
        add  eax,VGABasePtr
        pop  ebx

        mov   [eax],cx
        add   eax,2
        shr   ecx,16
        mov   [eax],cl
        sti

      v12nbgp:

        popa
        add   esi,3
        inc   eax
        cmp   eax,[draw_data+32+RECT.right]
        jg    v12nodp31
        jmp   v12dp3

      v12nodp31:

        mov   eax,[draw_data+32+RECT.left]
        inc   ebx
        cmp   ebx,[draw_data+32+RECT.bottom]
        jg    v12dp4
        jmp   v12dp3

      v12dp4:

        pop   edx
        pop   ecx
        pop   ebx
        pop   eax
        ret


vesa12_drawbar:

    call  [disable_mouse]

;;    mov  [novesachecksum],dword 0
    sub  edx,ebx
    sub  ecx,eax
    push esi
    push edi
    push eax
    push ebx
    push ecx
    push edx
    mov  ecx,[TASK_BASE]
    add  eax,[ecx-twdw+WDATA.box.left]
    add  ebx,[ecx-twdw+WDATA.box.top]
    push eax
    mov  eax,ebx         ; y
    mov  ebx,[BytesPerScanLine]
    mul  ebx
    pop  ecx
    add  eax,ecx         ; x
    add  eax,ecx
    add  eax,ecx
    cmp  [ScreenBPP],byte 24     ; 24 or 32 bpp ? - x start
    jz   dbpi2412
    add  eax,ecx

  dbpi2412:

    add  eax,VGABasePtr
    mov  edi,eax

    ; x size

    mov  eax,[esp+4] ; [esp+6]
    mov  ecx,eax
    add  ecx,eax
    add  ecx,eax
    cmp  [ScreenBPP],byte 24     ; 24 or 32 bpp ? - x size
    jz   dbpi24312
    add  ecx,eax

  dbpi24312:

    mov  ebx,[esp+0]

    ; check limits ?

    push eax
    push ecx
    mov  eax,[TASK_BASE]
    mov  ecx,[eax+draw_data-CURRENT_TASK+RECT.left]
    cmp  ecx,0
    jnz  dbcblimitlset12
    mov  ecx,[eax+draw_data-CURRENT_TASK+RECT.top]
    cmp  ecx,0
    jnz  dbcblimitlset12
    mov  ecx,[eax+draw_data-CURRENT_TASK+RECT.right]
    cmp  ecx,[Screen_Max_X]
    jnz  dbcblimitlset12
    mov  ecx,[eax+draw_data-CURRENT_TASK+RECT.bottom]
    cmp  ecx,[Screen_Max_Y]
    jnz  dbcblimitlset12
    pop  ecx
    pop  eax
    push dword 0
    jmp  dbcblimitlno12

  dbcblimitlset12:

    pop  ecx
    pop  eax
    push dword 1

  dbcblimitlno12:

    cmp  [ScreenBPP],byte 24     ; 24 or 32 bpp ?
    jz   dbpi24bit12
    jmp  dbpi32bit12


; DRAWBAR 24 BBP


dbpi24bit12:

    push eax
    push ebx
    push edx
    mov  eax,ecx
    mov  ebx,3
    div  ebx
    mov  ecx,eax
    pop  edx
    pop  ebx
    pop  eax
    cld

  dbnewpi12:

    push ebx
    push edi
    push ecx

      xor  edx,edx
      mov  eax,edi
      sub  eax,VGABasePtr
      mov  ebx,3
      div  ebx
      add  eax, [_display_data]
      mov   ebx,[CURRENT_TASK]
      cld

      dbnp2412:

        mov  dl,[eax]
        push eax
        push ecx
        cmp  dl,bl
        jnz  dbimp24no12
        cmp  [esp+5*4],dword 0
        jz   dbimp24yes12
;        call dbcplimit
;        jnz  dbimp24no12

     dbimp24yes12:

        push edi
        mov  eax,edi
        sub  eax,VGABasePtr
        shr  eax,16
        call set_bank
        and  edi,0xffff
        add  edi,VGABasePtr
        mov  eax,[esp+8+3*4+16+4+4]
        stosw
        shr  eax,16
        stosb
        sti
        pop  edi
        add  edi,3
        pop  ecx
        pop  eax
        inc  eax
        loop dbnp2412
        jmp  dbnp24d12

      dbimp24no12:

        pop  ecx
        pop  eax
        cld
        add  edi,3
        inc  eax
        loop dbnp2412

      dbnp24d12:

        mov  eax,[esp+3*4+16+4]
        test eax,0x80000000
        jz   nodbgl2412
        cmp  al,0
        jz   nodbgl2412
        dec  eax
        mov  [esp+3*4+16+4],eax

      nodbgl2412:

    pop  ecx
    pop  edi
    pop  ebx
    add  edi,[BytesPerScanLine]
    dec  ebx
    jz   dbnonewpi12
    jmp  dbnewpi12

  dbnonewpi12:

    add  esp,7*4

    ret


; DRAWBAR 32 BBP


  dbpi32bit12:

    cld
    shr  ecx,2

   dbnewpi3212:

    push ebx
    push edi
    push ecx

      mov  eax,edi
      sub  eax,VGABasePtr
      shr  eax,2
      add  eax, [_display_data]
      mov   ebx,[CURRENT_TASK]
      cld

      dbnp3212:

        mov  dl,[eax]
        push eax
        push ecx
        cmp  dl,bl
        jnz  dbimp32no12
        cmp  [esp+5*4],dword 0
        jz   dbimp32yes12
;        call dbcplimit
;        jnz  dbimp32no12

      dbimp32yes12:

        push edi
        mov  eax,edi
        sub  eax,VGABasePtr
        shr  eax,16
        call set_bank
        and  edi,0xffff
        add  edi,VGABasePtr
        mov  eax,[esp+8+3*4+16+4+4]
        stosw
        shr  eax,16
        stosb
        sti
        pop  edi
        add  edi,4
        inc  ebp
        pop  ecx
        pop  eax
        inc  eax
        loop dbnp3212
        jmp  dbnp32d12

      dbimp32no12:

        pop  ecx
        pop  eax
        inc  eax
        add  edi,4
        inc  ebp
        loop dbnp3212

      dbnp32d12:

        mov  eax,[esp+12+16+4]
        test eax,0x80000000
        jz   nodbgl3212
        cmp  al,0
        jz   nodbgl3212
        dec  eax
        mov  [esp+12+16+4],eax

      nodbgl3212:

    pop  ecx
    pop  edi
    pop  ebx
    add  edi,[BytesPerScanLine]
    dec  ebx
    jz   nodbnewpi3212
    jmp  dbnewpi3212

  nodbnewpi3212:

    add  esp,7*4
    ret


Vesa12_putpixel24:

        mov  edi,eax ; x
        mov  eax,ebx ; y
        lea  edi,[edi+edi*2]
        mov  ebx,[BytesPerScanLine]
        mul  ebx
        add  edi,eax
        mov  eax,edi
        shr  eax,16
        call set_bank
        and  edi,65535
        add  edi,VGABasePtr
        mov  eax,[esp+28]
        stosw
        shr  eax,16
        mov  [edi],al
        sti
        ret



Vesa12_putpixel32:

        mov  edi,eax ; x
        mov  eax,ebx ; y
        shl  edi,2
        mov  ebx,[BytesPerScanLine]
        mul  ebx
        add  edi,eax
        mov  eax,edi
        shr  eax,16
        call set_bank
        and  edi,65535
        add  edi,VGABasePtr
        mov  ecx,[esp+28]
        mov  [edi],ecx
        sti
        ret


Vesa12_getpixel24:

        mov  edi,eax ; x
        mov  eax,ebx ; y
        lea  edi,[edi+edi*2]
        mov  ebx,[BytesPerScanLine]
        mul  ebx
        add  edi,eax
        mov  eax,edi
        shr  eax,16
        call set_bank
        and  edi,65535
        add  edi,VGABasePtr
        mov  ecx,[edi]
        and  ecx,255*256*256+255*256+255
        sti
        ret


Vesa12_getpixel32:

        mov  edi,eax ; x
        mov  eax,ebx ; y
        shl  edi,2
        mov  ebx,[BytesPerScanLine]
        xor  edx,edx
        mul  ebx
        add  edi,eax
        mov  eax,edi
        shr  eax,16
        call set_bank
        and  edi,65535
        add  edi,VGABasePtr
        mov  ecx,[edi]
        and  ecx,255*256*256+255*256+255
        sti

        ret



vesa12_putimage:
; ebx = pointer to image
; ecx = size [x|y]
; edx = coordinates [x|y]
; ebp = pointer to 'get' function
; esi = pointer to 'init' function
; edi = parameter for 'get' function

;    mov  ebx,image
;    mov  ecx,320*65536+240
;    mov  edx,20*65536+20

    call  [disable_mouse]

    mov   [novesachecksum],dword 0
    push  esi
    push  edi
    push  eax
    push  ebx
    push  ecx
    push  edx
    movzx eax,word [esp+2]
    movzx ebx,word [esp+0]
    mov   ecx,[TASK_BASE]
    add   eax,[ecx-twdw+WDATA.box.left]
    add   ebx,[ecx-twdw+WDATA.box.top]
    push  eax
    mov   eax,ebx         ; y
    mul   dword [BytesPerScanLine]
    pop   ecx
    add   eax,ecx         ; x
    add   eax,ecx
    add   eax,ecx
    cmp  [ScreenBPP],byte 24     ; 24 or 32 bpp ? - x start
    jz   pi2412
    add  eax,ecx

  pi2412:

    add  eax,VGABasePtr
    mov  edi,eax

    ; x size

    movzx ecx,word [esp+6]

    mov   esi,[esp+8]
    movzx ebx,word [esp+4]

    ; check limits while draw ?

    push  ecx
    mov  eax,[TASK_BASE]
    cmp  dword [eax+draw_data-CURRENT_TASK+RECT.left], 0
    jnz  dbcblimitlset212
    cmp  dword [eax+draw_data-CURRENT_TASK+RECT.top], 0
    jnz  dbcblimitlset212
    mov  ecx,[eax+draw_data-CURRENT_TASK+RECT.right]
    cmp  ecx,[Screen_Max_X]
    jnz  dbcblimitlset212
    mov  ecx,[eax+draw_data-CURRENT_TASK+RECT.bottom]
    cmp  ecx,[Screen_Max_Y]
    jnz  dbcblimitlset212
    pop  ecx
    push 0
    jmp  dbcblimitlno212

  dbcblimitlset212:

    pop  ecx
    push 1

  dbcblimitlno212:

    cmp  [ScreenBPP],byte 24     ; 24 or 32 bpp ?
    jnz  pi32bit12

  pi24bit12:

  newpi12:

    push edi
    push ecx
    push ebx

      mov  edx,edi
      sub  edx,VGABasePtr
      mov  ebx,3
      div  ebx
      add  edx,[_display_data]
      mov  ebx,[CURRENT_TASK]
      mov  bh,[esp+4*3]

      np2412:

        cmp  bl,[edx]
        jnz  imp24no12
;        mov  eax,[esi]
        push    dword [esp+4*3+20]
        call    ebp
;        cmp  bh,0
;        jz   imp24yes12
;        call dbcplimit
;        jnz  imp24no12

     imp24yes12:

        push edi
        push eax
        mov  eax,edi
        sub  eax,VGABasePtr
        shr  eax,16
        call set_bank
        pop  eax
        and  edi,0xffff
        add  edi,VGABasePtr
        mov  [edi],ax
        shr  eax,16
        mov  [edi+2],al
        pop  edi

     imp24no12:

        inc  edx
;        add  esi,3
        add  edi,3
        dec  ecx
        jnz  np2412

      np24d12:

     pop  ebx
     pop  ecx
     pop  edi

    add  edi,[BytesPerScanLine]
    add  esi,[esp+32]
    cmp  ebp,putimage_get1bpp
    jz   .correct
    cmp  ebp,putimage_get4bpp
    jnz  @f
.correct:
    mov  eax,[esp+20]
    mov  byte[eax],80h
@@:
    dec  ebx
    jnz  newpi12

  nonewpi12:

        pop     eax edx ecx ebx eax edi esi
        xor     eax, eax
        ret


  pi32bit12:

   newpi3212:

    push edi
    push ecx
    push ebx

      mov  edx,edi
      sub  edx,VGABasePtr
      shr  edx,2
      add  edx, [_display_data]
      mov   ebx,[CURRENT_TASK]
      mov   bh,[esp+4*3]

      np3212:

        cmp  bl,[edx]
        jnz  imp32no12
;        mov  eax,[esi]
        push    dword [esp+4*3+20]
        call    ebp
;        cmp  bh,0
;        jz   imp32yes12
;        call dbcplimit
;        jnz  imp32no12

      imp32yes12:

        push edi
        push eax
        mov  eax,edi
        sub  eax,VGABasePtr
        shr  eax,16
        call set_bank
        pop  eax
        and  edi,0xffff
        mov  [edi+VGABasePtr],eax
        pop  edi

      imp32no12:

        inc  edx
;        add  esi,3
        add  edi,4
        dec  ecx
        jnz  np3212

      np32d12:

     pop  ebx
     pop  ecx
     pop  edi

    add   edi,[BytesPerScanLine]
    cmp   ebp,putimage_get1bpp
    jz    .correct
    cmp   ebp,putimage_get4bpp
    jnz   @f
.correct:
    mov   eax,[esp+20]
    mov   byte[eax],80h
@@:
    dec   ebx
    jnz   newpi3212

  nonewpi3212:

        pop     eax edx ecx ebx eax edi esi
        xor     eax, eax
        ret


vesa12_read_screen_pixel:

     and   eax,0x3FFFFF
     cmp   [ScreenBPP],byte 24      ; 24 or 32 bpp ?
     jz    v12rsp24
     mov   edi,eax
     shl   edi,2
     mov   eax,edi
     shr   eax,16
     call  set_bank
     and   edi,65535
     add   edi,VGABasePtr
     mov   eax,[edi]
     and   eax,0x00ffffff
     ret
  v12rsp24:

     imul  eax,3
     mov   edi,eax
     shr   eax,16
     call  set_bank
     and   edi,65535
     add   edi,VGABasePtr
     mov   eax,[edi]
     and   eax,0x00ffffff
     ret