Subversion Repositories Kolibri OS

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

;;                                                              ;;

;; Copyright (C) KolibriOS team 2004-2008. All rights reserved. ;;

;; Distributed under terms of the GNU General Public License    ;;

;;                                                              ;;

;;  VESA20.INC                                                  ;;

;;                                                              ;;

;;  Vesa 2.0 functions for MenuetOS                             ;;

;;                                                              ;;

;;  Copyright 2002 Ville Turjanmaa                              ;;

;;  Alexey, kgaz@crosswindws.net                                ;;

;;  - Voodoo compatible graphics                                ;;

;;  Juan M. Caravaca                                            ;;

;;  - Graphics optimimizations eg. drawline                     ;;

;;                                                              ;;

;;  See file COPYING for details                                ;;

;;                                                              ;;

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

$Revision: 1708 $

;*************************************************

; getpixel

;

; in:

; eax = x coordinate

; ebx = y coordinate

;

; ret:

; ecx = 00 RR GG BB

get_pixel:

     mov     ecx, [BytesPerScanLine]

     imul    ecx, ebx

     lea     ecx, [ecx+eax*4]		; ecx = x*4+(y*y multiplier)

     mov     ecx, [ecx+LFB_BASE]

     and     ecx, 0xffffff

     ret

;*************************************************

virtual at esp

 putimg:

   .real_sx	   dd ?

   .real_sy	   dd ?

   .image_sx	   dd ?

   .image_sy	   dd ?

   .image_cx	   dd ?

   .image_cy	   dd ?

   .pti 	   dd ?

   .abs_cx	   dd ?

   .abs_cy	   dd ?

   .line_increment dd ?

   .winmap_newline dd ?

   .screen_newline dd ?

   .stack_data = 4*12

   .edi 	dd	?

   .esi 	dd	?

   .ebp 	dd	?

   .esp 	dd	?

   .ebx 	dd	?

   .edx 	dd	?

   .ecx 	dd	?

   .eax 	dd	?

   .ret_addr	dd	?

   .arg_0	dd	?

end virtual

align 16

; ebx = pointer

; ecx = size [x|y]

; edx = coordinates [x|y]

; ebp = pointer to 'get' function

; esi = pointer to 'init' function

; edi = parameter for 'get' function

vesa20_putimage:

     pushad

     call    [_display.disable_mouse]

     sub     esp, putimg.stack_data

; save pointer to image

     mov     [putimg.pti], ebx

; unpack the size

     mov     eax, ecx

     and     ecx, 0xFFFF

     shr     eax, 16

     mov     [putimg.image_sx], eax

     mov     [putimg.image_sy], ecx

; unpack the coordinates

     mov     eax, edx

     and     edx, 0xFFFF

     shr     eax, 16

     mov     [putimg.image_cx], eax

     mov     [putimg.image_cy], edx

; calculate absolute (i.e. screen) coordinates

     mov     eax, [TASK_BASE]

     mov     ebx, [eax-twdw + WDATA.box.left]

     add     ebx, [putimg.image_cx]

     mov     [putimg.abs_cx], ebx

     mov     ebx, [eax-twdw + WDATA.box.top]

     add     ebx, [putimg.image_cy]

     mov     [putimg.abs_cy], ebx

; real_sx = MIN(wnd_sx-image_cx, image_sx);

     mov     ebx, [eax-twdw + WDATA.box.width] ; ebx = wnd_sx

     inc     ebx	; WDATA.box.width is one pixel less than real window x-size

     sub     ebx, [putimg.image_cx]

     ja      @f

     add     esp, putimg.stack_data

     popad

     ret

@@:

     cmp     ebx, [putimg.image_sx]

     jbe     .end_x

     mov     ebx, [putimg.image_sx]

.end_x:

     mov     [putimg.real_sx], ebx

; init real_sy

     mov     ebx, [eax-twdw + WDATA.box.height] ; ebx = wnd_sy

     inc     ebx

     sub     ebx, [putimg.image_cy]

     ja      @f

     add     esp, putimg.stack_data

     popad

     ret

@@:

     cmp     ebx, [putimg.image_sy]

     jbe     .end_y

     mov     ebx, [putimg.image_sy]

