WebSVN – Kolibri OS – Diff – /kernel/trunk/blkdev/cd_drv.inc


;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;;                                                              ;;
;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;;
;; Distributed under terms of the GNU General Public License    ;;
;;                                                              ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 
$Revision: 8054 $
 
;-----------------------------------------------------------------------------
;**********************************************************
;  Direct work with CD (ATAPI) device
;**********************************************************
; Author of a part of the source code -  Kulakov Vladimir Gennadievich
; Adaptation, revision and development -  Mario79, 
 
; Maximum number of repeats of a read operation
MaxRetr = 10
; Maximum waiting time for ready to receive a command
; (in ticks)
BSYWaitTime = 1000  ;2
NoTickWaitTime = 0xfffff
CDBlockSize = 2048
;********************************************
;*        READING SECTOR WITH REPEATS       *
;*      Repeated reads on failures          *
;********************************************
ReadCDWRetr:
;-----------------------------------------------------------
; input  : eax = block to read
;          ebx = destination
;-----------------------------------------------------------
        pushad
        mov     eax, [CDSectorAddress]
        mov     ebx, [CDDataBuf_pointer]
        call    cd_calculate_cache
        xor     edi, edi
        add     esi, 8
        inc     edi
;--------------------------------------
align 4
.hdreadcache:
        cmp     [esi], eax      ; correct sector
        je      .yeshdcache
 
        add     esi, 8
        inc     edi
        dec     ecx
        jnz     .hdreadcache
 
        call    find_empty_slot_CD_cache ; ret in edi
 
        push    edi
        push    eax
        call    cd_calculate_cache_2
        shl     edi, 11
        add     edi, eax
        mov     [CDDataBuf_pointer], edi
        pop     eax
        pop     edi
 
        call    ReadCDWRetr_1
        cmp     [DevErrorCode], 0
        jne     .exit
 
        mov     [CDDataBuf_pointer], ebx
        call    cd_calculate_cache_1
        lea     esi, [edi*8+esi]
        mov     [esi], eax      ; sector number
;--------------------------------------
.yeshdcache:
        mov     esi, edi
        shl     esi, 11 ;9
        push    eax
        call    cd_calculate_cache_2
        add     esi, eax
        pop     eax
        mov     edi, ebx ;[CDDataBuf_pointer]
        mov     ecx, 512 ;/4
        cld
        rep movsd               ; move data
;--------------------------------------
.exit:
        popad
        ret
;-----------------------------------------------------------------------------
ReadCDWRetr_1:
        pushad
; Loop until the command is successful or the number of attempts is over
 
        mov     ecx, MaxRetr
;--------------------------------------
align 4
@@NextRetr:
; Send a command
;*************************************************
;*      FULL READ OF COMPACT DISK SECTOR         *
;* User data, subchannel                         *
;* information and control information are read  *
;* Input parameters are passed through global    *
;* variables:                                    *
;* ChannelNumber - channel number;               *
;* DiskNumber - disc number on channel;          *
;* CDSectorAddress - address of reading sector.  *
;* The data is read into the CDDataBuf array.    *
;*************************************************
;ReadCD:
        push    ecx
; Flush the packet command buffer
        call    clear_packet_buffer
 
; Generate a packet command to read a data sector
; Set the command code Read CD
        mov     [PacketCommand], byte 0x28 ;0xBE
; Set the sector address
        mov     ax, word [CDSectorAddress+2]
        xchg    al, ah
        mov     word [PacketCommand+2], ax
        mov     ax, word [CDSectorAddress]
        xchg    al, ah
        mov     word [PacketCommand+4], ax
; Set the number of sectors to read
        mov     [PacketCommand+8], byte 1
; Send a command
        call    SendPacketDatCommand
        pop     ecx
 
        test    eax, eax
        jz      @@End_4
 
        or      ecx, ecx        ;{SPraid.simba} (for cd load)
        jz      @@End_4
 
        dec     ecx
 
        cmp     [timer_ticks_enable], 0
        jne     @f
 
        mov     eax, NoTickWaitTime
;--------------------------------------
align 4
.wait:
        dec     eax
        jz      @@NextRetr
 
        jmp     .wait
;--------------------------------------
align 4
@@:
        loop    @@NextRetr
;--------------------------------------
@@End_4:
        mov     dword [DevErrorCode], eax
        popad
        ret
;-----------------------------------------------------------------------------
 
; General purpose procedures to execute packet commands in PIO Mode
; Maximum allowable waiting time for the device to respond to a packet command (in ticks)
 
;-----------------------------------------------------------------------------
MaxCDWaitTime = 1000 ;200 ;10 seconds
uglobal
; Memory area for generating a packet command
PacketCommand:
                 rb 12  ;DB 12 DUP (?)
; address of reading data sector
CDSectorAddress:   dd ?
; Start time of the next disk operation
TickCounter_1     dd 0
; Time to start waiting for device readiness
WURStartTime      dd 0
; pointer to buffer to read data into
CDDataBuf_pointer dd 0
endg
;-----------------------------------------------------------------------------
;****************************************************
;*    SEND TO ATAPI DEVICE PACKET COMMAND,          *
;* THAT MEANS TRASMIT ONE DATA SECTOR OF SIZE       *
;*     2048 BYTE FROM DEVICE TO HOST                *
;* Input parameters are passed through global       *
;* variables:                                       *
;* ChannelNumber - channel number;                  *
;* DiskNumber - disk number on channel.             *
;* PacketCommand - 12-byte command packet;          *
;* CDBlockSize - size of receiving data block.      *
; return eax DevErrorCode
;****************************************************
SendPacketDatCommand:
        xor     eax, eax
; Set CHS mode
        mov     byte [ATAAddressMode], al
; Send ATA command to send packet command
        mov     byte [ATAFeatures], al
        mov     byte [ATASectorCount], al
        mov     byte [ATASectorNumber], al
; Load the size of the sending block
        mov     [ATAHead], al
        mov     [ATACylinder], CDBlockSize
        mov     [ATACommand], 0xA0
        call    SendCommandToHDD_1
        test    eax, eax
        jnz     @@End_8    ; finish, saving the error code
; Waiting for the drive to be ready to receive a packet command
 
        mov     dx, [ATABasePortAddr]
        add     dx, 7    ; port 1x7h
        mov     ecx, NoTickWaitTime
;--------------------------------------
align 4
@@WaitDevice0:
        cmp     [timer_ticks_enable], 0
        jne     @f
 
        dec     ecx
        jz      @@Err1_1
 
        jmp     .test
;--------------------------------------
align 4
@@:
        call    change_task
        ; Check command execution time
        mov     eax, [timer_ticks]
        sub     eax, [TickCounter_1]
        cmp     eax, BSYWaitTime
        ja      @@Err1_1   ; time out error
        ; Check readiness
;--------------------------------------
align 4
.test:
        in      al, dx
        test    al, 0x80  ; BSY signal state
        jnz     @@WaitDevice0
 
        test    al, 1     ; ERR signal state
        jnz     @@Err6
 
        test    al, 0x8   ; DRQ signal state
        jz      @@WaitDevice0
; Send a packet command
        cli
        mov     dx, [ATABasePortAddr]
        mov     ax, [PacketCommand]
        out     dx, ax
        mov     ax, [PacketCommand+2]
        out     dx, ax
        mov     ax, [PacketCommand+4]
        out     dx, ax
        mov     ax, [PacketCommand+6]
        out     dx, ax
        mov     ax, [PacketCommand+8]
        out     dx, ax
        mov     ax, [PacketCommand+10]
        out     dx, ax
        sti
; Waiting for data to be ready
        mov     dx, [ATABasePortAddr]
        add     dx, 7  ; port 1x7h
        mov     ecx, NoTickWaitTime
;--------------------------------------
align 4
@@WaitDevice1:
        cmp     [timer_ticks_enable], 0
        jne     @f
 
        dec     ecx
        jz      @@Err1_1
 
        jmp     .test_1
;--------------------------------------
align 4
@@:
        call    change_task
        ; Check command execution time
        mov     eax, [timer_ticks]
        sub     eax, [TickCounter_1]
        cmp     eax, MaxCDWaitTime
        ja      @@Err1_1   ; time out error
        ; Check readiness
;--------------------------------------
align 4
.test_1:
        in      al, dx
        test    al, 0x80  ; BSY signal state
        jnz     @@WaitDevice1
 
        test    al, 1    ; ERR signal state
        jnz     @@Err6_temp
 
        test    al, 0x8  ; DRQ signal state
        jz      @@WaitDevice1
