WebSVN – Kolibri OS – Diff – /kernel/branches/Kolibri-acpi/blkdev/ide_cache.inc


;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;;                                                              ;;
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
;; Distributed under terms of the GNU General Public License    ;;
;;                                                              ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 
;**************************************************************************
;
;   [cache_ide[X]_pointer]
;   or [cache_ide[X]_data_pointer]  first entry in cache list
;
;            +0   - lba sector
;            +4   - state of cache sector
;                   0 = empty
;                   1 = used for read  ( same as in hd )
;                   2 = used for write ( differs from hd )
;
;  [cache_ide[X]_system_data]
;  or [cache_ide[x]_appl_data] - cache entries
;
;**************************************************************************
 
$Revision: 2987 $
 
 
align 4
write_cache:
;-----------------------------------------------------------
; write all changed sectors to disk
;-----------------------------------------------------------
    push  eax ecx edx esi edi
 
    ; write difference ( 2 ) from cache to hd
    call  calculate_cache
        add     esi, 8
        mov     edi, 1
write_cache_more:
        cmp     dword [esi+4], 2; if cache slot is not different
    jne   .write_chain
        mov     dword [esi+4], 1; same as in hd
        mov     eax, [esi]      ; eax = sector to write
        cmp     eax, [PARTITION_START]
    jb	  danger
        cmp     eax, [PARTITION_END]
    ja	  danger
        cmp     [hdpos], 0x80
        jae     @f
; DMA write is permitted only if [allow_dma_access]=1
	cmp	[allow_dma_access], 2
	jae	.nodma
	cmp	[dma_hdd], 1
	jnz	.nodma
@@:
; ¡ê¥¤¨­ï¥¬ § ¯¨áì æ¥¯®çª¨ ¯®á«¥¤®¢ â¥«ì­ëå á¥ªâ®à®¢ ¢ ®¤­® ®¡à é¥­¨¥ ª ¤¨áªã
	cmp	ecx, 1
	jz	.nonext
	cmp	dword [esi+8+4], 2
	jnz	.nonext
	push	eax
	inc	eax
	cmp	eax, [esi+8]
	pop	eax
	jnz	.nonext
	cmp	[cache_chain_started], 1
	jz	@f
	mov	[cache_chain_started], 1
	mov	[cache_chain_size], 0
	mov	[cache_chain_pos], edi
	mov	[cache_chain_ptr], esi
@@:
	inc	[cache_chain_size]
	cmp	[cache_chain_size], 16
	jnz	.continue
	jmp	.write_chain
.nonext:
	call	flush_cache_chain
	mov	[cache_chain_size], 1
	mov	[cache_chain_ptr], esi
	call	write_cache_sector
	jmp	.continue
.nodma:
	call	cache_write_pio
.write_chain:
	call	flush_cache_chain
.continue:
danger:
        add     esi, 8
    inc   edi
    dec   ecx
    jnz   write_cache_more
	call	flush_cache_chain
 return_02:
    pop   edi esi edx ecx eax
    ret
 
flush_cache_chain:
	cmp	[cache_chain_started], 0
	jz	@f
	call	write_cache_chain
	mov	[cache_chain_started], 0
@@:
	ret
;--------------------------------------------------------------------
align 4
find_empty_slot:
;-----------------------------------------------------------
; find empty or read slot, flush cache if next 10% is used by write
; output : edi = cache slot
;-----------------------------------------------------------
;    push  ecx esi
 
search_again:
    call  calculate_cache_3
        shr     ecx, 3
search_for_empty:
    inc   edi
    call  calculate_cache_4
    jbe   inside_cache
        mov     edi, 1
inside_cache:
    push   esi
    call  calculate_cache_1
        cmp     dword [edi*8+esi+4], 2
    pop   esi
    jb	  found_slot			; it's empty or read
    dec   ecx
    jnz   search_for_empty
    call  write_cache			; no empty slots found, write all
        cmp     [hd_error], 0
    jne   found_slot_access_denied
    jmp   search_again			; and start again
found_slot:
    call  calculate_cache_5
found_slot_access_denied:
    ret
;--------------------------------------------------------------------
align 4
clear_hd_cache:
 
 
    ret
;--------------------------------------------------------------------
align 4
calculate_cache:
;    mov   ecx,cache_max         ; entries in cache
;    mov   esi,HD_CACHE+8
 
; 1 - IDE0 ... 4 - IDE3
.ide0:
        cmp     [hdpos], 1
    jne    .ide1
        cmp     [hdd_appl_data], 0
    jne    .ide0_appl_data
        mov     ecx, [cache_ide0_system_sad_size]
        mov     esi, [cache_ide0_pointer]
    ret
.ide0_appl_data:
        mov     ecx, [cache_ide0_appl_sad_size]
        mov     esi, [cache_ide0_data_pointer]
    ret
.ide1:
        cmp     [hdpos], 2
    jne    .ide2
        cmp     [hdd_appl_data], 0
    jne    .ide1_appl_data
        mov     ecx, [cache_ide1_system_sad_size]
        mov     esi, [cache_ide1_pointer]
    ret
.ide1_appl_data:
        mov     ecx, [cache_ide1_appl_sad_size]
        mov     esi, [cache_ide1_data_pointer]
    ret
.ide2:
        cmp     [hdpos], 3
    jne    .ide3
        cmp     [hdd_appl_data], 0
    jne    .ide2_appl_data
        mov     ecx, [cache_ide2_system_sad_size]
        mov     esi, [cache_ide2_pointer]
    ret
.ide2_appl_data:
        mov     ecx, [cache_ide2_appl_sad_size]
        mov     esi, [cache_ide2_data_pointer]
    ret
.ide3:
        cmp     [hdpos], 4
    jne    .noide
        cmp     [hdd_appl_data], 0
    jne    .ide3_appl_data
        mov     ecx, [cache_ide3_system_sad_size]
        mov     esi, [cache_ide3_pointer]
    ret
.ide3_appl_data:
        mov     ecx, [cache_ide3_appl_sad_size]
        mov     esi, [cache_ide3_data_pointer]
    ret
.noide:
    push   eax
        mov     eax, [hdpos]
        sub     eax, 80h
    cmp    byte [BiosDisksData+eax*4+2], -1
    jz     @f
        movzx   eax, byte [BiosDisksData+eax*4+2]
        imul    eax, cache_ide1-cache_ide0
        add     eax, cache_ide0
    jmp    .get
@@:
        imul    eax, cache_ide1-cache_ide0
        add     eax, BiosDiskCaches
.get:
        cmp     [hdd_appl_data], 0
    jne    .bd_appl_data
        mov     ecx, [cache_ide0_system_sad_size-cache_ide0+eax]
        mov     esi, [cache_ide0_pointer-cache_ide0+eax]
    pop    eax
    ret
.bd_appl_data:
        mov     ecx, [cache_ide0_appl_sad_size-cache_ide0+eax]
        mov     esi, [cache_ide0_data_pointer-cache_ide0+eax]
    pop    eax
    ret
;--------------------------------------------------------------------
align 4
calculate_cache_1:
;    lea   esi,[edi*8+HD_CACHE]
; 1 - IDE0 ... 4 - IDE3
.ide0:
        cmp     [hdpos], 1
    jne    .ide1
        cmp     [hdd_appl_data], 0
    jne    .ide0_appl_data
        mov     esi, [cache_ide0_pointer]
    ret
.ide0_appl_data:
        mov     esi, [cache_ide0_data_pointer]
    ret
.ide1:
        cmp     [hdpos], 2
    jne    .ide2
        cmp     [hdd_appl_data], 0
    jne    .ide1_appl_data
        mov     esi, [cache_ide1_pointer]
    ret
.ide1_appl_data:
        mov     esi, [cache_ide1_data_pointer]
    ret
.ide2:
        cmp     [hdpos], 3
    jne    .ide3
        cmp     [hdd_appl_data], 0
    jne    .ide2_appl_data
        mov     esi, [cache_ide2_pointer]
    ret