.end_y:

     mov     [putimg.real_sy], ebx

; line increment

     mov     eax, [putimg.image_sx]

     mov     ecx, [putimg.real_sx]

     sub     eax, ecx

     call    esi

     add     eax, [putimg.arg_0]

     mov     [putimg.line_increment], eax

; winmap new line increment

     mov     eax, [Screen_Max_X]

     inc     eax

     sub     eax, [putimg.real_sx]

     mov     [putimg.winmap_newline], eax

; screen new line increment

     mov     eax, [BytesPerScanLine]

     shl     ecx, 1

     shl     ecx, 1

     sub     eax, ecx

     mov     [putimg.screen_newline], eax

; pointer to image

     mov     esi, [putimg.pti]

; pointer to screen

     mov     edx, [putimg.abs_cy]

     imul    edx, [BytesPerScanLine]

     mov     eax, [putimg.abs_cx]

     shl     eax, 1

     shl     eax, 1

     add     edx, eax

; pointer to pixel map

     mov     eax, [putimg.abs_cy]

     imul    eax, [Screen_Max_X]

     add     eax, [putimg.abs_cy]

     add     eax, [putimg.abs_cx]

     add     eax, [_WinMapAddress]

     xchg    eax, ebp

; get process number

     mov     ebx, [CURRENT_TASK]

put_image_end_32:

     mov     edi, [putimg.real_sy]

align	4

.new_line:

     mov     ecx, [putimg.real_sx]

align	4

.new_x:

     push    [putimg.edi]

     mov     eax, [putimg.ebp+4]

     call    eax

     cmp     [ebp], bl

     jne     .skip

     mov     [LFB_BASE+edx], eax

.skip:

     add     edx, 4

     inc     ebp

     dec     ecx

     jnz     .new_x

     add     esi, [putimg.line_increment]

     add     edx, [putimg.screen_newline] ;[BytesPerScanLine]

     add     ebp, [putimg.winmap_newline] ;[Screen_Max_X]

     cmp     [putimg.ebp], putimage_get1bpp

     jz      .correct

     cmp     [putimg.ebp], putimage_get2bpp

     jz      .correct

     cmp     [putimg.ebp], putimage_get4bpp

     jnz     @f

.correct:

     mov     eax, [putimg.edi]

     mov     byte [eax], 80h

@@:

     dec     edi

     jnz     .new_line

.finish:

     add     esp, putimg.stack_data

     popad

     ret

;*************************************************

align 4

__sys_putpixel:

; eax = x coordinate

; ebx = y coordinate

; ecx = ?? RR GG BB    ; 0x01000000 negation

; edi = 0x00000001 force

     cmp   [Screen_Max_X], eax

     jb    .exit

     cmp   [Screen_Max_Y], ebx

     jb    .exit

.check_forced:

     test    edi,1		 ; force ?

     jnz     .checked

.not_forced:

     push     edx

     mov      edx,[_display.width]	   ; screen x size

     imul     edx, ebx

     add      edx, [_WinMapAddress]

     movzx    edx, byte [eax+edx]

     cmp      edx, [CURRENT_TASK]

     pop      edx

     jne      .exit

; OK to set pixel

.checked:

     push  ebx

     imul  ebx, [BytesPerScanLine]

     lea   ebx, [ebx+eax*4]

     test  ecx,0x01000000

     jz    .noneg

     mov   ecx, [LFB_BASE+ebx]

     not   ecx

     and   ecx, 0x01FFFFFF

.noneg:

     mov   [LFB_BASE+ebx], ecx

     pop   ebx

.exit:

     ret

align 4

put_pixel:	; left for compatibility with Vesa20_putpixel32

; eax = x

; ebx = y

     imul    ebx, [BytesPerScanLine]	 ; ebx = y * y multiplier

     lea     edi, [ebx+eax*4]  ; edi = x*4+(y*y multiplier)

;     mov     eax, [esp+32-8+4] ; eax = color

     mov     [LFB_BASE+edi], ecx

     ret

;*************************************************

;align 4

calculate_edi:

     mov     edi, ebx

     imul    edi, [Screen_Max_X]

     add     edi, ebx

     add     edi, eax

     ret