; Receive data block from controller
        mov     edi, [CDDataBuf_pointer]
        ; Load controller's data register address
        mov     dx, [ATABasePortAddr]
        ; Load the block size in bytes into the counter
        xor     ecx, ecx
        mov     cx, CDBlockSize
        ; Calculate block size in 16-bit words
        shr     cx, 1 ; divide block size by 2
        ; Receive data block
        cli
        cld
        rep insw
        sti
;--------------------------------------
; Successful completion of data receive
@@End_8:
        xor     eax, eax
        ret
;--------------------------------------
; Write error code
@@Err1_1:
        xor     eax, eax
        inc     eax
        ret
;--------------------------------------
@@Err6_temp:
        mov     eax, 7
        ret
;--------------------------------------
@@Err6:
        mov     eax, 6
        ret
;-----------------------------------------------------------------------------
;***********************************************
;*  SEND TO ATAPI DEVICE PACKET COMMAND,       *
;*     THAT DOESNT MEAN TRANSMIT DATA          *
;* Input parameters are passed through global  *
;* variables:                                  *
;* ChannelNumber - channel number;             *
;* DiskNumber - disk number on channel.        *
;* PacketCommand - 12-byte command packet.     *
;***********************************************
SendPacketNoDatCommand:
        pushad
        xor     eax, eax
; Set CHS mode
        mov     byte [ATAAddressMode], al
; Send ATA command to send packet command
        mov     byte [ATAFeatures], al
        mov     byte [ATASectorCount], al
        mov     byte [ATASectorNumber], al
        mov     word [ATACylinder], ax
        mov     byte [ATAHead], al
        mov     [ATACommand], 0xA0
        call    SendCommandToHDD_1
        test    eax, eax
        jnz     @@End_9  ; finish, saving the error code
; Waiting for the drive to be ready to receive a packet command
 
        mov     dx, [ATABasePortAddr]
        add     dx, 7  ; port 1x7h
;--------------------------------------
align 4
@@WaitDevice0_1:
        call    change_task
        ; Check waiting time
        mov     eax, [timer_ticks]
        sub     eax, [TickCounter_1]
        cmp     eax, BSYWaitTime
        ja      @@Err1_3  ; time out error
        ; Check readiness
        in      al, dx
        test    al, 0x80  ; BSY signal state
        jnz     @@WaitDevice0_1
 
        test    al, 1     ; ERR signal state
        jnz     @@Err6_1
 
        test    al, 0x8   ; DRQ signal state
        jz      @@WaitDevice0_1
; Send packet command
;        cli
        mov     dx, [ATABasePortAddr]
        mov     ax, word [PacketCommand]
        out     dx, ax
        mov     ax, word [PacketCommand+2]
        out     dx, ax
        mov     ax, word [PacketCommand+4]
        out     dx, ax
        mov     ax, word [PacketCommand+6]
        out     dx, ax
        mov     ax, word [PacketCommand+8]
        out     dx, ax
        mov     ax, word [PacketCommand+10]
        out     dx, ax
;        sti
        cmp     [ignore_CD_eject_wait], 1
        je      @@clear_DEC
; Waiting for confirmation of command receive
        mov     dx, [ATABasePortAddr]
        add     dx, 7  ; port 1x7h
;--------------------------------------
align 4
@@WaitDevice1_1:
        call    change_task
        ; Check command execution time
        mov     eax, [timer_ticks]
        sub     eax, [TickCounter_1]
        cmp     eax, MaxCDWaitTime
        ja      @@Err1_3   ; time out error
        ; Wait for device release
        in      al, dx
        test    al, 0x80   ; BSY signal state
        jnz     @@WaitDevice1_1
 
        test    al, 1      ; ERR signal state
        jnz     @@Err6_1
 
        test    al, 0x40   ; DRDY signal state
        jz      @@WaitDevice1_1
;--------------------------------------
@@clear_DEC:
        and     [DevErrorCode], 0
        popad
        ret
;--------------------------------------
; Write error code
@@Err1_3:
        xor     eax, eax
        inc     eax
        jmp     @@End_9
;--------------------------------------
@@Err6_1:
        mov     eax, 6
;--------------------------------------
@@End_9:
        mov     [DevErrorCode], eax
        popad
        ret
;-----------------------------------------------------------------------------
;****************************************************
;*          SEND COMMAND TO GIVEN DISK              *
;* Input parameters are passed through the global   *
;* variables:                                       *
;* ChannelNumber - channel number (1 or 2);         *
;* DiskNumber - disk number (0 or 1);               *
;* ATAFeatures - "features";                        *
;* ATASectorCount - sector count;                   *
;* ATASectorNumber - initial sector number;         *
;* ATACylinder - initial cylinder number;           *
;* ATAHead - initial head number;                   *
;* ATAAddressMode - addressing mode (0-CHS, 1-LBA); *
;* ATACommand - command code.                       *
;* If the function finished successfully:           *
;* in ATABasePortAddr - base address of HDD;        *
;* in DevErrorCode - zero.                          *
;* If error has occured then in DevErrorCode will   *
;* be the error code.                               *
;****************************************************
SendCommandToHDD_1:
; Check the addressing mode code
        cmp     [ATAAddressMode], 1
        ja      @@Err2_4
; Check the channel number correctness
        movzx   ebx, [ChannelNumber]
        dec     ebx
        cmp     ebx, 1
        ja      @@Err3_4
; Set the base address
        shl     ebx, 2
        mov     eax, [cdpos]
        dec     eax
        shr     eax, 2
        imul    eax, sizeof.IDE_DATA
        add     eax, IDE_controller_1
        add     eax, ebx
        mov     ax, [eax+IDE_DATA.BAR0_val]
        mov     [ATABasePortAddr], ax
; Waiting for HDD ready to receive a command
        ; Choose desired disk
        mov     dx, [ATABasePortAddr]
        add     dx, 6   ; address of the heads register
        mov     al, [DiskNumber]
        cmp     al, 1   ; check the disk number
        ja      @@Err4_4
 
        shl     al, 4
        or      al, 10100000b
        out     dx, al
        ; Waiting for disk ready
        inc     dx
        mov     eax, [timer_ticks]
        mov     [TickCounter_1], eax
        mov     ecx, NoTickWaitTime
;--------------------------------------
align 4
@@WaitHDReady_2:
        cmp     [timer_ticks_enable], 0
        jne     @f
 
        dec     ecx
        jz      @@Err1_4
 
        jmp     .test
;--------------------------------------
align 4
@@:
        call    change_task
        ; Check waiting time
        mov     eax, [timer_ticks]
        sub     eax, [TickCounter_1]
        cmp     eax, BSYWaitTime ;300    ; wait for 3 seconds
        ja      @@Err1_4   ; time out error
;--------------------------------------
align 4
.test:
        in      al, dx ; Read the state register
        ; Check the state of BSY signal
        test    al, 0x80
        jnz     @@WaitHDReady_2
        ; Check the state of DRQ signal
        test    al, 0x8
        jnz     @@WaitHDReady_2
; load command to controller's registers
        cli
        mov     dx, [ATABasePortAddr]
        inc     dx      ; "features" register
        mov     al, [ATAFeatures]
        out     dx, al
        inc     dx      ; sector counter
        mov     al, [ATASectorCount]
        out     dx, al
        inc     dx      ; sector number register
        mov     al, [ATASectorNumber]
        out     dx, al
        inc     dx      ; cylinder number (low byte)
        mov     ax, [ATACylinder]
        out     dx, al
        inc     dx      ; cylinder number (high byte)
        mov     al, ah
        out     dx, al
        inc     dx      ; head number / disk number
        mov     al, [DiskNumber]
        shl     al, 4
        cmp     [ATAHead], 0xF ; check head number
        ja      @@Err5_4
 
        or      al, [ATAHead]
        or      al, 10100000b
        mov     ah, [ATAAddressMode]
        shl     ah, 6
        or      al, ah
        out     dx, al
; Send command
        mov     al, [ATACommand]
        inc     dx      ; command register
        out     dx, al
        sti
;--------------------------------------
@@End_10:
        xor     eax, eax
        ret
;--------------------------------------
; Write error code
@@Err1_4:
        xor     eax, eax
        inc     eax
        ret
;--------------------------------------
@@Err2_4:
        mov     eax, 2
        ret
;--------------------------------------
@@Err3_4:
        mov     eax, 3
        ret
;--------------------------------------
@@Err4_4:
        mov     eax, 4
        ret
;--------------------------------------
@@Err5_4:
        mov     eax, 5
        ret