.ide2_appl_data:
        mov     esi, [cache_ide2_data_pointer]
    ret
.ide3:
        cmp     [hdpos], 4
    jne    .noide
        cmp     [hdd_appl_data], 0
    jne    .ide3_appl_data
        mov     esi, [cache_ide3_pointer]
    ret
.ide3_appl_data:
        mov     esi, [cache_ide3_data_pointer]
    ret
.noide:
    push   eax
        mov     eax, [hdpos]
        sub     eax, 80h
    cmp    byte [BiosDisksData+eax*4+2], -1
    jz     @f
        movzx   eax, byte [BiosDisksData+eax*4+2]
        imul    eax, cache_ide1-cache_ide0
        add     eax, cache_ide0
    jmp    .get
@@:
        imul    eax, cache_ide1-cache_ide0
        add     eax, BiosDiskCaches
.get:
        cmp     [hdd_appl_data], 0
    jne    .bd_appl_data
        mov     esi, [cache_ide0_pointer-cache_ide0+eax]
    pop    eax
    ret
.bd_appl_data:
        mov     esi, [cache_ide0_data_pointer-cache_ide0+eax]
    pop    eax
    ret
 
;--------------------------------------------------------------------
align 4
calculate_cache_2:
;    add   esi,HD_CACHE+65536
; 1 - IDE0 ... 4 - IDE3
.ide0:
        cmp     [hdpos], 1
    jne    .ide1
        cmp     [hdd_appl_data], 0
    jne    .ide0_appl_data
        mov     eax, [cache_ide0_system_data]
    ret
.ide0_appl_data:
        mov     eax, [cache_ide0_appl_data]
    ret
.ide1:
        cmp     [hdpos], 2
    jne    .ide2
        cmp     [hdd_appl_data], 0
    jne    .ide1_appl_data
        mov     eax, [cache_ide1_system_data]
    ret
.ide1_appl_data:
        mov     eax, [cache_ide1_appl_data]
    ret
.ide2:
        cmp     [hdpos], 3
    jne    .ide3
        cmp     [hdd_appl_data], 0
    jne    .ide2_appl_data
        mov     eax, [cache_ide2_system_data]
    ret
.ide2_appl_data:
        mov     eax, [cache_ide2_appl_data]
    ret
.ide3:
        cmp     [hdpos], 4
    jne    .noide
        cmp     [hdd_appl_data], 0
    jne    .ide3_appl_data
        mov     eax, [cache_ide3_system_data]
    ret
.ide3_appl_data:
        mov     eax, [cache_ide3_appl_data]
    ret
.noide:
        mov     eax, [hdpos]
        sub     eax, 80h
    cmp    byte [BiosDisksData+eax*4+2], -1
    jz     @f
        movzx   eax, byte [BiosDisksData+eax*4+2]
        imul    eax, cache_ide1-cache_ide0
        add     eax, cache_ide0
    jmp    .get
@@:
        imul    eax, cache_ide1-cache_ide0
        add     eax, BiosDiskCaches
.get:
        cmp     [hdd_appl_data], 0
    jne    .bd_appl_data
        mov     eax, [cache_ide0_system_data-cache_ide0+eax]
    ret
.bd_appl_data:
        mov     eax, [cache_ide0_appl_data-cache_ide0+eax]
    ret
;--------------------------------------------------------------------
align 4
calculate_cache_3:
;    mov   ecx,cache_max*10/100
;    mov   edi,[cache_search_start]
 
; 1 - IDE0 ... 4 - IDE3
.ide0:
        cmp     [hdpos], 1
    jne    .ide1
        cmp     [hdd_appl_data], 0
    jne    .ide0_appl_data
        mov     ecx, [cache_ide0_system_sad_size]
        mov     edi, [cache_ide0_search_start]
    ret
.ide0_appl_data:
        mov     ecx, [cache_ide0_appl_sad_size]
        mov     edi, [cache_ide0_appl_search_start]
    ret
.ide1:
        cmp     [hdpos], 2
    jne    .ide2
        cmp     [hdd_appl_data], 0
    jne    .ide1_appl_data
        mov     ecx, [cache_ide1_system_sad_size]
        mov     edi, [cache_ide1_search_start]
    ret
.ide1_appl_data:
        mov     ecx, [cache_ide1_appl_sad_size]
        mov     edi, [cache_ide1_appl_search_start]
    ret
.ide2:
        cmp     [hdpos], 3
    jne    .ide3
        cmp     [hdd_appl_data], 0
    jne    .ide2_appl_data
        mov     ecx, [cache_ide2_system_sad_size]
        mov     edi, [cache_ide2_search_start]
    ret
.ide2_appl_data:
        mov     ecx, [cache_ide2_appl_sad_size]
        mov     edi, [cache_ide2_appl_search_start]
    ret
.ide3:
        cmp     [hdpos], 4
    jne    .noide
        cmp     [hdd_appl_data], 0
    jne    .ide3_appl_data
        mov     ecx, [cache_ide3_system_sad_size]
        mov     edi, [cache_ide3_search_start]
    ret
.ide3_appl_data:
        mov     ecx, [cache_ide3_appl_sad_size]
        mov     edi, [cache_ide3_appl_search_start]
    ret
.noide:
    push   eax
        mov     eax, [hdpos]
        sub     eax, 80h
    cmp    byte [BiosDisksData+eax*4+2], -1
    jz     @f
        movzx   eax, byte [BiosDisksData+eax*4+2]
        imul    eax, cache_ide1-cache_ide0
        add     eax, cache_ide0
    jmp    .get
@@:
        imul    eax, cache_ide1-cache_ide0
        add     eax, BiosDiskCaches
.get:
        cmp     [hdd_appl_data], 0
    jne    .bd_appl_data
        mov     ecx, [cache_ide0_system_sad_size-cache_ide0+eax]
        mov     edi, [cache_ide0_search_start-cache_ide0+eax]
    pop    eax
    ret
.bd_appl_data:
        mov     ecx, [cache_ide0_appl_sad_size-cache_ide0+eax]
        mov     edi, [cache_ide0_appl_search_start-cache_ide0+eax]
    pop    eax
    ret
;--------------------------------------------------------------------
align 4
calculate_cache_4:
;    cmp   edi,cache_max
; 1 - IDE0 ... 4 - IDE3
.ide0:
        cmp     [hdpos], 1
    jne    .ide1
        cmp     [hdd_appl_data], 0
    jne    .ide0_appl_data
        cmp     edi, [cache_ide0_system_sad_size]
    ret
.ide0_appl_data:
        cmp     edi, [cache_ide0_appl_sad_size]
    ret
.ide1:
        cmp     [hdpos], 2
    jne    .ide2
        cmp     [hdd_appl_data], 0
    jne    .ide1_appl_data
        cmp     edi, [cache_ide1_system_sad_size]
    ret
.ide1_appl_data:
        cmp     edi, [cache_ide1_appl_sad_size]
    ret
.ide2:
        cmp     [hdpos], 3
    jne    .ide3
        cmp     [hdd_appl_data], 0
    jne    .ide2_appl_data
        cmp     edi, [cache_ide2_system_sad_size]
    ret
.ide2_appl_data:
        cmp     edi, [cache_ide2_appl_sad_size]
    ret
.ide3:
        cmp     [hdpos], 4
    jne    .noide
        cmp     [hdd_appl_data], 0
    jne    .ide3_appl_data
        cmp     edi, [cache_ide3_system_sad_size]
    ret
.ide3_appl_data:
        cmp     edi, [cache_ide3_appl_sad_size]
    ret
.noide:
    push   eax
        mov     eax, [hdpos]
        sub     eax, 80h
    cmp    byte [BiosDisksData+eax*4+2], -1
    jz     @f
        movzx   eax, byte [BiosDisksData+eax*4+2]
        imul    eax, cache_ide1-cache_ide0
        add     eax, cache_ide0
    jmp    .get