;*************************************************

; DRAWLINE

align 4

__sys_draw_line:

     call    [_display.disable_mouse]

; draw a line

; eax = HIWORD = x1

;       LOWORD = x2

; ebx = HIWORD = y1

;       LOWORD = y2

; ecx = color

; edi = force ?

	pusha

dl_x1 equ esp+20

dl_y1 equ esp+16

dl_x2 equ esp+12

dl_y2 equ esp+8

dl_dx equ esp+4

dl_dy equ esp+0

     xor     edx, edx	   ; clear edx

     xor     esi, esi	   ; unpack arguments

     xor     ebp, ebp

     mov     si, ax	   ; esi = x2

     mov     bp, bx	   ; ebp = y2

     shr     eax, 16	   ; eax = x1

     shr     ebx, 16	   ; ebx = y1

     push    eax	   ; save x1

     push    ebx	   ; save y1

     push    esi	   ; save x2

     push    ebp	   ; save y2

; checking x-axis...

     sub     esi, eax	   ; esi = x2-x1

     push    esi	   ; save y2-y1

     jl      .x2lx1	   ; is x2 less than x1 ?

     jg      .no_vline	   ; x1 > x2 ?

     mov     edx, ebp	   ; else (if x1=x2)

     call    vline

     push    edx    ; necessary to rightly restore stack frame at .exit

     jmp     .exit

.x2lx1:

     neg     esi	    ; get esi absolute value

.no_vline:

; checking y-axis...

     sub     ebp, ebx	    ; ebp = y2-y1

     push    ebp	    ; save y2-y1

     jl      .y2ly1	    ; is y2 less than y1 ?

     jg      .no_hline	    ; y1 > y2 ?

     mov     edx, [dl_x2]   ; else (if y1=y2)

     call    hline

     jmp     .exit

.y2ly1:

     neg     ebp	    ; get ebp absolute value

.no_hline:

     cmp     ebp, esi

     jle     .x_rules	    ; |y2-y1| < |x2-x1|  ?

     cmp     [dl_y2], ebx   ; make sure y1 is at the begining

     jge     .no_reverse1

     neg     dword [dl_dx]

     mov     edx, [dl_x2]

     mov     [dl_x2], eax

     mov     [dl_x1], edx

     mov     edx, [dl_y2]

     mov     [dl_y2], ebx

     mov     [dl_y1], edx

.no_reverse1:

     mov     eax, [dl_dx]

     cdq		    ; extend eax sing to edx

     shl     eax, 16	    ; using 16bit fix-point maths

     idiv    ebp	    ; eax = ((x2-x1)*65536)/(y2-y1)

     mov     edx, ebp	    ; edx = counter (number of pixels to draw)

     mov     ebp, 1 *65536  ; <<16   ; ebp = dy = 1.0

     mov     esi, eax	    ; esi = dx

     jmp     .y_rules

.x_rules:

     cmp     [dl_x2], eax    ; make sure x1 is at the begining

     jge     .no_reverse2

     neg     dword [dl_dy]

     mov     edx, [dl_x2]

     mov     [dl_x2], eax

     mov     [dl_x1], edx

     mov     edx, [dl_y2]

     mov     [dl_y2], ebx

     mov     [dl_y1], edx

.no_reverse2:

     xor     edx, edx

     mov     eax, [dl_dy]

     cdq		    ; extend eax sing to edx

     shl     eax, 16	    ; using 16bit fix-point maths

     idiv    esi	    ; eax = ((y2-y1)*65536)/(x2-x1)

     mov     edx, esi	    ; edx = counter (number of pixels to draw)

     mov     esi, 1 *65536  ;<< 16   ; esi = dx = 1.0

     mov     ebp, eax	    ; ebp = dy

.y_rules:

     mov     eax, [dl_x1]

     mov     ebx, [dl_y1]

     shl     eax, 16

     shl     ebx, 16

align 4

.draw:

     push    eax ebx

     shr     eax, 16

     shr     ebx, 16

     call    [putpixel]

     pop     ebx eax

     add     ebx, ebp	     ; y = y+dy

     add     eax, esi	     ; x = x+dx

     dec     edx

     jnz     .draw