;-----------------------------------------------------------------------------
;*************************************************
;*    WAIT FOR THE DEVICE IS READY FOR WORK      *
;* Input parameters are passed through global    *
;* variables:                                    *
;* ChannelNumber - channel number;               *
;* DiskNumber - disk number on channel.          *
;*************************************************
WaitUnitReady:
        pusha
; Remember the peration start time
        mov     eax, [timer_ticks]
        mov     [WURStartTime], eax
; Clear the packet command buffer
        call    clear_packet_buffer
; Generate TEST UNIT READY command
        mov     [PacketCommand], word 0
; waiting loop for device readiness
        mov     ecx, NoTickWaitTime
;--------------------------------------
align 4
@@SendCommand:
        ; Send readiness check command
        call    SendPacketNoDatCommand
        cmp     [timer_ticks_enable], 0
        jne     @f
 
        cmp     [DevErrorCode], 0
        je      @@End_11
 
        dec     ecx
        jz      .Error
 
        jmp     @@SendCommand
;--------------------------------------
align 4
@@:
        call    change_task
        ; Check the error code
        cmp     [DevErrorCode], 0
        je      @@End_11
        ; Check waiting time
        mov     eax, [timer_ticks]
        sub     eax, [WURStartTime]
        cmp     eax, MaxCDWaitTime
        jb      @@SendCommand
;--------------------------------------
.Error:
        ; time out error
        mov     [DevErrorCode], 1
;--------------------------------------
@@End_11:
        popa
        ret
;-----------------------------------------------------------------------------
;*************************************************
;*            FORBID DISK CHANGE                 *
;* Input parameters are passed through global    *
;* variables:                                    *
;* ChannelNumber - channel number;               *
;* DiskNumber - disk number on channel.          *
;*************************************************
prevent_medium_removal:
        pusha
; Clear the packet command buffer
        call    clear_packet_buffer
; Set command code
        mov     [PacketCommand], byte 0x1E
; Set "Forbid" code
        mov     [PacketCommand+4], byte 11b
; Send command
        call    SendPacketNoDatCommand
        mov     eax, ATAPI_IDE0_lock
        add     eax, [cdpos]
        dec     eax
        mov     [eax], byte 1
        popa
        ret
;-----------------------------------------------------------------------------
;*************************************************
;*            ALLOW DISK CHANGE                  *
;* Input parameters are passed through global    *
;* variables:                                    *
;* ChannelNumber - channel number;               *
;* DiskNumber - disk number on channel.          *
;*************************************************
allow_medium_removal:
        pusha
; Clear the packet command buffer
        call    clear_packet_buffer
; Set command code
        mov     [PacketCommand], byte 0x1E
; unset "Forbid" code
        mov     [PacketCommand+4], byte 0
; Send command
        call    SendPacketNoDatCommand
        mov     eax, ATAPI_IDE0_lock
        add     eax, [cdpos]
        dec     eax
        mov     [eax], byte 0
        popa
        ret
;-----------------------------------------------------------------------------
;*************************************************
;*         LOAD DISK TO THE DRIVE                *
;* Input parameters are passed through global    *
;* variables:                                    *
;* ChannelNumber - channel number;               *
;* DiskNumber - disk number on channel.          *
;*************************************************
LoadMedium:
        pusha
; Clear the packet command buffer
        call    clear_packet_buffer
; Generate START/STOP UNIT command
        ; Set command code
        mov     [PacketCommand], word 0x1B
        ; Set disk loading operation
        mov     [PacketCommand+4], word 00000011b
; Send command
        call    SendPacketNoDatCommand
        popa
        ret
;-----------------------------------------------------------------------------
;*************************************************
;*         REMOVE THE DISK FROM THE DRIVE        *
;* Input parameters are passed through global    *
;* variables:                                    *
;* ChannelNumber - channel number;               *
;* DiskNumber - disk number on channel.          *
;*************************************************
EjectMedium:
        pusha
; Clear the packet command buffer
        call    clear_packet_buffer
; Generate START/STOP UNIT command
        ; Set command code
        mov     [PacketCommand], word 0x1B
        ; Set the operation to eject disk
        mov     [PacketCommand+4], word 00000010b
; Send command
        call    SendPacketNoDatCommand
        popa
        ret
;-----------------------------------------------------------------------------
;*************************************************
;* Check the event of pressing the eject button  *
;*                                               *
;* Input parameters are passed through global    *
;* variables:                                    *
;* ChannelNumber - channel number;               *
;* DiskNumber - disk number on channel.          *
;*************************************************
proc check_ATAPI_device_event_has_work?
        mov     eax, [timer_ticks]
        sub     eax, [timer_ATAPI_check]
        cmp     eax, 100
        jb      .no
 
        xor     eax, eax
        inc     eax
        ret
;--------------------------------------
.no:
        xor     eax, eax
        ret
endp
;-----------------------------------------------------------------------------
align 4
check_ATAPI_device_event:
        pusha
        mov     eax, [timer_ticks]
        sub     eax, [timer_ATAPI_check]
        cmp     eax, 100
        jb      .end_1
 
        pushfd
        mov     al, [DRIVE_DATA+1]
        and     al, 11b
        cmp     al, 10b
        jz      .ide3
;--------------------------------------
.ide2_1:
        mov     al, [DRIVE_DATA+1]
        and     al, 1100b
        cmp     al, 1000b
        jz      .ide2
;--------------------------------------
.ide1_1:
        mov     al, [DRIVE_DATA+1]
        and     al, 110000b
        cmp     al, 100000b
        jz      .ide1
;--------------------------------------
.ide0_1:
        mov     al, [DRIVE_DATA+1]
        and     al, 11000000b
        cmp     al, 10000000b
        jz      .ide0
;--------------------------------------
.ide7_1:
        mov     al, [DRIVE_DATA+6]
        and     al, 11b
        cmp     al, 10b
        jz      .ide7
;--------------------------------------
.ide6_1:
        mov     al, [DRIVE_DATA+6]
        and     al, 1100b
        cmp     al, 1000b
        jz      .ide6
;--------------------------------------
.ide5_1:
        mov     al, [DRIVE_DATA+6]
        and     al, 110000b
        cmp     al, 100000b
        jz      .ide5
;--------------------------------------
.ide4_1:
        mov     al, [DRIVE_DATA+6]
        and     al, 11000000b
        cmp     al, 10000000b
        jz      .ide4
;--------------------------------------
.ide11_1:
        mov     al, [DRIVE_DATA+11]
        and     al, 11b
        cmp     al, 10b
        jz      .ide11
;--------------------------------------
.ide10_1:
        mov     al, [DRIVE_DATA+11]
        and     al, 1100b
        cmp     al, 1000b
        jz      .ide10
;--------------------------------------
.ide9_1:
        mov     al, [DRIVE_DATA+11]
        and     al, 110000b
        cmp     al, 100000b
        jz      .ide9
;--------------------------------------
.ide8_1:
        mov     al, [DRIVE_DATA+11]
        and     al, 11000000b
        cmp     al, 10000000b
        jz      .ide8
;--------------------------------------
.end:
        popfd
        mov     eax, [timer_ticks]
        mov     [timer_ATAPI_check], eax
;--------------------------------------
.end_1:
        popa
        ret
;-----------------------------------------------------------------------------
.ide3:
        cli
        cmp     [ATAPI_IDE3_lock], 1
        jne     .ide2_1
 
        cmp     [cd_status], 0
        jne     .end
 
        mov     ecx, ide_channel2_mutex
        call    mutex_lock
        call    reserve_ok2
        mov     [ChannelNumber], 2
        mov     [DiskNumber], 1
        mov     [cdpos], 4
        call    GetEvent_StatusNotification
        cmp     [CDDataBuf+4], byte 1
        jne     @f
 
        call    .eject
;--------------------------------------
@@:
        call    syscall_cdaudio.free
        jmp     .ide2_1
;-----------------------------------------------------------------------------
.ide2:
        cli
        cmp     [ATAPI_IDE2_lock], 1
        jne     .ide1_1
 
        cmp     [cd_status], 0
        jne     .end
 
        mov     ecx, ide_channel2_mutex
        call    mutex_lock
        call    reserve_ok2
        mov     [ChannelNumber], 2
        mov     [DiskNumber], 0
        mov     [cdpos], 3
        call    GetEvent_StatusNotification
        cmp     [CDDataBuf+4], byte 1
        jne     @f
 
        call    .eject
;--------------------------------------
@@:
        call    syscall_cdaudio.free
        jmp     .ide1_1