@@:
        imul    eax, cache_ide1-cache_ide0
        add     eax, BiosDiskCaches
.get:
        cmp     [hdd_appl_data], 0
    jne    .bd_appl_data
        cmp     edi, [cache_ide0_system_sad_size-cache_ide0+eax]
    pop    eax
    ret
.bd_appl_data:
        cmp     edi, [cache_ide0_appl_sad_size-cache_ide0+eax]
    pop    eax
    ret
 
;--------------------------------------------------------------------
align 4
calculate_cache_5:
;    mov   [cache_search_start],edi
; 1 - IDE0 ... 4 - IDE3
.ide0:
        cmp     [hdpos], 1
    jne    .ide1
        cmp     [hdd_appl_data], 0
    jne    .ide0_appl_data
        mov     [cache_ide0_search_start], edi
    ret
.ide0_appl_data:
        mov     [cache_ide0_appl_search_start], edi
    ret
.ide1:
        cmp     [hdpos], 2
    jne    .ide2
        cmp     [hdd_appl_data], 0
    jne    .ide1_appl_data
        mov     [cache_ide1_search_start], edi
    ret
.ide1_appl_data:
        mov     [cache_ide1_appl_search_start], edi
    ret
.ide2:
        cmp     [hdpos], 3
    jne    .ide3
        cmp     [hdd_appl_data], 0
    jne    .ide2_appl_data
        mov     [cache_ide2_search_start], edi
    ret
.ide2_appl_data:
        mov     [cache_ide2_appl_search_start], edi
    ret
.ide3:
        cmp     [hdpos], 4
    jne    .noide
        cmp     [hdd_appl_data], 0
    jne    .ide3_appl_data
        mov     [cache_ide3_search_start], edi
    ret
.ide3_appl_data:
        mov     [cache_ide3_appl_search_start], edi
    ret
.noide:
    push   eax
        mov     eax, [hdpos]
        sub     eax, 80h
    cmp    byte [BiosDisksData+eax*4+2], -1
    jz     @f
        movzx   eax, byte [BiosDisksData+eax*4+2]
        imul    eax, cache_ide1-cache_ide0
        add     eax, cache_ide0
    jmp    .get
@@:
        imul    eax, cache_ide1-cache_ide0
        add     eax, BiosDiskCaches
.get:
        cmp     [hdd_appl_data], 0
    jne    .bd_appl_data
        mov     [cache_ide0_search_start-cache_ide0+eax], edi
    pop    eax
    ret
.bd_appl_data:
        mov     [cache_ide0_appl_search_start-cache_ide0+eax], edi
    pop    eax
    ret
 
;--------------------------------------------------------------------
align 4
find_empty_slot_CD_cache:
;-----------------------------------------------------------
; find empty or read slot, flush cache if next 10% is used by write
; output : edi = cache slot
;-----------------------------------------------------------
.search_again:
    call  cd_calculate_cache_3
.search_for_empty:
    inc   edi
    call  cd_calculate_cache_4
    jbe   .inside_cache
        mov     edi, 1
.inside_cache:
    call  cd_calculate_cache_5
    ret
;--------------------------------------------------------------------
clear_CD_cache:
    pusha
.ide0:
        xor     eax, eax
        cmp     [cdpos], 1
    jne    .ide1
        mov     [cache_ide0_search_start], eax
        mov     ecx, [cache_ide0_system_sad_size]
        mov     edi, [cache_ide0_pointer]
    call   .clear
        mov     [cache_ide0_appl_search_start], eax
        mov     ecx, [cache_ide0_appl_sad_size]
        mov     edi, [cache_ide0_data_pointer]
    jmp    .continue
.ide1:
        cmp     [cdpos], 2
    jne    .ide2
        mov     [cache_ide1_search_start], eax
        mov     ecx, [cache_ide1_system_sad_size]
        mov     edi, [cache_ide1_pointer]
    call   .clear
        mov     [cache_ide1_appl_search_start], eax
        mov     ecx, [cache_ide1_appl_sad_size]
        mov     edi, [cache_ide1_data_pointer]
    jmp    .continue
.ide2:
        cmp     [cdpos], 3
    jne    .ide3
        mov     [cache_ide2_search_start], eax
        mov     ecx, [cache_ide2_system_sad_size]
        mov     edi, [cache_ide2_pointer]
    call   .clear
        mov     [cache_ide2_appl_search_start], eax
        mov     ecx, [cache_ide2_appl_sad_size]
        mov     edi, [cache_ide2_data_pointer]
    jmp    .continue
.ide3:
        mov     [cache_ide3_search_start], eax
        mov     ecx, [cache_ide3_system_sad_size]
        mov     edi, [cache_ide3_pointer]
    call   .clear
        mov     [cache_ide3_appl_search_start], eax
        mov     ecx, [cache_ide3_appl_sad_size]
        mov     edi, [cache_ide3_data_pointer]
.continue:
    call   .clear
    popa
    ret
.clear:
        shl     ecx, 1
    cld
    rep   stosd
    ret
;--------------------------------------------------------------------
align 4
cd_calculate_cache:
;    mov   ecx,cache_max         ; entries in cache
;    mov   esi,HD_CACHE+8
 
; 1 - IDE0 ... 4 - IDE3
.ide0:
        cmp     [cdpos], 1
    jne    .ide1
        cmp     [cd_appl_data], 0
    jne    .ide0_appl_data
        mov     ecx, [cache_ide0_system_sad_size]
        mov     esi, [cache_ide0_pointer]
    ret
.ide0_appl_data:
        mov     ecx, [cache_ide0_appl_sad_size]
        mov     esi, [cache_ide0_data_pointer]
    ret
.ide1:
        cmp     [cdpos], 2
    jne    .ide2
        cmp     [cd_appl_data], 0
    jne    .ide1_appl_data
        mov     ecx, [cache_ide1_system_sad_size]
        mov     esi, [cache_ide1_pointer]
    ret
.ide1_appl_data:
        mov     ecx, [cache_ide1_appl_sad_size]
        mov     esi, [cache_ide1_data_pointer]
    ret
.ide2:
        cmp     [cdpos], 3
    jne    .ide3
        cmp     [cd_appl_data], 0
    jne    .ide2_appl_data
        mov     ecx, [cache_ide2_system_sad_size]
        mov     esi, [cache_ide2_pointer]
    ret
.ide2_appl_data:
        mov     ecx, [cache_ide2_appl_sad_size]
        mov     esi, [cache_ide2_data_pointer]
    ret
.ide3:
        cmp     [cd_appl_data], 0
    jne    .ide3_appl_data
        mov     ecx, [cache_ide3_system_sad_size]
        mov     esi, [cache_ide3_pointer]
    ret
.ide3_appl_data:
        mov     ecx, [cache_ide3_appl_sad_size]
        mov     esi, [cache_ide3_data_pointer]
    ret
;--------------------------------------------------------------------
align 4
cd_calculate_cache_1:
;    lea   esi,[edi*8+HD_CACHE]
; 1 - IDE0 ... 4 - IDE3
.ide0:
        cmp     [cdpos], 1
    jne    .ide1
        cmp     [cd_appl_data], 0
    jne    .ide0_appl_data
        mov     esi, [cache_ide0_pointer]
    ret
.ide0_appl_data:
        mov     esi, [cache_ide0_data_pointer]
    ret
.ide1:
        cmp     [cdpos], 2
    jne    .ide2
        cmp     [cd_appl_data], 0
    jne    .ide1_appl_data
        mov     esi, [cache_ide1_pointer]
    ret
.ide1_appl_data:
        mov     esi, [cache_ide1_data_pointer]
    ret
.ide2:
        cmp     [cdpos], 3
    jne    .ide3
        cmp     [cd_appl_data], 0
    jne    .ide2_appl_data
        mov     esi, [cache_ide2_pointer]
    ret
.ide2_appl_data:
        mov     esi, [cache_ide2_data_pointer]
    ret