; force last drawn pixel to be at (x2,y2)

     mov     eax, [dl_x2]

     mov     ebx, [dl_y2]

     call    [putpixel]

.exit:

     add     esp, 6*4

     popa

     call   [draw_pointer]

     ret

align 4

hline:

; ------------  draw a horizontal line -------------

; eax = x1

; edx = x2

; ebx = y

; ecx = color

; edi = force ?

     cmp     ebx, [Screen_Max_Y]

     jge     .out

     push    eax ebp esi ebx edx

     bt      ecx, 24			; color inversion check

     rcl     edi,1			; forced graphics check

     mov     ebp, [_display.width]	; ebp = screen co-ords base

     imul    ebp, ebx

     add     ebp, [_WinMapAddress]

     cmp     edx, eax		; to make sure x2 > x1

     jge     @f

     xchg    eax, edx

@@:

     cmp     eax, [Screen_Max_X]

     jge     .exit

     imul    ebx, [BytesPerScanLine]

     add     ebx, LFB_BASE

     cmp     edx, [Screen_Max_X]	; last check

     jb      .draw

     mov     edx, [Screen_Max_X]

.draw:	; -- the line ---

     jmp     dword [hline.drawtable + edi*4]	; a coolhack (C) Serge

align 4

.invert_color:

     mov     ecx, [ebx+eax*4]

     xor     ecx, 0x00FFFFFF

     or      ecx, 0x01000000		; keep bit[24] high !

align 4

.check_overlap:

     movzx   esi, byte [ebp+eax]	; check whether the line covered by other windows

     cmp     esi, [CURRENT_TASK]

     je      .putpixel

     jmp     .nextpixel

align 4

.invert_force:

     mov     ecx, [ebx+eax*4]

     xor     ecx, 0x00FFFFFF

     or      ecx, 0x01000000		; keep bit[24] high !

align 4

.putpixel:

     mov     [ebx+eax*4], ecx

align 4

.nextpixel:

     inc     eax

     cmp     eax, edx

     ja     .exit

     jmp     dword [hline.drawtable + edi*4]	; close the loop

.exit:

     shr     edi, 1			; restore the 'force' bit

     pop     edx ebx esi ebp eax

.out:

     ret

align 4

.drawtable:

dd	.check_overlap  ; general case

dd	.invert_color

dd	.putpixel	; force to draw it

dd	.invert_force

align 4

vline:

; ---------  draw a vertical line  ------------

; eax = x

; ebx = y1

; edx = y2

; ecx = color

; edi = force ?

     cmp     eax, [Screen_Max_X]

     jge     .out

     push    eax ebp esi ebx edx

     mov     ebp, [_display.width]	; ebp = screen co-ords base

     imul    ebp, ebx

     add     ebp, [_WinMapAddress]

     add     ebp, eax

     cmp     edx, ebx			; to make sure y2 > y1

     jge     @f

     xchg    ebx, edx

@@:

     cmp     ebx, [Screen_Max_Y]

     jge     .exit

     push    ebx

     imul    ebx, [BytesPerScanLine]

     shl     eax, 1

     shl     eax, 1

     add     eax, ebx

     add     eax, LFB_BASE

     pop     ebx        		; restore ebx = y1

     cmp     edx, [Screen_Max_Y]	; the last check

     jb     .draw

     mov     edx, [Screen_Max_Y]	; to prevent off-screen drawing

.draw:

     jmp     dword [vline.drawtable + edi*4]

align 4

.invert_color:

     mov     ecx, [eax]

     xor     ecx, 0x00FFFFFF

     or      ecx, 0x01000000

align 4

.check_overlap:

     movzx   esi, byte [ebp]

     cmp     esi, [CURRENT_TASK]

     je      .putpixel

     jmp     .nextpixel

align 4

.invert_force:

     mov     ecx, [eax]

     xor     ecx, 0x00FFFFFF

     or      ecx, 0x01000000

align 4

.putpixel:

     mov     [eax], ecx

align 4

.nextpixel:

     add     eax, [BytesPerScanLine]

     add     ebp, [_display.width]

     inc     ebx

     cmp     ebx, edx

     ja     .exit

     jmp     dword [vline.drawtable + edi*4]