;-----------------------------------------------------------------------------
.ide1:
        cli
        cmp     [ATAPI_IDE1_lock], 1
        jne     .ide0_1
 
        cmp     [cd_status], 0
        jne     .end
 
        mov     ecx, ide_channel1_mutex
        call    mutex_lock
        call    reserve_ok2
        mov     [ChannelNumber], 1
        mov     [DiskNumber], 1
        mov     [cdpos], 2
        call    GetEvent_StatusNotification
        cmp     [CDDataBuf+4], byte 1
        jne     @f
 
        call    .eject
;--------------------------------------
@@:
        call    syscall_cdaudio.free
        jmp     .ide0_1
;-----------------------------------------------------------------------------
.ide0:
        cli
        cmp     [ATAPI_IDE0_lock], 1
        jne     .ide7_1
 
        cmp     [cd_status], 0
        jne     .end
 
        mov     ecx, ide_channel1_mutex
        call    mutex_lock
        call    reserve_ok2
        mov     [ChannelNumber], 1
        mov     [DiskNumber], 0
        mov     [cdpos], 1
        call    GetEvent_StatusNotification
        cmp     [CDDataBuf+4], byte 1
        jne     @f
 
        call    .eject
;--------------------------------------
@@:
        call    syscall_cdaudio.free
        jmp     .ide7_1
;-----------------------------------------------------------------------------
.ide7:
        cli
        cmp     [ATAPI_IDE7_lock], 1
        jne     .ide6_1
 
        cmp     [cd_status], 0
        jne     .end
 
        mov     ecx, ide_channel4_mutex
        call    mutex_lock
        call    reserve_ok2
        mov     [ChannelNumber], 2
        mov     [DiskNumber], 1
        mov     [cdpos], 8
        call    GetEvent_StatusNotification
        cmp     [CDDataBuf+4], byte 1
        jne     @f
 
        call    .eject
;--------------------------------------
@@:
        call    syscall_cdaudio.free
        jmp     .ide6_1
;-----------------------------------------------------------------------------
.ide6:
        cli
        cmp     [ATAPI_IDE6_lock], 1
        jne     .ide5_1
 
        cmp     [cd_status], 0
        jne     .end
 
        mov     ecx, ide_channel4_mutex
        call    mutex_lock
        call    reserve_ok2
        mov     [ChannelNumber], 2
        mov     [DiskNumber], 0
        mov     [cdpos], 7
        call    GetEvent_StatusNotification
        cmp     [CDDataBuf+4], byte 1
        jne     @f
 
        call    .eject
;--------------------------------------
@@:
        call    syscall_cdaudio.free
        jmp     .ide5_1
;-----------------------------------------------------------------------------
.ide5:
        cli
        cmp     [ATAPI_IDE5_lock], 1
        jne     .ide4_1
 
        cmp     [cd_status], 0
        jne     .end
 
        mov     ecx, ide_channel3_mutex
        call    mutex_lock
        call    reserve_ok2
        mov     [ChannelNumber], 1
        mov     [DiskNumber], 1
        mov     [cdpos], 6
        call    GetEvent_StatusNotification
        cmp     [CDDataBuf+4], byte 1
        jne     @f
 
        call    .eject
;--------------------------------------
@@:
        call    syscall_cdaudio.free
        jmp     .ide4_1
;-----------------------------------------------------------------------------
.ide4:
        cli
        cmp     [ATAPI_IDE4_lock], 1
        jne     .ide11_1
 
        cmp     [cd_status], 0
        jne     .end
 
        mov     ecx, ide_channel3_mutex
        call    mutex_lock
        call    reserve_ok2
        mov     [ChannelNumber], 1
        mov     [DiskNumber], 0
        mov     [cdpos], 5
        call    GetEvent_StatusNotification
        cmp     [CDDataBuf+4], byte 1
        jne     @f
 
        call    .eject
;--------------------------------------
@@:
        call    syscall_cdaudio.free
        jmp     .ide11_1
;-----------------------------------------------------------------------------
.ide11:
        cli
        cmp     [ATAPI_IDE11_lock], 1
        jne     .ide10_1
 
        cmp     [cd_status], 0
        jne     .end
 
        mov     ecx, ide_channel6_mutex
        call    mutex_lock
        call    reserve_ok2
        mov     [ChannelNumber], 2
        mov     [DiskNumber], 1
        mov     [cdpos], 12
        call    GetEvent_StatusNotification
        cmp     [CDDataBuf+4], byte 1
        jne     @f
 
        call    .eject
;--------------------------------------
@@:
        call    syscall_cdaudio.free
        jmp     .ide10_1
;-----------------------------------------------------------------------------
.ide10:
        cli
        cmp     [ATAPI_IDE10_lock], 1
        jne     .ide9_1
 
        cmp     [cd_status], 0
        jne     .end
 
        mov     ecx, ide_channel6_mutex
        call    mutex_lock
        call    reserve_ok2
        mov     [ChannelNumber], 2
        mov     [DiskNumber], 0
        mov     [cdpos], 11
        call    GetEvent_StatusNotification
        cmp     [CDDataBuf+4], byte 1
        jne     @f
 
        call    .eject
;--------------------------------------
@@:
        call    syscall_cdaudio.free
        jmp     .ide9_1
;-----------------------------------------------------------------------------
.ide9:
        cli
        cmp     [ATAPI_IDE9_lock], 1
        jne     .ide8_1
 
        cmp     [cd_status], 0
        jne     .end
 
        mov     ecx, ide_channel5_mutex
        call    mutex_lock
        call    reserve_ok2
        mov     [ChannelNumber], 1
        mov     [DiskNumber], 1
        mov     [cdpos], 10
        call    GetEvent_StatusNotification
        cmp     [CDDataBuf+4], byte 1
        jne     @f
 
        call    .eject
;--------------------------------------
@@:
        call    syscall_cdaudio.free
        jmp     .ide8_1
;-----------------------------------------------------------------------------
.ide8:
        cli
        cmp     [ATAPI_IDE8_lock], 1
        jne     .end
 
        cmp     [cd_status], 0
        jne     .end
 
        mov     ecx, ide_channel5_mutex
        call    mutex_lock
        call    reserve_ok2
        mov     [ChannelNumber], 1
        mov     [DiskNumber], 0
        mov     [cdpos], 9
        call    GetEvent_StatusNotification
        cmp     [CDDataBuf+4], byte 1
        jne     @f
 
        call    .eject
;--------------------------------------
@@:
        call    syscall_cdaudio.free
        jmp     .end
;-----------------------------------------------------------------------------
.eject:
        call    clear_CD_cache
        call    allow_medium_removal
        mov     [ignore_CD_eject_wait], 1
        call    EjectMedium
        mov     [ignore_CD_eject_wait], 0
        ret
;-----------------------------------------------------------------------------
iglobal
timer_ATAPI_check dd 0
ATAPI_IDE0_lock db 0
ATAPI_IDE1_lock db 0
ATAPI_IDE2_lock db 0
ATAPI_IDE3_lock db 0
ATAPI_IDE4_lock db 0
ATAPI_IDE5_lock db 0
ATAPI_IDE6_lock db 0
ATAPI_IDE7_lock db 0
ATAPI_IDE8_lock db 0
ATAPI_IDE9_lock db 0
ATAPI_IDE10_lock db 0
ATAPI_IDE11_lock db 0
ignore_CD_eject_wait db 0
endg
;-----------------------------------------------------------------------------
;*************************************************
;* Get an event or device status message         *
;*                                               *
;* Input parameters are passed through global    *
;* variables:                                    *
;* ChannelNumber - channel number;               *
;* DiskNumber - disk number on channel           *
;*************************************************
GetEvent_StatusNotification:
        pusha
        mov     [CDDataBuf_pointer], CDDataBuf
; Clear the packet command buffer
        call    clear_packet_buffer
; Set command code
        mov     [PacketCommand], byte 4Ah
        mov     [PacketCommand+1], byte 00000001b
; Set message class request
        mov     [PacketCommand+4], byte 00010000b
; Size of allocated area
        mov     [PacketCommand+7], byte 8h
        mov     [PacketCommand+8], byte 0h
; Send command
        call    SendPacketDatCommand
        popa
        ret
;-----------------------------------------------------------------------------
;*************************************************
; Read information from TOC (Table of contents)  *
;* Input parameters are passed through global    *
;* variables:                                    *
;* ChannelNumber - channel number;               *
;* DiskNumber - disk number on channel           *
;*************************************************
Read_TOC:
        pusha
        mov     [CDDataBuf_pointer], CDDataBuf
; Clear the packet command buffer
        call    clear_packet_buffer
 