.ide3:
        cmp     [cd_appl_data], 0
    jne    .ide3_appl_data
        mov     esi, [cache_ide3_pointer]
    ret
.ide3_appl_data:
        mov     esi, [cache_ide3_data_pointer]
    ret
;--------------------------------------------------------------------
align 4
cd_calculate_cache_2:
;    add   esi,HD_CACHE+65536
; 1 - IDE0 ... 4 - IDE3
.ide0:
        cmp     [cdpos], 1
    jne    .ide1
        cmp     [cd_appl_data], 0
    jne    .ide0_appl_data
        mov     eax, [cache_ide0_system_data]
    ret
.ide0_appl_data:
        mov     eax, [cache_ide0_appl_data]
    ret
.ide1:
        cmp     [cdpos], 2
    jne    .ide2
        cmp     [cd_appl_data], 0
    jne    .ide1_appl_data
        mov     eax, [cache_ide1_system_data]
    ret
.ide1_appl_data:
        mov     eax, [cache_ide1_appl_data]
    ret
.ide2:
        cmp     [cdpos], 3
    jne    .ide3
        cmp     [cd_appl_data], 0
    jne    .ide2_appl_data
        mov     eax, [cache_ide2_system_data]
    ret
.ide2_appl_data:
        mov     eax, [cache_ide2_appl_data]
    ret
.ide3:
        cmp     [cd_appl_data], 0
    jne    .ide3_appl_data
        mov     eax, [cache_ide3_system_data]
    ret
.ide3_appl_data:
        mov     eax, [cache_ide3_appl_data]
    ret
;--------------------------------------------------------------------
align 4
cd_calculate_cache_3:
;    mov   ecx,cache_max*10/100
;    mov   edi,[cache_search_start]
 
; 1 - IDE0 ... 4 - IDE3
.ide0:
        cmp     [cdpos], 1
    jne    .ide1
        cmp     [cd_appl_data], 0
    jne    .ide0_appl_data
        mov     edi, [cache_ide0_search_start]
    ret
.ide0_appl_data:
        mov     edi, [cache_ide0_appl_search_start]
    ret
.ide1:
        cmp     [cdpos], 2
    jne    .ide2
        cmp     [cd_appl_data], 0
    jne    .ide1_appl_data
        mov     edi, [cache_ide1_search_start]
    ret
.ide1_appl_data:
        mov     edi, [cache_ide1_appl_search_start]
    ret
.ide2:
        cmp     [cdpos], 3
    jne    .ide3
        cmp     [cd_appl_data], 0
    jne    .ide2_appl_data
        mov     edi, [cache_ide2_search_start]
    ret
.ide2_appl_data:
        mov     edi, [cache_ide2_appl_search_start]
    ret
.ide3:
        cmp     [cd_appl_data], 0
    jne    .ide3_appl_data
        mov     edi, [cache_ide3_search_start]
    ret
.ide3_appl_data:
        mov     edi, [cache_ide3_appl_search_start]
    ret
;--------------------------------------------------------------------
align 4
cd_calculate_cache_4:
;    cmp   edi,cache_max
; 1 - IDE0 ... 4 - IDE3
.ide0:
        cmp     [cdpos], 1
    jne    .ide1
        cmp     [cd_appl_data], 0
    jne    .ide0_appl_data
        cmp     edi, [cache_ide0_system_sad_size]
    ret
.ide0_appl_data:
        cmp     edi, [cache_ide0_appl_sad_size]
    ret
.ide1:
        cmp     [cdpos], 2
    jne    .ide2
        cmp     [cd_appl_data], 0
    jne    .ide1_appl_data
        cmp     edi, [cache_ide1_system_sad_size]
    ret
.ide1_appl_data:
        cmp     edi, [cache_ide1_appl_sad_size]
    ret
.ide2:
        cmp     [cdpos], 3
    jne    .ide3
        cmp     [cd_appl_data], 0
    jne    .ide2_appl_data
        cmp     edi, [cache_ide2_system_sad_size]
    ret
.ide2_appl_data:
        cmp     edi, [cache_ide2_appl_sad_size]
    ret
.ide3:
        cmp     [cd_appl_data], 0
    jne    .ide3_appl_data
        cmp     edi, [cache_ide3_system_sad_size]
    ret
.ide3_appl_data:
        cmp     edi, [cache_ide3_appl_sad_size]
    ret
;--------------------------------------------------------------------
align 4
cd_calculate_cache_5:
;    mov   [cache_search_start],edi
; 1 - IDE0 ... 4 - IDE3
.ide0:
        cmp     [cdpos], 1
    jne    .ide1
        cmp     [cd_appl_data], 0
    jne    .ide0_appl_data
        mov     [cache_ide0_search_start], edi
    ret
.ide0_appl_data:
        mov     [cache_ide0_appl_search_start], edi
    ret
.ide1:
        cmp     [cdpos], 2
    jne    .ide2
        cmp     [cd_appl_data], 0
    jne    .ide1_appl_data
        mov     [cache_ide1_search_start], edi
    ret
.ide1_appl_data:
        mov     [cache_ide1_appl_search_start], edi
    ret
.ide2:
        cmp     [cdpos], 3
    jne    .ide3
        cmp     [cd_appl_data], 0
    jne    .ide2_appl_data
        mov     [cache_ide2_search_start], edi
    ret
.ide2_appl_data:
        mov     [cache_ide2_appl_search_start], edi
    ret
.ide3:
        cmp     [cd_appl_data], 0
    jne    .ide3_appl_data
        mov     [cache_ide3_search_start], edi
    ret
.ide3_appl_data:
        mov     [cache_ide3_appl_search_start], edi
    ret
;--------------------------------------------------------------------
;align 4
;calculate_linear_to_real:
;    shr eax, 12
;    mov eax, [page_tabs+eax*4]
;    and eax, 0xFFFFF000
;    ret