.exit:

     shr     edi, 1

     pop     edx ebx esi ebp eax

.out:

     ret

align 4

.drawtable:

dd	.check_overlap  ; general case

dd	.invert_color

dd	.putpixel	; force to draw it

dd	.invert_force

;*************************************************

virtual at esp

drbar:

     .bar_sx	   dd ?

     .bar_sy	   dd ?

     .bar_cx	   dd ?

     .bar_cy	   dd ?

     .abs_cx	   dd ?

     .abs_cy	   dd ?

     .real_sx	   dd ?

     .real_sy	   dd ?

     .color	   dd ?

     .line_inc_scr dd ?

     .line_inc_map dd ?

     .stack_data = 4*11

end virtual

align 4

; eax   cx

; ebx   cy

; ecx   xe

; edx   ye

; edi   color

vesa20_drawbar:

     pushad

     call    [_display.disable_mouse]

     sub     esp, drbar.stack_data

     mov     [drbar.color], edi

     sub     edx, ebx

     jle     .exit

     sub     ecx, eax

     jle     .exit

     mov     [drbar.bar_sy], edx

     mov     [drbar.bar_sx], ecx

     mov     [drbar.bar_cx], eax

     mov     [drbar.bar_cy], ebx

     mov     edi, [TASK_BASE]

     add     eax, [edi-twdw + WDATA.box.left] ; win_cx

     add     ebx, [edi-twdw + WDATA.box.top] ; win_cy

     mov     [drbar.abs_cx], eax

     mov     [drbar.abs_cy], ebx

; real_sx = MIN(wnd_sx-bar_cx, bar_sx);

     mov     ebx, [edi-twdw + WDATA.box.width] ; ebx = wnd_sx

; note that WDATA.box.width is one pixel less than real window x-size

     inc     ebx

     sub     ebx, [drbar.bar_cx]

     ja      @f

.exit:

     add     esp, drbar.stack_data

     popad

     xor     eax, eax

     inc     eax

     ret

@@:

     cmp     ebx, [drbar.bar_sx]

     jbe     .end_x

     mov     ebx, [drbar.bar_sx]

.end_x:

     mov     [drbar.real_sx], ebx

; real_sy = MIN(wnd_sy-bar_cy, bar_sy);

     mov     ebx, [edi-twdw + WDATA.box.height] ; ebx = wnd_sy

     inc     ebx

     sub     ebx, [drbar.bar_cy]

     ja      @f

     add     esp, drbar.stack_data

     popad

     xor     eax, eax

     inc     eax

     ret

@@:

     cmp     ebx, [drbar.bar_sy]

     jbe     .end_y

     mov     ebx, [drbar.bar_sy]

.end_y:

     mov     [drbar.real_sy], ebx

; line_inc_map

     mov     eax, [Screen_Max_X]

     sub     eax, [drbar.real_sx]

     inc     eax

     mov     [drbar.line_inc_map], eax

; line_inc_scr

     mov     eax, [drbar.real_sx]

     shl     eax, 1

     shl     eax, 1

     neg     eax

     add     eax, [BytesPerScanLine]

     mov     [drbar.line_inc_scr], eax

; pointer to screen

     mov     edx, [drbar.abs_cy]

     imul    edx, [BytesPerScanLine]

     mov     eax, [drbar.abs_cx]

     shl     eax, 1

     shl     eax, 1

     add     edx, eax

; pointer to pixel map

     mov     eax, [drbar.abs_cy]

     imul    eax, [Screen_Max_X]

     add     eax, [drbar.abs_cy]

     add     eax, [drbar.abs_cx]

     add     eax, [_WinMapAddress]

     xchg    eax, ebp

; get process number

     mov     ebx, [CURRENT_TASK]

draw_bar_end_32:

; eax - color high   RRGG

; bl - process num

; bh - color low    BB

; ecx - temp

; edx - pointer to screen

; esi - counter

; edi - counter

     mov     eax, [drbar.color]    ;; BBGGRR00

     mov     esi, [drbar.real_sy]

align	4