; Generate a packet command to read a data sector
        mov     [PacketCommand], byte 0x43
        ; Set format
        mov     [PacketCommand+2], byte 1
; Size of allocated area
        mov     [PacketCommand+7], byte 0xFF
        mov     [PacketCommand+8], byte 0h
; Send a command
        call    SendPacketDatCommand
        popa
        ret
;-----------------------------------------------------------------------------
;*****************************************************
;* DETERMINE THE TOTAL NUMBER OF SECTORS ON THE DISK *
;* Input parameters are passed through global        *
;* variables:                                        *
;* ChannelNumber - channel number;                   *
;* DiskNumber - disk number on channel               *
;*****************************************************
;ReadCapacity:
;       pusha
;; Clear the packet command buffer
;       call  clear_packet_buffer
;; Set the buffer size in bytes
;       mov     [CDBlockSize],8
;; Generate READ CAPACITY command
;       mov     [PacketCommand],word 25h
;; Send command
;       call    SendPacketDatCommand
;       popa
;       ret
;-----------------------------------------------------------------------------
clear_packet_buffer:
; Clear the packet command buffer
        and     [PacketCommand], dword 0
        and     [PacketCommand+4], dword 0
        and     [PacketCommand+8], dword 0
        ret
;-----------------------------------------------------------------------------