Rev 2465	Rev 2987
1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
2	;; ;;	2	;; ;;
3	;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;	3	;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
4	;; Distributed under terms of the GNU General Public License ;;	4	;; Distributed under terms of the GNU General Public License ;;
5	;; ;;	5	;; ;;
6	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	6	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
7		7
8	;**************************************************************************	8	;**************************************************************************
9	;	9	;
10	; [cache_ide[X]_pointer]	10	; [cache_ide[X]_pointer]
11	; or [cache_ide[X]_data_pointer] first entry in cache list	11	; or [cache_ide[X]_data_pointer] first entry in cache list
12	;	12	;
13	; +0 - lba sector	13	; +0 - lba sector
14	; +4 - state of cache sector	14	; +4 - state of cache sector
15	; 0 = empty	15	; 0 = empty
16	; 1 = used for read ( same as in hd )	16	; 1 = used for read ( same as in hd )
17	; 2 = used for write ( differs from hd )	17	; 2 = used for write ( differs from hd )
18	;	18	;
19	; [cache_ide[X]_system_data]	19	; [cache_ide[X]_system_data]
20	; or [cache_ide[x]_appl_data] - cache entries	20	; or [cache_ide[x]_appl_data] - cache entries
21	;	21	;
22	;**************************************************************************	22	;**************************************************************************
23		23
24	$Revision: 2465 $	24	$Revision: 2987 $
25		25
26		26
27	align 4	27	align 4
28	write_cache:	28	write_cache:
29	;-----------------------------------------------------------	29	;-----------------------------------------------------------
30	; write all changed sectors to disk	30	; write all changed sectors to disk
31	;-----------------------------------------------------------	31	;-----------------------------------------------------------
32	push eax ecx edx esi edi	32	push eax ecx edx esi edi
33		33
34	; write difference ( 2 ) from cache to hd	34	; write difference ( 2 ) from cache to hd
35	call calculate_cache	35	call calculate_cache
36	add esi, 8	36	add esi, 8
37	mov edi, 1	37	mov edi, 1
38	write_cache_more:	38	write_cache_more:
39	cmp dword [esi+4], 2; if cache slot is not different	39	cmp dword [esi+4], 2; if cache slot is not different
40	jne .write_chain	40	jne .write_chain
41	mov dword [esi+4], 1; same as in hd	41	mov dword [esi+4], 1; same as in hd
42	mov eax, [esi] ; eax = sector to write	42	mov eax, [esi] ; eax = sector to write
43	cmp eax, [PARTITION_START]	43	cmp eax, [PARTITION_START]
44	jb danger	44	jb danger
45	cmp eax, [PARTITION_END]	45	cmp eax, [PARTITION_END]
46	ja danger	46	ja danger
47	cmp [hdpos], 0x80	47	cmp [hdpos], 0x80
48	jae @f	48	jae @f
49	; DMA write is permitted only if [allow_dma_access]=1	49	; DMA write is permitted only if [allow_dma_access]=1
50	cmp [allow_dma_access], 2	50	cmp [allow_dma_access], 2
51	jae .nodma	51	jae .nodma
52	cmp [dma_hdd], 1	52	cmp [dma_hdd], 1
53	jnz .nodma	53	jnz .nodma
54	@@:	54	@@:
55	; ¡ê¥¤¨ï¥¬ § ¯¨áì æ¥¯®çª¨ ¯®á«¥¤®¢ â¥«ìëå á¥ªâ®à®¢ ¢ ®¤® ®¡à é¥¨¥ ª ¤¨áªã	55	; ¡ê¥¤¨ï¥¬ § ¯¨áì æ¥¯®çª¨ ¯®á«¥¤®¢ â¥«ìëå á¥ªâ®à®¢ ¢ ®¤® ®¡à é¥¨¥ ª ¤¨áªã
56	cmp ecx, 1	56	cmp ecx, 1
57	jz .nonext	57	jz .nonext
58	cmp dword [esi+8+4], 2	58	cmp dword [esi+8+4], 2
59	jnz .nonext	59	jnz .nonext
60	push eax	60	push eax
61	inc eax	61	inc eax
62	cmp eax, [esi+8]	62	cmp eax, [esi+8]
63	pop eax	63	pop eax
64	jnz .nonext	64	jnz .nonext
65	cmp [cache_chain_started], 1	65	cmp [cache_chain_started], 1
66	jz @f	66	jz @f
67	mov [cache_chain_started], 1	67	mov [cache_chain_started], 1
68	mov [cache_chain_size], 0	68	mov [cache_chain_size], 0
69	mov [cache_chain_pos], edi	69	mov [cache_chain_pos], edi
70	mov [cache_chain_ptr], esi	70	mov [cache_chain_ptr], esi
71	@@:	71	@@:
72	inc [cache_chain_size]	72	inc [cache_chain_size]
73	cmp [cache_chain_size], 16	73	cmp [cache_chain_size], 16
74	jnz .continue	74	jnz .continue
75	jmp .write_chain	75	jmp .write_chain
76	.nonext:	76	.nonext:
77	call flush_cache_chain	77	call flush_cache_chain
78	mov [cache_chain_size], 1	78	mov [cache_chain_size], 1
79	mov [cache_chain_ptr], esi	79	mov [cache_chain_ptr], esi
80	call write_cache_sector	80	call write_cache_sector
81	jmp .continue	81	jmp .continue
82	.nodma:	82	.nodma:
83	call cache_write_pio	83	call cache_write_pio
84	.write_chain:	84	.write_chain:
85	call flush_cache_chain	85	call flush_cache_chain
86	.continue:	86	.continue:
87	danger:	87	danger:
88	add esi, 8	88	add esi, 8
89	inc edi	89	inc edi
90	dec ecx	90	dec ecx
91	jnz write_cache_more	91	jnz write_cache_more
92	call flush_cache_chain	92	call flush_cache_chain
93	return_02:	93	return_02:
94	pop edi esi edx ecx eax	94	pop edi esi edx ecx eax
95	ret	95	ret
96		96
97	flush_cache_chain:	97	flush_cache_chain:
98	cmp [cache_chain_started], 0	98	cmp [cache_chain_started], 0
99	jz @f	99	jz @f
100	call write_cache_chain	100	call write_cache_chain
101	mov [cache_chain_started], 0	101	mov [cache_chain_started], 0
102	@@:	102	@@:
103	ret	103	ret
104	;--------------------------------------------------------------------	104	;--------------------------------------------------------------------
105	align 4	105	align 4
106	find_empty_slot:	106	find_empty_slot:
107	;-----------------------------------------------------------	107	;-----------------------------------------------------------
108	; find empty or read slot, flush cache if next 10% is used by write	108	; find empty or read slot, flush cache if next 10% is used by write
109	; output : edi = cache slot	109	; output : edi = cache slot
110	;-----------------------------------------------------------	110	;-----------------------------------------------------------
111	; push ecx esi	111	; push ecx esi
112		112
113	search_again:	113	search_again:
114	call calculate_cache_3	114	call calculate_cache_3
115	shr ecx, 3	115	shr ecx, 3
116	search_for_empty:	116	search_for_empty:
117	inc edi	117	inc edi
118	call calculate_cache_4	118	call calculate_cache_4
119	jbe inside_cache	119	jbe inside_cache
120	mov edi, 1	120	mov edi, 1
121	inside_cache:	121	inside_cache:
122	push esi	122	push esi
123	call calculate_cache_1	123	call calculate_cache_1
124	cmp dword [edi*8+esi+4], 2	124	cmp dword [edi*8+esi+4], 2
125	pop esi	125	pop esi
126	jb found_slot ; it's empty or read	126	jb found_slot ; it's empty or read
127	dec ecx	127	dec ecx
128	jnz search_for_empty	128	jnz search_for_empty
129	call write_cache ; no empty slots found, write all	129	call write_cache ; no empty slots found, write all
130	cmp [hd_error], 0	130	cmp [hd_error], 0
131	jne found_slot_access_denied	131	jne found_slot_access_denied
132	jmp search_again ; and start again	132	jmp search_again ; and start again
133	found_slot:	133	found_slot:
134	call calculate_cache_5	134	call calculate_cache_5
135	found_slot_access_denied:	135	found_slot_access_denied:
136	ret	136	ret
137	;--------------------------------------------------------------------	137	;--------------------------------------------------------------------
138	align 4	138	align 4
139	clear_hd_cache:	139	clear_hd_cache:
140	mov [fat_in_cache], -1	-
141	mov [fat_change], 0	-
142	ret	140	ret
143	;--------------------------------------------------------------------	141	;--------------------------------------------------------------------
144	align 4	142	align 4
145	calculate_cache:	143	calculate_cache:
146	; mov ecx,cache_max ; entries in cache	144	; mov ecx,cache_max ; entries in cache
147	; mov esi,HD_CACHE+8	145	; mov esi,HD_CACHE+8
148		146
149	; 1 - IDE0 ... 4 - IDE3	147	; 1 - IDE0 ... 4 - IDE3
150	.ide0:	148	.ide0:
151	cmp [hdpos], 1	149	cmp [hdpos], 1
152	jne .ide1	150	jne .ide1
153	cmp [hdd_appl_data], 0	151	cmp [hdd_appl_data], 0
154	jne .ide0_appl_data	152	jne .ide0_appl_data
155	mov ecx, [cache_ide0_system_sad_size]	153	mov ecx, [cache_ide0_system_sad_size]
156	mov esi, [cache_ide0_pointer]	154	mov esi, [cache_ide0_pointer]
157	ret	155	ret
158	.ide0_appl_data:	156	.ide0_appl_data:
159	mov ecx, [cache_ide0_appl_sad_size]	157	mov ecx, [cache_ide0_appl_sad_size]
160	mov esi, [cache_ide0_data_pointer]	158	mov esi, [cache_ide0_data_pointer]
161	ret	159	ret
162	.ide1:	160	.ide1:
163	cmp [hdpos], 2	161	cmp [hdpos], 2
164	jne .ide2	162	jne .ide2
165	cmp [hdd_appl_data], 0	163	cmp [hdd_appl_data], 0
166	jne .ide1_appl_data	164	jne .ide1_appl_data
167	mov ecx, [cache_ide1_system_sad_size]	165	mov ecx, [cache_ide1_system_sad_size]
168	mov esi, [cache_ide1_pointer]	166	mov esi, [cache_ide1_pointer]
169	ret	167	ret
170	.ide1_appl_data:	168	.ide1_appl_data:
171	mov ecx, [cache_ide1_appl_sad_size]	169	mov ecx, [cache_ide1_appl_sad_size]
172	mov esi, [cache_ide1_data_pointer]	170	mov esi, [cache_ide1_data_pointer]
173	ret	171	ret
174	.ide2:	172	.ide2:
175	cmp [hdpos], 3	173	cmp [hdpos], 3
176	jne .ide3	174	jne .ide3
177	cmp [hdd_appl_data], 0	175	cmp [hdd_appl_data], 0
178	jne .ide2_appl_data	176	jne .ide2_appl_data
179	mov ecx, [cache_ide2_system_sad_size]	177	mov ecx, [cache_ide2_system_sad_size]
180	mov esi, [cache_ide2_pointer]	178	mov esi, [cache_ide2_pointer]
181	ret	179	ret
182	.ide2_appl_data:	180	.ide2_appl_data:
183	mov ecx, [cache_ide2_appl_sad_size]	181	mov ecx, [cache_ide2_appl_sad_size]
184	mov esi, [cache_ide2_data_pointer]	182	mov esi, [cache_ide2_data_pointer]
185	ret	183	ret
186	.ide3:	184	.ide3:
187	cmp [hdpos], 4	185	cmp [hdpos], 4
188	jne .noide	186	jne .noide
189	cmp [hdd_appl_data], 0	187	cmp [hdd_appl_data], 0
190	jne .ide3_appl_data	188	jne .ide3_appl_data
191	mov ecx, [cache_ide3_system_sad_size]	189	mov ecx, [cache_ide3_system_sad_size]
192	mov esi, [cache_ide3_pointer]	190	mov esi, [cache_ide3_pointer]
193	ret	191	ret
194	.ide3_appl_data:	192	.ide3_appl_data:
195	mov ecx, [cache_ide3_appl_sad_size]	193	mov ecx, [cache_ide3_appl_sad_size]
196	mov esi, [cache_ide3_data_pointer]	194	mov esi, [cache_ide3_data_pointer]
197	ret	195	ret
198	.noide:	196	.noide:
199	push eax	197	push eax
200	mov eax, [hdpos]	198	mov eax, [hdpos]
201	sub eax, 80h	199	sub eax, 80h
202	cmp byte [BiosDisksData+eax*4+2], -1	200	cmp byte [BiosDisksData+eax*4+2], -1
203	jz @f	201	jz @f
204	movzx eax, byte [BiosDisksData+eax*4+2]	202	movzx eax, byte [BiosDisksData+eax*4+2]
205	imul eax, cache_ide1-cache_ide0	203	imul eax, cache_ide1-cache_ide0
206	add eax, cache_ide0	204	add eax, cache_ide0
207	jmp .get	205	jmp .get
208	@@:	206	@@:
209	imul eax, cache_ide1-cache_ide0	207	imul eax, cache_ide1-cache_ide0
210	add eax, BiosDiskCaches	208	add eax, BiosDiskCaches
211	.get:	209	.get:
212	cmp [hdd_appl_data], 0	210	cmp [hdd_appl_data], 0
213	jne .bd_appl_data	211	jne .bd_appl_data
214	mov ecx, [cache_ide0_system_sad_size-cache_ide0+eax]	212	mov ecx, [cache_ide0_system_sad_size-cache_ide0+eax]
215	mov esi, [cache_ide0_pointer-cache_ide0+eax]	213	mov esi, [cache_ide0_pointer-cache_ide0+eax]
216	pop eax	214	pop eax
217	ret	215	ret
218	.bd_appl_data:	216	.bd_appl_data:
219	mov ecx, [cache_ide0_appl_sad_size-cache_ide0+eax]	217	mov ecx, [cache_ide0_appl_sad_size-cache_ide0+eax]
220	mov esi, [cache_ide0_data_pointer-cache_ide0+eax]	218	mov esi, [cache_ide0_data_pointer-cache_ide0+eax]
221	pop eax	219	pop eax
222	ret	220	ret
223	;--------------------------------------------------------------------	221	;--------------------------------------------------------------------
224	align 4	222	align 4
225	calculate_cache_1:	223	calculate_cache_1:
226	; lea esi,[edi*8+HD_CACHE]	224	; lea esi,[edi*8+HD_CACHE]
227	; 1 - IDE0 ... 4 - IDE3	225	; 1 - IDE0 ... 4 - IDE3
228	.ide0:	226	.ide0:
229	cmp [hdpos], 1	227	cmp [hdpos], 1
230	jne .ide1	228	jne .ide1
231	cmp [hdd_appl_data], 0	229	cmp [hdd_appl_data], 0
232	jne .ide0_appl_data	230	jne .ide0_appl_data
233	mov esi, [cache_ide0_pointer]	231	mov esi, [cache_ide0_pointer]
234	ret	232	ret
235	.ide0_appl_data:	233	.ide0_appl_data:
236	mov esi, [cache_ide0_data_pointer]	234	mov esi, [cache_ide0_data_pointer]
237	ret	235	ret
238	.ide1:	236	.ide1:
239	cmp [hdpos], 2	237	cmp [hdpos], 2
240	jne .ide2	238	jne .ide2
241	cmp [hdd_appl_data], 0	239	cmp [hdd_appl_data], 0
242	jne .ide1_appl_data	240	jne .ide1_appl_data
243	mov esi, [cache_ide1_pointer]	241	mov esi, [cache_ide1_pointer]
244	ret	242	ret
245	.ide1_appl_data:	243	.ide1_appl_data:
246	mov esi, [cache_ide1_data_pointer]	244	mov esi, [cache_ide1_data_pointer]
247	ret	245	ret
248	.ide2:	246	.ide2:
249	cmp [hdpos], 3	247	cmp [hdpos], 3
250	jne .ide3	248	jne .ide3
251	cmp [hdd_appl_data], 0	249	cmp [hdd_appl_data], 0
252	jne .ide2_appl_data	250	jne .ide2_appl_data
253	mov esi, [cache_ide2_pointer]	251	mov esi, [cache_ide2_pointer]
254	ret	252	ret
255	.ide2_appl_data:	253	.ide2_appl_data:
256	mov esi, [cache_ide2_data_pointer]	254	mov esi, [cache_ide2_data_pointer]
257	ret	255	ret
258	.ide3:	256	.ide3:
259	cmp [hdpos], 4	257	cmp [hdpos], 4
260	jne .noide	258	jne .noide
261	cmp [hdd_appl_data], 0	259	cmp [hdd_appl_data], 0
262	jne .ide3_appl_data	260	jne .ide3_appl_data
263	mov esi, [cache_ide3_pointer]	261	mov esi, [cache_ide3_pointer]
264	ret	262	ret
265	.ide3_appl_data:	263	.ide3_appl_data:
266	mov esi, [cache_ide3_data_pointer]	264	mov esi, [cache_ide3_data_pointer]
267	ret	265	ret
268	.noide:	266	.noide:
269	push eax	267	push eax
270	mov eax, [hdpos]	268	mov eax, [hdpos]
271	sub eax, 80h	269	sub eax, 80h
272	cmp byte [BiosDisksData+eax*4+2], -1	270	cmp byte [BiosDisksData+eax*4+2], -1
273	jz @f	271	jz @f
274	movzx eax, byte [BiosDisksData+eax*4+2]	272	movzx eax, byte [BiosDisksData+eax*4+2]
275	imul eax, cache_ide1-cache_ide0	273	imul eax, cache_ide1-cache_ide0
276	add eax, cache_ide0	274	add eax, cache_ide0
277	jmp .get	275	jmp .get
278	@@:	276	@@:
279	imul eax, cache_ide1-cache_ide0	277	imul eax, cache_ide1-cache_ide0
280	add eax, BiosDiskCaches	278	add eax, BiosDiskCaches
281	.get:	279	.get:
282	cmp [hdd_appl_data], 0	280	cmp [hdd_appl_data], 0
283	jne .bd_appl_data	281	jne .bd_appl_data
284	mov esi, [cache_ide0_pointer-cache_ide0+eax]	282	mov esi, [cache_ide0_pointer-cache_ide0+eax]
285	pop eax	283	pop eax
286	ret	284	ret
287	.bd_appl_data:	285	.bd_appl_data:
288	mov esi, [cache_ide0_data_pointer-cache_ide0+eax]	286	mov esi, [cache_ide0_data_pointer-cache_ide0+eax]
289	pop eax	287	pop eax
290	ret	288	ret
291		289
292	;--------------------------------------------------------------------	290	;--------------------------------------------------------------------
293	align 4	291	align 4
294	calculate_cache_2:	292	calculate_cache_2:
295	; add esi,HD_CACHE+65536	293	; add esi,HD_CACHE+65536
296	; 1 - IDE0 ... 4 - IDE3	294	; 1 - IDE0 ... 4 - IDE3
297	.ide0:	295	.ide0:
298	cmp [hdpos], 1	296	cmp [hdpos], 1
299	jne .ide1	297	jne .ide1
300	cmp [hdd_appl_data], 0	298	cmp [hdd_appl_data], 0
301	jne .ide0_appl_data	299	jne .ide0_appl_data
302	mov eax, [cache_ide0_system_data]	300	mov eax, [cache_ide0_system_data]
303	ret	301	ret
304	.ide0_appl_data:	302	.ide0_appl_data:
305	mov eax, [cache_ide0_appl_data]	303	mov eax, [cache_ide0_appl_data]
306	ret	304	ret
307	.ide1:	305	.ide1:
308	cmp [hdpos], 2	306	cmp [hdpos], 2
309	jne .ide2	307	jne .ide2
310	cmp [hdd_appl_data], 0	308	cmp [hdd_appl_data], 0
311	jne .ide1_appl_data	309	jne .ide1_appl_data
312	mov eax, [cache_ide1_system_data]	310	mov eax, [cache_ide1_system_data]
313	ret	311	ret
314	.ide1_appl_data:	312	.ide1_appl_data:
315	mov eax, [cache_ide1_appl_data]	313	mov eax, [cache_ide1_appl_data]
316	ret	314	ret
317	.ide2:	315	.ide2:
318	cmp [hdpos], 3	316	cmp [hdpos], 3
319	jne .ide3	317	jne .ide3
320	cmp [hdd_appl_data], 0	318	cmp [hdd_appl_data], 0
321	jne .ide2_appl_data	319	jne .ide2_appl_data
322	mov eax, [cache_ide2_system_data]	320	mov eax, [cache_ide2_system_data]
323	ret	321	ret
324	.ide2_appl_data:	322	.ide2_appl_data:
325	mov eax, [cache_ide2_appl_data]	323	mov eax, [cache_ide2_appl_data]
326	ret	324	ret
327	.ide3:	325	.ide3:
328	cmp [hdpos], 4	326	cmp [hdpos], 4
329	jne .noide	327	jne .noide
330	cmp [hdd_appl_data], 0	328	cmp [hdd_appl_data], 0
331	jne .ide3_appl_data	329	jne .ide3_appl_data
332	mov eax, [cache_ide3_system_data]	330	mov eax, [cache_ide3_system_data]
333	ret	331	ret
334	.ide3_appl_data:	332	.ide3_appl_data:
335	mov eax, [cache_ide3_appl_data]	333	mov eax, [cache_ide3_appl_data]
336	ret	334	ret
337	.noide:	335	.noide:
338	mov eax, [hdpos]	336	mov eax, [hdpos]
339	sub eax, 80h	337	sub eax, 80h
340	cmp byte [BiosDisksData+eax*4+2], -1	338	cmp byte [BiosDisksData+eax*4+2], -1
341	jz @f	339	jz @f
342	movzx eax, byte [BiosDisksData+eax*4+2]	340	movzx eax, byte [BiosDisksData+eax*4+2]
343	imul eax, cache_ide1-cache_ide0	341	imul eax, cache_ide1-cache_ide0
344	add eax, cache_ide0	342	add eax, cache_ide0
345	jmp .get	343	jmp .get
346	@@:	344	@@:
347	imul eax, cache_ide1-cache_ide0	345	imul eax, cache_ide1-cache_ide0
348	add eax, BiosDiskCaches	346	add eax, BiosDiskCaches
349	.get:	347	.get:
350	cmp [hdd_appl_data], 0	348	cmp [hdd_appl_data], 0
351	jne .bd_appl_data	349	jne .bd_appl_data
352	mov eax, [cache_ide0_system_data-cache_ide0+eax]	350	mov eax, [cache_ide0_system_data-cache_ide0+eax]
353	ret	351	ret
354	.bd_appl_data:	352	.bd_appl_data:
355	mov eax, [cache_ide0_appl_data-cache_ide0+eax]	353	mov eax, [cache_ide0_appl_data-cache_ide0+eax]
356	ret	354	ret
357	;--------------------------------------------------------------------	355	;--------------------------------------------------------------------
358	align 4	356	align 4
359	calculate_cache_3:	357	calculate_cache_3:
360	; mov ecx,cache_max*10/100	358	; mov ecx,cache_max*10/100
361	; mov edi,[cache_search_start]	359	; mov edi,[cache_search_start]
362		360
363	; 1 - IDE0 ... 4 - IDE3	361	; 1 - IDE0 ... 4 - IDE3
364	.ide0:	362	.ide0:
365	cmp [hdpos], 1	363	cmp [hdpos], 1
366	jne .ide1	364	jne .ide1
367	cmp [hdd_appl_data], 0	365	cmp [hdd_appl_data], 0
368	jne .ide0_appl_data	366	jne .ide0_appl_data
369	mov ecx, [cache_ide0_system_sad_size]	367	mov ecx, [cache_ide0_system_sad_size]
370	mov edi, [cache_ide0_search_start]	368	mov edi, [cache_ide0_search_start]
371	ret	369	ret
372	.ide0_appl_data:	370	.ide0_appl_data:
373	mov ecx, [cache_ide0_appl_sad_size]	371	mov ecx, [cache_ide0_appl_sad_size]
374	mov edi, [cache_ide0_appl_search_start]	372	mov edi, [cache_ide0_appl_search_start]
375	ret	373	ret
376	.ide1:	374	.ide1:
377	cmp [hdpos], 2	375	cmp [hdpos], 2
378	jne .ide2	376	jne .ide2
379	cmp [hdd_appl_data], 0	377	cmp [hdd_appl_data], 0
380	jne .ide1_appl_data	378	jne .ide1_appl_data
381	mov ecx, [cache_ide1_system_sad_size]	379	mov ecx, [cache_ide1_system_sad_size]
382	mov edi, [cache_ide1_search_start]	380	mov edi, [cache_ide1_search_start]
383	ret	381	ret
384	.ide1_appl_data:	382	.ide1_appl_data:
385	mov ecx, [cache_ide1_appl_sad_size]	383	mov ecx, [cache_ide1_appl_sad_size]
386	mov edi, [cache_ide1_appl_search_start]	384	mov edi, [cache_ide1_appl_search_start]
387	ret	385	ret
388	.ide2:	386	.ide2:
389	cmp [hdpos], 3	387	cmp [hdpos], 3
390	jne .ide3	388	jne .ide3
391	cmp [hdd_appl_data], 0	389	cmp [hdd_appl_data], 0
392	jne .ide2_appl_data	390	jne .ide2_appl_data
393	mov ecx, [cache_ide2_system_sad_size]	391	mov ecx, [cache_ide2_system_sad_size]
394	mov edi, [cache_ide2_search_start]	392	mov edi, [cache_ide2_search_start]
395	ret	393	ret
396	.ide2_appl_data:	394	.ide2_appl_data:
397	mov ecx, [cache_ide2_appl_sad_size]	395	mov ecx, [cache_ide2_appl_sad_size]
398	mov edi, [cache_ide2_appl_search_start]	396	mov edi, [cache_ide2_appl_search_start]
399	ret	397	ret
400	.ide3:	398	.ide3:
401	cmp [hdpos], 4	399	cmp [hdpos], 4
402	jne .noide	400	jne .noide
403	cmp [hdd_appl_data], 0	401	cmp [hdd_appl_data], 0
404	jne .ide3_appl_data	402	jne .ide3_appl_data
405	mov ecx, [cache_ide3_system_sad_size]	403	mov ecx, [cache_ide3_system_sad_size]
406	mov edi, [cache_ide3_search_start]	404	mov edi, [cache_ide3_search_start]
407	ret	405	ret
408	.ide3_appl_data:	406	.ide3_appl_data:
409	mov ecx, [cache_ide3_appl_sad_size]	407	mov ecx, [cache_ide3_appl_sad_size]
410	mov edi, [cache_ide3_appl_search_start]	408	mov edi, [cache_ide3_appl_search_start]
411	ret	409	ret
412	.noide:	410	.noide:
413	push eax	411	push eax
414	mov eax, [hdpos]	412	mov eax, [hdpos]
415	sub eax, 80h	413	sub eax, 80h
416	cmp byte [BiosDisksData+eax*4+2], -1	414	cmp byte [BiosDisksData+eax*4+2], -1
417	jz @f	415	jz @f
418	movzx eax, byte [BiosDisksData+eax*4+2]	416	movzx eax, byte [BiosDisksData+eax*4+2]
419	imul eax, cache_ide1-cache_ide0	417	imul eax, cache_ide1-cache_ide0
420	add eax, cache_ide0	418	add eax, cache_ide0
421	jmp .get	419	jmp .get
422	@@:	420	@@:
423	imul eax, cache_ide1-cache_ide0	421	imul eax, cache_ide1-cache_ide0
424	add eax, BiosDiskCaches	422	add eax, BiosDiskCaches
425	.get:	423	.get:
426	cmp [hdd_appl_data], 0	424	cmp [hdd_appl_data], 0
427	jne .bd_appl_data	425	jne .bd_appl_data
428	mov ecx, [cache_ide0_system_sad_size-cache_ide0+eax]	426	mov ecx, [cache_ide0_system_sad_size-cache_ide0+eax]
429	mov edi, [cache_ide0_search_start-cache_ide0+eax]	427	mov edi, [cache_ide0_search_start-cache_ide0+eax]
430	pop eax	428	pop eax
431	ret	429	ret
432	.bd_appl_data:	430	.bd_appl_data:
433	mov ecx, [cache_ide0_appl_sad_size-cache_ide0+eax]	431	mov ecx, [cache_ide0_appl_sad_size-cache_ide0+eax]
434	mov edi, [cache_ide0_appl_search_start-cache_ide0+eax]	432	mov edi, [cache_ide0_appl_search_start-cache_ide0+eax]
435	pop eax	433	pop eax
436	ret	434	ret
437	;--------------------------------------------------------------------	435	;--------------------------------------------------------------------
438	align 4	436	align 4
439	calculate_cache_4:	437	calculate_cache_4:
440	; cmp edi,cache_max	438	; cmp edi,cache_max
441	; 1 - IDE0 ... 4 - IDE3	439	; 1 - IDE0 ... 4 - IDE3
442	.ide0:	440	.ide0:
443	cmp [hdpos], 1	441	cmp [hdpos], 1
444	jne .ide1	442	jne .ide1
445	cmp [hdd_appl_data], 0	443	cmp [hdd_appl_data], 0
446	jne .ide0_appl_data	444	jne .ide0_appl_data
447	cmp edi, [cache_ide0_system_sad_size]	445	cmp edi, [cache_ide0_system_sad_size]
448	ret	446	ret
449	.ide0_appl_data:	447	.ide0_appl_data:
450	cmp edi, [cache_ide0_appl_sad_size]	448	cmp edi, [cache_ide0_appl_sad_size]
451	ret	449	ret
452	.ide1:	450	.ide1:
453	cmp [hdpos], 2	451	cmp [hdpos], 2
454	jne .ide2	452	jne .ide2
455	cmp [hdd_appl_data], 0	453	cmp [hdd_appl_data], 0
456	jne .ide1_appl_data	454	jne .ide1_appl_data
457	cmp edi, [cache_ide1_system_sad_size]	455	cmp edi, [cache_ide1_system_sad_size]
458	ret	456	ret
459	.ide1_appl_data:	457	.ide1_appl_data:
460	cmp edi, [cache_ide1_appl_sad_size]	458	cmp edi, [cache_ide1_appl_sad_size]
461	ret	459	ret
462	.ide2:	460	.ide2:
463	cmp [hdpos], 3	461	cmp [hdpos], 3
464	jne .ide3	462	jne .ide3
465	cmp [hdd_appl_data], 0	463	cmp [hdd_appl_data], 0
466	jne .ide2_appl_data	464	jne .ide2_appl_data
467	cmp edi, [cache_ide2_system_sad_size]	465	cmp edi, [cache_ide2_system_sad_size]
468	ret	466	ret
469	.ide2_appl_data:	467	.ide2_appl_data:
470	cmp edi, [cache_ide2_appl_sad_size]	468	cmp edi, [cache_ide2_appl_sad_size]
471	ret	469	ret
472	.ide3:	470	.ide3:
473	cmp [hdpos], 4	471	cmp [hdpos], 4
474	jne .noide	472	jne .noide
475	cmp [hdd_appl_data], 0	473	cmp [hdd_appl_data], 0
476	jne .ide3_appl_data	474	jne .ide3_appl_data
477	cmp edi, [cache_ide3_system_sad_size]	475	cmp edi, [cache_ide3_system_sad_size]
478	ret	476	ret
479	.ide3_appl_data:	477	.ide3_appl_data:
480	cmp edi, [cache_ide3_appl_sad_size]	478	cmp edi, [cache_ide3_appl_sad_size]
481	ret	479	ret
482	.noide:	480	.noide:
483	push eax	481	push eax
484	mov eax, [hdpos]	482	mov eax, [hdpos]
485	sub eax, 80h	483	sub eax, 80h
486	cmp byte [BiosDisksData+eax*4+2], -1	484	cmp byte [BiosDisksData+eax*4+2], -1
487	jz @f	485	jz @f
488	movzx eax, byte [BiosDisksData+eax*4+2]	486	movzx eax, byte [BiosDisksData+eax*4+2]
489	imul eax, cache_ide1-cache_ide0	487	imul eax, cache_ide1-cache_ide0
490	add eax, cache_ide0	488	add eax, cache_ide0
491	jmp .get	489	jmp .get
492	@@:	490	@@:
493	imul eax, cache_ide1-cache_ide0	491	imul eax, cache_ide1-cache_ide0
494	add eax, BiosDiskCaches	492	add eax, BiosDiskCaches
495	.get:	493	.get:
496	cmp [hdd_appl_data], 0	494	cmp [hdd_appl_data], 0
497	jne .bd_appl_data	495	jne .bd_appl_data
498	cmp edi, [cache_ide0_system_sad_size-cache_ide0+eax]	496	cmp edi, [cache_ide0_system_sad_size-cache_ide0+eax]
499	pop eax	497	pop eax
500	ret	498	ret

Subversion Repositories Kolibri OS

(root)/kernel/branches/Kolibri-acpi/blkdev/ide_cache.inc – Rev 2465 → 2987