.new_y:

     mov     edi, [drbar.real_sx]

align	4

.new_x:

     cmp     byte [ebp], bl

     jne     .skip

     mov     [LFB_BASE+edx], eax

.skip:

; add pixel

     add     edx, 4

     inc     ebp

     dec     edi

     jnz     .new_x

; add line

     add     edx, [drbar.line_inc_scr]

     add     ebp, [drbar.line_inc_map]

;  drawing gradient bars

     test    eax, 0x80000000

     jz      @f

     test    al, al

     jz      @f

     dec     al

@@:

; 

     dec     esi

     jnz     .new_y

     add     esp, drbar.stack_data

     popad

     xor     eax, eax

     ret

align 4

vesa20_drawbackground_tiled:

	call	[_display.disable_mouse]

	pushad

; External loop for all y from start to end

	mov	ebx, [draw_data+32+RECT.top]	; y start

dp2:

	mov	ebp, [draw_data+32+RECT.left]	; x start

; 1) Calculate pointers in WinMapAddress (does pixel belong to OS thread?) [ebp]

;                       and LFB data (output for our function) [edi]

	mov	eax, [BytesPerScanLine]

	mul	ebx

	xchg	ebp, eax

	add	ebp, eax

	add	ebp, eax

	add	ebp, eax

	add	ebp, eax

	add	ebp, LFB_BASE

; ebp:=Y*BytesPerScanLine+X*BytesPerPixel+AddrLFB

	call	calculate_edi

	xchg	edi, ebp

	add ebp, [_WinMapAddress]

; Now eax=x, ebx=y, edi->output, ebp=offset in WinMapAddress

; 2) Calculate offset in background memory block

	push	eax

	xor	edx, edx

	mov	eax, ebx

	div	dword [BgrDataHeight]	; edx := y mod BgrDataHeight

	pop	eax

	push	eax

	mov	ecx, [BgrDataWidth]

	mov	esi, edx

	imul	esi, ecx		; esi := (y mod BgrDataHeight) * BgrDataWidth

	xor	edx, edx

	div	ecx		; edx := x mod BgrDataWidth

	sub	ecx, edx

	add	esi, edx	; esi := (y mod BgrDataHeight)*BgrDataWidth + (x mod BgrDataWidth)

	pop	eax

	lea	esi, [esi*3]

	add	esi, [img_background]

	xor	edx, edx

	inc	edx

; 3) Loop through redraw rectangle and copy background data

; Registers meaning:

; eax = x, ebx = y (screen coordinates)

; ecx = deltax - number of pixels left in current tile block

; edx = 1

; esi -> bgr memory, edi -> output

; ebp = offset in WinMapAddress

dp3:

	cmp	[ebp], dl

	jnz	nbgp

	movsb

	movsb

	movsb

	jmp	@f

nbgp:

	add	esi, 3

	add	edi, 3

@@:

	inc	edi   	 	; +1 for 32 bpp

	add	ebp, edx

	add	eax, edx

	cmp	eax, [draw_data+32+RECT.right]

	ja	dp4

	sub	ecx, edx

	jnz	dp3

; next tile block on x-axis

	mov	ecx, [BgrDataWidth]

	sub	esi, ecx

	sub	esi, ecx

	sub	esi, ecx

	jmp	dp3

dp4:

; next scan line

	inc	ebx

	cmp	ebx, [draw_data+32+RECT.bottom]

	jbe	dp2

	popad

	ret

; ----------

vesa20_drawbackground_stretch:

	call	[_display.disable_mouse]

	pushad

; Helper variables

; calculate 2^32*(BgrDataWidth-1) mod (ScreenWidth-1)

	mov	eax, [BgrDataWidth]

	dec	eax

	xor	edx, edx

	div	dword [Screen_Max_X]

	push	eax	; high

	xor	eax, eax

	div	dword [Screen_Max_X]

	push	eax	; low

; the same for height

	mov	eax, [BgrDataHeight]

	dec	eax

	xor	edx, edx

	div	dword [Screen_Max_Y]

	push	eax	; high

	xor	eax, eax

	div	dword [Screen_Max_Y]

	push	eax	; low