Rev 8053	Rev 8054
1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
2	;; ;;	2	;; ;;
3	;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;;	3	;; Copyright (C) KolibriOS team 2004-2015. 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	$Revision: 8053 $	8	$Revision: 8054 $
9		9
10	;-----------------------------------------------------------------------------	10	;-----------------------------------------------------------------------------
11	;**********************************************************	11	;**********************************************************
12	; Direct work with СD (ATAPI) device	12	; Direct work with CD (ATAPI) device
13	;**********************************************************	13	;**********************************************************
14	; Author of a part of the source code - Kulakov Vladimir Gennadievich	14	; Author of a part of the source code - Kulakov Vladimir Gennadievich
15	; Adaptation, revision and development - Mario79,	15	; Adaptation, revision and development - Mario79,
16		16
17	; Maximum number of repeats of a read operation	17	; Maximum number of repeats of a read operation
18	MaxRetr = 10	18	MaxRetr = 10
19	; Maximum waiting time for ready to receive a command	19	; Maximum waiting time for ready to receive a command
20	; (in ticks)	20	; (in ticks)
21	BSYWaitTime = 1000 ;2	21	BSYWaitTime = 1000 ;2
22	NoTickWaitTime = 0xfffff	22	NoTickWaitTime = 0xfffff
23	CDBlockSize = 2048	23	CDBlockSize = 2048
24	;********************************************	24	;********************************************
25	;* ЧТЕНИЕ СЕКТОРА С ПОВТОРАМИ *	25	;* READING SECTOR WITH REPEATS *
26	;* Многократное повторение чтения при сбоях *	26	;* Repeated reads on failures *
27	;********************************************	27	;********************************************
28	ReadCDWRetr:	28	ReadCDWRetr:
29	;-----------------------------------------------------------	29	;-----------------------------------------------------------
30	; input : eax = block to read	30	; input : eax = block to read
31	; ebx = destination	31	; ebx = destination
32	;-----------------------------------------------------------	32	;-----------------------------------------------------------
33	pushad	33	pushad
34	mov eax, [CDSectorAddress]	34	mov eax, [CDSectorAddress]
35	mov ebx, [CDDataBuf_pointer]	35	mov ebx, [CDDataBuf_pointer]
36	call cd_calculate_cache	36	call cd_calculate_cache
37	xor edi, edi	37	xor edi, edi
38	add esi, 8	38	add esi, 8
39	inc edi	39	inc edi
40	;--------------------------------------	40	;--------------------------------------
41	align 4	41	align 4
42	.hdreadcache:	42	.hdreadcache:
43	cmp [esi], eax ; correct sector	43	cmp [esi], eax ; correct sector
44	je .yeshdcache	44	je .yeshdcache
45		45
46	add esi, 8	46	add esi, 8
47	inc edi	47	inc edi
48	dec ecx	48	dec ecx
49	jnz .hdreadcache	49	jnz .hdreadcache
50		50
51	call find_empty_slot_CD_cache ; ret in edi	51	call find_empty_slot_CD_cache ; ret in edi
52		52
53	push edi	53	push edi
54	push eax	54	push eax
55	call cd_calculate_cache_2	55	call cd_calculate_cache_2
56	shl edi, 11	56	shl edi, 11
57	add edi, eax	57	add edi, eax
58	mov [CDDataBuf_pointer], edi	58	mov [CDDataBuf_pointer], edi
59	pop eax	59	pop eax
60	pop edi	60	pop edi
61		61
62	call ReadCDWRetr_1	62	call ReadCDWRetr_1
63	cmp [DevErrorCode], 0	63	cmp [DevErrorCode], 0
64	jne .exit	64	jne .exit
65		65
66	mov [CDDataBuf_pointer], ebx	66	mov [CDDataBuf_pointer], ebx
67	call cd_calculate_cache_1	67	call cd_calculate_cache_1
68	lea esi, [edi*8+esi]	68	lea esi, [edi*8+esi]
69	mov [esi], eax ; sector number	69	mov [esi], eax ; sector number
70	;--------------------------------------	70	;--------------------------------------
71	.yeshdcache:	71	.yeshdcache:
72	mov esi, edi	72	mov esi, edi
73	shl esi, 11 ;9	73	shl esi, 11 ;9
74	push eax	74	push eax
75	call cd_calculate_cache_2	75	call cd_calculate_cache_2
76	add esi, eax	76	add esi, eax
77	pop eax	77	pop eax
78	mov edi, ebx ;[CDDataBuf_pointer]	78	mov edi, ebx ;[CDDataBuf_pointer]
79	mov ecx, 512 ;/4	79	mov ecx, 512 ;/4
80	cld	80	cld
81	rep movsd ; move data	81	rep movsd ; move data
82	;--------------------------------------	82	;--------------------------------------
83	.exit:	83	.exit:
84	popad	84	popad
85	ret	85	ret
86	;-----------------------------------------------------------------------------	86	;-----------------------------------------------------------------------------
87	ReadCDWRetr_1:	87	ReadCDWRetr_1:
88	pushad	88	pushad
89	; Цикл, пока команда не выполнена успешно или не	89	; Loop until the command is successful or the number of attempts is over
90	; исчерпано количество попыток	-
91	mov ecx, MaxRetr	90	mov ecx, MaxRetr
92	;--------------------------------------	91	;--------------------------------------
93	align 4	92	align 4
94	@@NextRetr:	93	@@NextRetr:
95	; Подать команду	94	; Send a command
96	;*************************************************	95	;*************************************************
97	;* ПОЛНОЕ ЧТЕНИЕ СЕКТОРА КОМПАКТ-ДИСКА *	96	;* FULL READ OF COMPACT DISK SECTOR *
98	;* Считываются данные пользователя, информация *	97	;* User data, subchannel *
99	;* субканала и контрольная информация *	98	;* information and control information are read *
100	;* Входные параметры передаются через глобальные *	99	;* Input parameters are passed through global *
101	;* перменные: *	100	;* variables: *
102	;* ChannelNumber - номер канала; *	101	;* ChannelNumber - channel number; *
103	;* DiskNumber - номер диска на канале; *	102	;* DiskNumber - disc number on channel; *
104	;* CDSectorAddress - адрес считываемого сектора. *	103	;* CDSectorAddress - address of reading sector. *
105	;* Данные считывается в массив CDDataBuf. *	104	;* The data is read into the CDDataBuf array. *
106	;*************************************************	105	;*************************************************
107	;ReadCD:	106	;ReadCD:
108	push ecx	107	push ecx
109	; Очистить буфер пакетной команды	108	; Flush the packet command buffer
110	call clear_packet_buffer	109	call clear_packet_buffer
111	; Сформировать пакетную команду для считывания	-
112	; сектора данных	110	; Generate a packet command to read a data sector
113	; Задать код команды Read CD	111	; Set the command code Read CD
114	mov [PacketCommand], byte 0x28 ;0xBE	112	mov [PacketCommand], byte 0x28 ;0xBE
115	; Задать адрес сектора	113	; Set the sector address
116	mov ax, word [CDSectorAddress+2]	114	mov ax, word [CDSectorAddress+2]
117	xchg al, ah	115	xchg al, ah
118	mov word [PacketCommand+2], ax	116	mov word [PacketCommand+2], ax
119	mov ax, word [CDSectorAddress]	117	mov ax, word [CDSectorAddress]
120	xchg al, ah	118	xchg al, ah
121	mov word [PacketCommand+4], ax	119	mov word [PacketCommand+4], ax
122	; Задать количество считываемых секторов	120	; Set the number of sectors to read
123	mov [PacketCommand+8], byte 1	121	mov [PacketCommand+8], byte 1
124	; Подать команду	122	; Send a command
125	call SendPacketDatCommand	123	call SendPacketDatCommand
126	pop ecx	124	pop ecx
127		125
128	test eax, eax	126	test eax, eax
129	jz @@End_4	127	jz @@End_4
130		128
131	or ecx, ecx ;{SPraid.simba} (for cd load)	129	or ecx, ecx ;{SPraid.simba} (for cd load)
132	jz @@End_4	130	jz @@End_4
133		131
134	dec ecx	132	dec ecx
135		133
136	cmp [timer_ticks_enable], 0	134	cmp [timer_ticks_enable], 0
137	jne @f	135	jne @f
138		136
139	mov eax, NoTickWaitTime	137	mov eax, NoTickWaitTime
140	;--------------------------------------	138	;--------------------------------------
141	align 4	139	align 4
142	.wait:	140	.wait:
143	dec eax	141	dec eax
144	jz @@NextRetr	142	jz @@NextRetr
145		143
146	jmp .wait	144	jmp .wait
147	;--------------------------------------	145	;--------------------------------------
148	align 4	146	align 4
149	@@:	147	@@:
150	loop @@NextRetr	148	loop @@NextRetr
151	;--------------------------------------	149	;--------------------------------------
152	@@End_4:	150	@@End_4:
153	mov dword [DevErrorCode], eax	151	mov dword [DevErrorCode], eax
154	popad	152	popad
155	ret	153	ret
156	;-----------------------------------------------------------------------------	154	;-----------------------------------------------------------------------------
157	; Универсальные процедуры, обеспечивающие выполнение	-
158	; пакетных команд в режиме PIO	155	; General purpose procedures to execute packet commands in PIO Mode
159	; Максимально допустимое время ожидания реакции	156	; Maximum allowable waiting time for the device to respond to a packet command (in ticks)
160	; устройства на пакетную команду (в тиках)	-
161	;-----------------------------------------------------------------------------	157	;-----------------------------------------------------------------------------
162	MaxCDWaitTime = 1000 ;200 ;10 секунд	158	MaxCDWaitTime = 1000 ;200 ;10 seconds
163	uglobal	159	uglobal
164	; Область памяти для формирования пакетной команды	160	; Memory area for generating a packet command
165	PacketCommand:	161	PacketCommand:
166	rb 12 ;DB 12 DUP (?)	162	rb 12 ;DB 12 DUP (?)
167	; Адрес считываемого сектора данных	163	; address of reading data sector
168	CDSectorAddress: dd ?	164	CDSectorAddress: dd ?
169	; Время начала очередной операции с диском	165	; Start time of the next disk operation
170	TickCounter_1 dd 0	166	TickCounter_1 dd 0
171	; Время начала ожидания готовности устройства	167	; Time to start waiting for device readiness
172	WURStartTime dd 0	168	WURStartTime dd 0
173	; указатель буфера для считывания	169	; pointer to buffer to read data into
174	CDDataBuf_pointer dd 0	170	CDDataBuf_pointer dd 0
175	endg	171	endg
176	;-----------------------------------------------------------------------------	172	;-----------------------------------------------------------------------------
177	;****************************************************	173	;****************************************************
178	;* ПОСЛАТЬ УСТРОЙСТВУ ATAPI ПАКЕТНУЮ КОМАНДУ, *	174	;* SEND TO ATAPI DEVICE PACKET COMMAND, *
179	;* ПРЕДУСМАТРИВАЮЩУЮ ПЕРЕДАЧУ ОДНОГО СЕКТОРА ДАННЫХ *	175	;* THAT MEANS TRASMIT ONE DATA SECTOR OF SIZE *
180	;* РАЗМЕРОМ 2048 БАЙТ ОТ УСТРОЙСТВА К ХОСТУ *	176	;* 2048 BYTE FROM DEVICE TO HOST *
181	;* Входные параметры передаются через глобальные *	177	;* Input parameters are passed through global *
182	;* перменные: *	178	;* variables: *
183	;* ChannelNumber - номер канала; *	179	;* ChannelNumber - channel number; *
184	;* DiskNumber - номер диска на канале; *	180	;* DiskNumber - disk number on channel. *
185	;* PacketCommand - 12-байтный командный пакет; *	181	;* PacketCommand - 12-byte command packet; *
186	;* CDBlockSize - размер принимаемого блока данных. *	182	;* CDBlockSize - size of receiving data block. *
187	; return eax DevErrorCode	183	; return eax DevErrorCode
188	;****************************************************	184	;****************************************************
189	SendPacketDatCommand:	185	SendPacketDatCommand:
190	xor eax, eax	186	xor eax, eax
191	; Задать режим CHS	187	; Set CHS mode
192	mov byte [ATAAddressMode], al	188	mov byte [ATAAddressMode], al
193	; Послать ATA-команду передачи пакетной команды	189	; Send ATA command to send packet command
194	mov byte [ATAFeatures], al	190	mov byte [ATAFeatures], al
195	mov byte [ATASectorCount], al	191	mov byte [ATASectorCount], al
196	mov byte [ATASectorNumber], al	192	mov byte [ATASectorNumber], al
197	; Загрузить размер передаваемого блока	193	; Load the size of the sending block
198	mov [ATAHead], al	194	mov [ATAHead], al
199	mov [ATACylinder], CDBlockSize	195	mov [ATACylinder], CDBlockSize
200	mov [ATACommand], 0xA0	196	mov [ATACommand], 0xA0
201	call SendCommandToHDD_1	197	call SendCommandToHDD_1
202	test eax, eax	198	test eax, eax
203	jnz @@End_8 ;закончить, сохранив код ошибки	199	jnz @@End_8 ; finish, saving the error code
204	; Ожидание готовности дисковода к приему	200	; Waiting for the drive to be ready to receive a packet command
205	; пакетной команды	-
206	mov dx, [ATABasePortAddr]	201	mov dx, [ATABasePortAddr]
207	add dx, 7 ;порт 1х7h	202	add dx, 7 ; port 1x7h
208	mov ecx, NoTickWaitTime	203	mov ecx, NoTickWaitTime
209	;--------------------------------------	204	;--------------------------------------
210	align 4	205	align 4
211	@@WaitDevice0:	206	@@WaitDevice0:
212	cmp [timer_ticks_enable], 0	207	cmp [timer_ticks_enable], 0
213	jne @f	208	jne @f
214		209
215	dec ecx	210	dec ecx
216	jz @@Err1_1	211	jz @@Err1_1
217		212
218	jmp .test	213	jmp .test
219	;--------------------------------------	214	;--------------------------------------
220	align 4	215	align 4
221	@@:	216	@@:
222	call change_task	217	call change_task
223	; Проверить время выполнения команды	218	; Check command execution time
224	mov eax, [timer_ticks]	219	mov eax, [timer_ticks]
225	sub eax, [TickCounter_1]	220	sub eax, [TickCounter_1]
226	cmp eax, BSYWaitTime	221	cmp eax, BSYWaitTime
227	ja @@Err1_1 ;ошибка тайм-аута	222	ja @@Err1_1 ; time out error
228	; Проверить готовность	223	; Check readiness
229	;--------------------------------------	224	;--------------------------------------
230	align 4	225	align 4
231	.test:	226	.test:
232	in al, dx	227	in al, dx
233	test al, 0x80 ;состояние сигнала BSY	228	test al, 0x80 ; BSY signal state
234	jnz @@WaitDevice0	229	jnz @@WaitDevice0
235		230
236	test al, 1 ;состояние сигнала ERR	231	test al, 1 ; ERR signal state
237	jnz @@Err6	232	jnz @@Err6
238		233
239	test al, 0x8 ;состояние сигнала DRQ	234	test al, 0x8 ; DRQ signal state
240	jz @@WaitDevice0	235	jz @@WaitDevice0
241	; Послать пакетную команду	236	; Send a packet command
242	cli	237	cli
243	mov dx, [ATABasePortAddr]	238	mov dx, [ATABasePortAddr]
244	mov ax, [PacketCommand]	239	mov ax, [PacketCommand]
245	out dx, ax	240	out dx, ax
246	mov ax, [PacketCommand+2]	241	mov ax, [PacketCommand+2]
247	out dx, ax	242	out dx, ax
248	mov ax, [PacketCommand+4]	243	mov ax, [PacketCommand+4]
249	out dx, ax	244	out dx, ax
250	mov ax, [PacketCommand+6]	245	mov ax, [PacketCommand+6]
251	out dx, ax	246	out dx, ax
252	mov ax, [PacketCommand+8]	247	mov ax, [PacketCommand+8]
253	out dx, ax	248	out dx, ax
254	mov ax, [PacketCommand+10]	249	mov ax, [PacketCommand+10]
255	out dx, ax	250	out dx, ax
256	sti	251	sti
257	; Ожидание готовности данных	252	; Waiting for data to be ready
258	mov dx, [ATABasePortAddr]	253	mov dx, [ATABasePortAddr]
259	add dx, 7 ;порт 1х7h	254	add dx, 7 ; port 1x7h
260	mov ecx, NoTickWaitTime	255	mov ecx, NoTickWaitTime
261	;--------------------------------------	256	;--------------------------------------
262	align 4	257	align 4
263	@@WaitDevice1:	258	@@WaitDevice1:
264	cmp [timer_ticks_enable], 0	259	cmp [timer_ticks_enable], 0
265	jne @f	260	jne @f
266		261
267	dec ecx	262	dec ecx
268	jz @@Err1_1	263	jz @@Err1_1
269		264
270	jmp .test_1	265	jmp .test_1
271	;--------------------------------------	266	;--------------------------------------
272	align 4	267	align 4
273	@@:	268	@@:
274	call change_task	269	call change_task
275	; Проверить время выполнения команды	270	; Check command execution time
276	mov eax, [timer_ticks]	271	mov eax, [timer_ticks]
277	sub eax, [TickCounter_1]	272	sub eax, [TickCounter_1]
278	cmp eax, MaxCDWaitTime	273	cmp eax, MaxCDWaitTime
279	ja @@Err1_1 ;ошибка тайм-аута	274	ja @@Err1_1 ; time out error
280	; Проверить готовность	275	; Check readiness
281	;--------------------------------------	276	;--------------------------------------
282	align 4	277	align 4
283	.test_1:	278	.test_1:
284	in al, dx	279	in al, dx
285	test al, 0x80 ;состояние сигнала BSY	280	test al, 0x80 ; BSY signal state
286	jnz @@WaitDevice1	281	jnz @@WaitDevice1
287		282
288	test al, 1 ;состояние сигнала ERR	283	test al, 1 ; ERR signal state
289	jnz @@Err6_temp	284	jnz @@Err6_temp
290		285
291	test al, 0x8 ;состояние сигнала DRQ	286	test al, 0x8 ; DRQ signal state
292	jz @@WaitDevice1	287	jz @@WaitDevice1
293	; Принять блок данных от контроллера	288	; Receive data block from controller
294	mov edi, [CDDataBuf_pointer]	289	mov edi, [CDDataBuf_pointer]
295	; Загрузить адрес регистра данных контроллера	290	; Load controller's data register address
296	mov dx, [ATABasePortAddr]	291	mov dx, [ATABasePortAddr]
297	; Загрузить в счетчик размер блока в байтах	292	; Load the block size in bytes into the counter
298	xor ecx, ecx	293	xor ecx, ecx
299	mov cx, CDBlockSize	294	mov cx, CDBlockSize
300	; Вычислить размер блока в 16-разрядных словах	295	; Calculate block size in 16-bit words
301	shr cx, 1 ;разделить размер блока на 2	296	shr cx, 1 ; divide block size by 2
302	; Принять блок данных	297	; Receive data block
303	cli	298	cli
304	cld	299	cld
305	rep insw	300	rep insw
306	sti	301	sti
307	;--------------------------------------	302	;--------------------------------------
308	; Успешное завершение приема данных	303	; Successful completion of data receive
309	@@End_8:	304	@@End_8:
310	xor eax, eax	305	xor eax, eax
311	ret	306	ret
312	;--------------------------------------	307	;--------------------------------------
313	; Записать код ошибки	308	; Write error code
314	@@Err1_1:	309	@@Err1_1:
315	xor eax, eax	310	xor eax, eax
316	inc eax	311	inc eax
317	ret	312	ret
318	;--------------------------------------	313	;--------------------------------------
319	@@Err6_temp:	314	@@Err6_temp:
320	mov eax, 7	315	mov eax, 7
321	ret	316	ret
322	;--------------------------------------	317	;--------------------------------------
323	@@Err6:	318	@@Err6:
324	mov eax, 6	319	mov eax, 6
325	ret	320	ret
326	;-----------------------------------------------------------------------------	321	;-----------------------------------------------------------------------------
327	;***********************************************	322	;***********************************************
328	;* ПОСЛАТЬ УСТРОЙСТВУ ATAPI ПАКЕТНУЮ КОМАНДУ, *	323	;* SEND TO ATAPI DEVICE PACKET COMMAND, *
329	;* НЕ ПРЕДУСМАТРИВАЮЩУЮ ПЕРЕДАЧИ ДАННЫХ *	324	;* THAT DOESNT MEAN TRANSMIT DATA *
330	;* Входные параметры передаются через *	325	;* Input parameters are passed through global *
331	;* глобальные перменные: *	326	;* variables: *
332	;* ChannelNumber - номер канала; *	327	;* ChannelNumber - channel number; *
333	;* DiskNumber - номер диска на канале; *	328	;* DiskNumber - disk number on channel. *
334	;* PacketCommand - 12-байтный командный пакет. *	329	;* PacketCommand - 12-byte command packet. *
335	;***********************************************	330	;***********************************************
336	SendPacketNoDatCommand:	331	SendPacketNoDatCommand:
337	pushad	332	pushad
338	xor eax, eax	333	xor eax, eax
339	; Задать режим CHS	334	; Set CHS mode
340	mov byte [ATAAddressMode], al	335	mov byte [ATAAddressMode], al
341	; Послать ATA-команду передачи пакетной команды	336	; Send ATA command to send packet command
342	mov byte [ATAFeatures], al	337	mov byte [ATAFeatures], al
343	mov byte [ATASectorCount], al	338	mov byte [ATASectorCount], al
344	mov byte [ATASectorNumber], al	339	mov byte [ATASectorNumber], al
345	mov word [ATACylinder], ax	340	mov word [ATACylinder], ax
346	mov byte [ATAHead], al	341	mov byte [ATAHead], al
347	mov [ATACommand], 0xA0	342	mov [ATACommand], 0xA0
348	call SendCommandToHDD_1	343	call SendCommandToHDD_1
349	test eax, eax	344	test eax, eax
350	jnz @@End_9 ;закончить, сохранив код ошибки	345	jnz @@End_9 ; finish, saving the error code
351	; Ожидание готовности дисковода к приему	346	; Waiting for the drive to be ready to receive a packet command
352	; пакетной команды	-
353	mov dx, [ATABasePortAddr]	347	mov dx, [ATABasePortAddr]
354	add dx, 7 ;порт 1х7h	348	add dx, 7 ; port 1x7h
355	;--------------------------------------	349	;--------------------------------------
356	align 4	350	align 4
357	@@WaitDevice0_1:	351	@@WaitDevice0_1:
358	call change_task	352	call change_task
359	; Проверить время ожидания	353	; Check waiting time
360	mov eax, [timer_ticks]	354	mov eax, [timer_ticks]
361	sub eax, [TickCounter_1]	355	sub eax, [TickCounter_1]
362	cmp eax, BSYWaitTime	356	cmp eax, BSYWaitTime
363	ja @@Err1_3 ;ошибка тайм-аута	357	ja @@Err1_3 ; time out error
364	; Проверить готовность	358	; Check readiness
365	in al, dx	359	in al, dx
366	test al, 0x80 ;состояние сигнала BSY	360	test al, 0x80 ; BSY signal state
367	jnz @@WaitDevice0_1	361	jnz @@WaitDevice0_1
368		362
369	test al, 1 ;состояние сигнала ERR	363	test al, 1 ; ERR signal state
370	jnz @@Err6_1	364	jnz @@Err6_1
371		365
372	test al, 0x8 ;состояние сигнала DRQ	366	test al, 0x8 ; DRQ signal state
373	jz @@WaitDevice0_1	367	jz @@WaitDevice0_1
374	; Послать пакетную команду	368	; Send packet command
375	; cli	369	; cli
376	mov dx, [ATABasePortAddr]	370	mov dx, [ATABasePortAddr]
377	mov ax, word [PacketCommand]	371	mov ax, word [PacketCommand]
378	out dx, ax	372	out dx, ax
379	mov ax, word [PacketCommand+2]	373	mov ax, word [PacketCommand+2]
380	out dx, ax	374	out dx, ax
381	mov ax, word [PacketCommand+4]	375	mov ax, word [PacketCommand+4]
382	out dx, ax	376	out dx, ax
383	mov ax, word [PacketCommand+6]	377	mov ax, word [PacketCommand+6]
384	out dx, ax	378	out dx, ax
385	mov ax, word [PacketCommand+8]	379	mov ax, word [PacketCommand+8]
386	out dx, ax	380	out dx, ax
387	mov ax, word [PacketCommand+10]	381	mov ax, word [PacketCommand+10]
388	out dx, ax	382	out dx, ax
389	; sti	383	; sti
390	cmp [ignore_CD_eject_wait], 1	384	cmp [ignore_CD_eject_wait], 1
391	je @@clear_DEC	385	je @@clear_DEC
392	; Ожидание подтверждения приема команды	386	; Waiting for confirmation of command receive
393	mov dx, [ATABasePortAddr]	387	mov dx, [ATABasePortAddr]
394	add dx, 7 ;порт 1х7h	388	add dx, 7 ; port 1x7h
395	;--------------------------------------	389	;--------------------------------------
396	align 4	390	align 4
397	@@WaitDevice1_1:	391	@@WaitDevice1_1:
398	call change_task	392	call change_task
399	; Проверить время выполнения команды	393	; Check command execution time
400	mov eax, [timer_ticks]	394	mov eax, [timer_ticks]
401	sub eax, [TickCounter_1]	395	sub eax, [TickCounter_1]
402	cmp eax, MaxCDWaitTime	396	cmp eax, MaxCDWaitTime
403	ja @@Err1_3 ;ошибка тайм-аута	397	ja @@Err1_3 ; time out error
404	; Ожидать освобождения устройства	398	; Wait for device release
405	in al, dx	399	in al, dx
406	test al, 0x80 ;состояние сигнала BSY	400	test al, 0x80 ; BSY signal state
407	jnz @@WaitDevice1_1	401	jnz @@WaitDevice1_1
408		402
409	test al, 1 ;состояние сигнала ERR	403	test al, 1 ; ERR signal state
410	jnz @@Err6_1	404	jnz @@Err6_1
411		405
412	test al, 0x40 ;состояние сигнала DRDY	406	test al, 0x40 ; DRDY signal state
413	jz @@WaitDevice1_1	407	jz @@WaitDevice1_1
414	;--------------------------------------	408	;--------------------------------------
415	@@clear_DEC:	409	@@clear_DEC:
416	and [DevErrorCode], 0	410	and [DevErrorCode], 0
417	popad	411	popad
418	ret	412	ret
419	;--------------------------------------	413	;--------------------------------------
420	; Записать код ошибки	414	; Write error code
421	@@Err1_3:	415	@@Err1_3:
422	xor eax, eax	416	xor eax, eax
423	inc eax	417	inc eax
424	jmp @@End_9	418	jmp @@End_9
425	;--------------------------------------	419	;--------------------------------------
426	@@Err6_1:	420	@@Err6_1:
427	mov eax, 6	421	mov eax, 6
428	;--------------------------------------	422	;--------------------------------------
429	@@End_9:	423	@@End_9:
430	mov [DevErrorCode], eax	424	mov [DevErrorCode], eax
431	popad	425	popad
432	ret	426	ret
433	;-----------------------------------------------------------------------------	427	;-----------------------------------------------------------------------------
434	;****************************************************	428	;****************************************************
435	;* ПОСЛАТЬ КОМАНДУ ЗАДАННОМУ ДИСКУ *	429	;* SEND COMMAND TO GIVEN DISK *
436	;* Входные параметры передаются через глобальные *	430	;* Input parameters are passed through the global *
437	;* переменные: *	431	;* variables: *
438	;* ChannelNumber - номер канала (1 или 2); *	432	;* ChannelNumber - channel number (1 or 2); *
439	;* DiskNumber - номер диска (0 или 1); *	433	;* DiskNumber - disk number (0 or 1); *
440	;* ATAFeatures - "особенности"; *	434	;* ATAFeatures - "features"; *
441	;* ATASectorCount - количество секторов; *	435	;* ATASectorCount - sector count; *
442	;* ATASectorNumber - номер начального сектора; *	436	;* ATASectorNumber - initial sector number; *
443	;* ATACylinder - номер начального цилиндра; *	437	;* ATACylinder - initial cylinder number; *
444	;* ATAHead - номер начальной головки; *	438	;* ATAHead - initial head number; *
445	;* ATAAddressMode - режим адресации (0-CHS, 1-LBA); *	439	;* ATAAddressMode - addressing mode (0-CHS, 1-LBA); *
446	;* ATACommand - код команды. *	440	;* ATACommand - command code. *
447	;* После успешного выполнения функции: *	441	;* If the function finished successfully: *
448	;* в ATABasePortAddr - базовый адрес HDD; *	442	;* in ATABasePortAddr - base address of HDD; *
449	;* в DevErrorCode - ноль. *	443	;* in DevErrorCode - zero. *
450	;* При возникновении ошибки в DevErrorCode будет *	444	;* If error has occured then in DevErrorCode will *
451	;* возвращен код ошибки в eax *	445	;* be the error code. *
452	;****************************************************	446	;****************************************************
453	SendCommandToHDD_1:	447	SendCommandToHDD_1:
454	; Проверить значение кода режима	448	; Check the addressing mode code
455	cmp [ATAAddressMode], 1	449	cmp [ATAAddressMode], 1
456	ja @@Err2_4	450	ja @@Err2_4
457	; Проверить корректность номера канала	451	; Check the channel number correctness
458	movzx ebx, [ChannelNumber]	452	movzx ebx, [ChannelNumber]
459	dec ebx	453	dec ebx
460	cmp ebx, 1	454	cmp ebx, 1
461	ja @@Err3_4	455	ja @@Err3_4
462	; Установить базовый адрес	456	; Set the base address
463	shl ebx, 2	457	shl ebx, 2
464	mov eax, [cdpos]	458	mov eax, [cdpos]
465	dec eax	459	dec eax
466	shr eax, 2	460	shr eax, 2
467	imul eax, sizeof.IDE_DATA	461	imul eax, sizeof.IDE_DATA
468	add eax, IDE_controller_1	462	add eax, IDE_controller_1
469	add eax, ebx	463	add eax, ebx
470	mov ax, [eax+IDE_DATA.BAR0_val]	464	mov ax, [eax+IDE_DATA.BAR0_val]
471	mov [ATABasePortAddr], ax	465	mov [ATABasePortAddr], ax
472	; Ожидание готовности HDD к приему команды	466	; Waiting for HDD ready to receive a command
473	; Выбрать нужный диск	467	; Choose desired disk
474	mov dx, [ATABasePortAddr]	468	mov dx, [ATABasePortAddr]
475	add dx, 6 ;адрес регистра головок	469	add dx, 6 ; address of the heads register
476	mov al, [DiskNumber]	470	mov al, [DiskNumber]
477	cmp al, 1 ;проверить номера диска	471	cmp al, 1 ; check the disk number
478	ja @@Err4_4	472	ja @@Err4_4
479		473
480	shl al, 4	474	shl al, 4
481	or al, 10100000b	475	or al, 10100000b
482	out dx, al	476	out dx, al
483	; Ожидать, пока диск не будет готов	477	; Waiting for disk ready
484	inc dx	478	inc dx
485	mov eax, [timer_ticks]	479	mov eax, [timer_ticks]
486	mov [TickCounter_1], eax	480	mov [TickCounter_1], eax
487	mov ecx, NoTickWaitTime	481	mov ecx, NoTickWaitTime
488	;--------------------------------------	482	;--------------------------------------
489	align 4	483	align 4
490	@@WaitHDReady_2:	484	@@WaitHDReady_2:
491	cmp [timer_ticks_enable], 0	485	cmp [timer_ticks_enable], 0
492	jne @f	486	jne @f
493		487
494	dec ecx	488	dec ecx
495	jz @@Err1_4	489	jz @@Err1_4
496		490
497	jmp .test	491	jmp .test
498	;--------------------------------------	492	;--------------------------------------
499	align 4	493	align 4
500	@@:	494	@@:

Subversion Repositories Kolibri OS

(root)/kernel/trunk/blkdev/cd_drv.inc @ 3598 – Rev 8053 → 8054