; External loop for all y from start to end

	mov	ebx, [draw_data+32+RECT.top]	; y start

	mov	ebp, [draw_data+32+RECT.left]	; x start

; 1) Calculate pointers in WinMapAddress (does pixel belong to OS thread?) [ebp]

;                       and LFB data (output for our function) [edi]

	mov	eax, [BytesPerScanLine]

	mul	ebx

	xchg	ebp, eax

	add	ebp, eax

	add	ebp, eax

	add	ebp, eax

	add	ebp, eax

; ebp:=Y*BytesPerScanLine+X*BytesPerPixel+AddrLFB

	call	calculate_edi

	xchg	edi, ebp

; Now eax=x, ebx=y, edi->output, ebp=offset in WinMapAddress

	push	ebx

	push	eax

; 2) Calculate offset in background memory block

	mov	eax, ebx

	imul	ebx, dword [esp+12]

	mul	dword [esp+8]

	add	edx, ebx	; edx:eax = y * 2^32*(BgrDataHeight-1)/(ScreenHeight-1)

	mov	esi, edx

	imul	esi, [BgrDataWidth]

	push	edx

	push	eax

	mov	eax, [esp+8]

	mul	dword [esp+28]

	push	eax

	mov	eax, [esp+12]

	mul	dword [esp+28]

	add	[esp], edx

	pop	edx		; edx:eax = x * 2^32*(BgrDataWidth-1)/(ScreenWidth-1)

	add	esi, edx

	lea	esi, [esi*3]

	add	esi, [img_background]

	push	eax

	push	edx

	push	esi

; 3) Smooth horizontal

bgr_resmooth0:

	mov	ecx, [esp+8]

	mov	edx, [esp+4]

	mov	esi, [esp]

	push	edi

	mov	edi, bgr_cur_line

	call	smooth_line

bgr_resmooth1:

	mov	eax, [esp+16+4]

	inc	eax

	cmp	eax, [BgrDataHeight]

	jae	bgr.no2nd

	mov	ecx, [esp+8+4]

	mov	edx, [esp+4+4]

	mov	esi, [esp+4]

	add	esi, [BgrDataWidth]

	add	esi, [BgrDataWidth]

	add	esi, [BgrDataWidth]

	mov	edi, bgr_next_line

	call	smooth_line

bgr.no2nd:

	pop	edi

sdp3:

	xor	esi, esi

	mov	ecx, [esp+12]

; 4) Loop through redraw rectangle and copy background data

; Registers meaning:

; esi = offset in current line, edi -> output

; ebp = offset in WinMapAddress

; dword [esp] = offset in bgr data

; qword [esp+4] = x * 2^32 * (BgrDataWidth-1) / (ScreenWidth-1)

; qword [esp+12] = y * 2^32 * (BgrDataHeight-1) / (ScreenHeight-1)

; dword [esp+20] = x

; dword [esp+24] = y

; precalculated constants:

; qword [esp+28] = 2^32*(BgrDataHeight-1)/(ScreenHeight-1)

; qword [esp+36] = 2^32*(BgrDataWidth-1)/(ScreenWidth-1)

sdp3a:

	mov eax, [_WinMapAddress]

	cmp	[ebp+eax], byte 1

	jnz	snbgp

	mov	eax, [bgr_cur_line+esi]

	test	ecx, ecx

	jz	.novert

	mov	ebx, [bgr_next_line+esi]

	call	[overlapping_of_points_ptr]

.novert:

	mov	[LFB_BASE+edi], ax

	shr	eax, 16

	mov	[LFB_BASE+edi+2], al

snbgp:

	add	edi, 4

	inc	ebp

	mov	eax, [esp+20]

	inc	eax

	mov	[esp+20], eax

	add	esi, 4

	cmp	eax, [draw_data+32+RECT.right]

	jbe	sdp3a

sdp4:

; next y

	mov	ebx, [esp+24]

	inc	ebx

	mov	[esp+24], ebx

	cmp	ebx, [draw_data+32+RECT.bottom]

	ja	sdpdone

; advance edi, ebp to next scan line

	sub	eax, [draw_data+32+RECT.left]

	sub	ebp, eax

	add	ebp, [Screen_Max_X]

	inc	ebp

	sub	edi, eax

	sub	edi, eax

	sub	edi, eax

	sub	edi, eax

	add	edi, [BytesPerScanLine]

; restore ecx,edx; advance esi to next background line

	mov	eax, [esp+28]

	mov	ebx, [esp+32]

	add	[esp+12], eax

	mov	eax, [esp+16]

	adc	[esp+16], ebx

	sub	eax, [esp+16]

	mov	ebx, eax

	lea	eax, [eax*3]

	imul	eax, [BgrDataWidth]

	sub	[esp], eax

	mov	eax, [draw_data+32+RECT.left]

	mov	[esp+20], eax

	test	ebx, ebx

	jz	sdp3

	cmp	ebx, -1

	jnz	bgr_resmooth0

	push	edi

	mov	esi, bgr_next_line

	mov	edi, bgr_cur_line

	mov	ecx, [Screen_Max_X]

	inc	ecx

	rep	movsd

	jmp	bgr_resmooth1

sdpdone:

	add	esp, 44

	popad

	ret

uglobal

align 4

bgr_cur_line	rd	1920	; maximum width of screen

bgr_next_line	rd	1920

endg

smooth_line:

	mov	al, [esi+2]

	shl	eax, 16

	mov	ax, [esi]

	test	ecx, ecx

	jz	@f

	mov	ebx, [esi+2]

	shr	ebx, 8

	call	[overlapping_of_points_ptr]

@@:

	stosd

	mov	eax, [esp+20+8]

	inc	eax

	mov	[esp+20+8], eax

	cmp	eax, [draw_data+32+RECT.right]

	ja	@f

	add	ecx, [esp+36+8]

	mov	eax, edx

	adc	edx, [esp+40+8]

	sub	eax, edx

	lea	eax, [eax*3]

	sub	esi, eax

	jmp	smooth_line

@@:

	mov	eax, [draw_data+32+RECT.left]

	mov	[esp+20+8], eax

	ret

align 16

overlapping_of_points:

	push	ecx edx

	mov	edx, eax

	push	esi

	shr	ecx, 26

	mov	esi, ecx

	mov	ecx, ebx

	shl	esi, 9

	movzx	ebx, dl

	movzx	eax, cl

	sub	eax, ebx

	movzx	ebx, dh

	add	dl, [BgrAuxTable+(eax+0x100)+esi]

	movzx	eax, ch

	sub	eax, ebx

	add	dh, [BgrAuxTable+(eax+0x100)+esi]

	ror	ecx, 16

	ror	edx, 16

	movzx	eax, cl

	movzx	ebx, dl

	sub	eax, ebx

	add	dl, [BgrAuxTable+(eax+0x100)+esi]

	pop	esi

	mov	eax, edx

	pop	edx

	ror	eax, 16

	pop	ecx

	ret

iglobal

align 4

overlapping_of_points_ptr	dd	overlapping_of_points

endg

init_background:

	mov	edi, BgrAuxTable

	xor	edx, edx

.loop2:

	mov	eax, edx

	shl	eax, 8

	neg	eax

	mov	ecx, 0x200

.loop1:

	mov	byte [edi], ah

	inc	edi

	add	eax, edx

	loop	.loop1

	add	dl, 4

	jnz	.loop2

	test	byte [cpu_caps+(CAPS_MMX/8)], 1 shl (CAPS_MMX mod 8)

	jz	@f

	mov	[overlapping_of_points_ptr], overlapping_of_points_mmx

@@:

	ret

align 16

overlapping_of_points_mmx:

        movd    mm0, eax

        movd    mm4, eax

        movd    mm1, ebx

        pxor    mm2, mm2

        punpcklbw mm0, mm2

        punpcklbw mm1, mm2

        psubw   mm1, mm0

        movd    mm3, ecx

        psrld   mm3, 24

        packuswb mm3, mm3

        packuswb mm3, mm3

        pmullw  mm1, mm3

        psrlw   mm1, 8

        packuswb mm1, mm2

        paddb   mm4, mm1

        movd    eax, mm4

        ret

diff16 "VESA2 code end ",0,$

diff16 "VESA2 code size",get_pixel,$