Subversion Repositories Kolibri OS

Rev

Rev 425 | Rev 538 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. $Revision: 431 $
  2. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  3. ;;                                                              ;;
  4. ;; Copyright (C) KolibriOS team 2004-2007. All rights reserved. ;;
  5. ;; Distributed under terms of the GNU General Public License    ;;
  6. ;;                                                              ;;
  7. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  8.  
  9. ;**********************************************************
  10. ;  Íåïîñðåäñòâåííàÿ ðàáîòà ñ óñòðîéñòâîì ÑD (ATAPI)
  11. ;**********************************************************
  12. ; Àâòîð èñõîäíîãî òåêñòà  Êóëàêîâ Âëàäèìèð Ãåííàäüåâè÷.
  13. ; Àäàïòàöèÿ è äîðàáîòêà Mario79
  14.  
  15. ;        Ïðîöåäóðà äëÿ ïîëíîãî ñ÷èòûâàíèÿ âñåõ
  16. ;           äàííûõ èç ñåêòîðà êîìïàêò-äèñêà
  17. ; Àâòîð òåêñòà ïðîãðàììû Êóëàêîâ Âëàäèìèð Ãåííàäüåâè÷.
  18.  
  19.  
  20. ; Ìàêñèìàëüíîå êîëè÷åñòâî ïîâòîðåíèé îïåðàöèè ÷òåíèÿ
  21. MaxRetr equ 3
  22. ; Ïðåäåëüíîå âðåìÿ îæèäàíèÿ ãîòîâíîñòè ê ïðèåìó êîìàíäû
  23. ; (â òèêàõ)
  24. BSYWaitTime equ 1000  ;2
  25.  
  26. ;*************************************************
  27. ;*      ÏÎËÍÎÅ ×ÒÅÍÈÅ ÑÅÊÒÎÐÀ ÊÎÌÏÀÊÒ-ÄÈÑÊÀ      *
  28. ;* Ñ÷èòûâàþòñÿ äàííûå ïîëüçîâàòåëÿ, èíôîðìàöèÿ   *
  29. ;* ñóáêàíàëà è êîíòðîëüíàÿ èíôîðìàöèÿ            *
  30. ;* Âõîäíûå ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç ãëîáàëüíûå *
  31. ;* ïåðìåííûå:                                    *
  32. ;* ChannelNumber - íîìåð êàíàëà;                 *
  33. ;* DiskNumber - íîìåð äèñêà íà êàíàëå;           *
  34. ;* CDSectorAddress - àäðåñ ñ÷èòûâàåìîãî ñåêòîðà. *
  35. ;* Äàííûå ñ÷èòûâàåòñÿ â ìàññèâ CDDataBuf.        *
  36. ;*************************************************
  37. ReadCD:
  38.         pusha
  39. ; Çàäàòü ðàçìåð ñåêòîðà
  40.         mov     [CDBlockSize],2048 ;2352
  41. ; Î÷èñòèòü áóôåð ïàêåòíîé êîìàíäû
  42.         call  clear_packet_buffer
  43. ; Ñôîðìèðîâàòü ïàêåòíóþ êîìàíäó äëÿ ñ÷èòûâàíèÿ
  44. ; ñåêòîðà äàííûõ
  45.         ; Çàäàòü êîä êîìàíäû Read CD
  46.         mov     [PacketCommand],byte 0x28  ;0xBE
  47.         ; Çàäàòü àäðåñ ñåêòîðà
  48.         mov     AX,word [CDSectorAddress+2]
  49.         xchg    AL,AH
  50.         mov     word [PacketCommand+2],AX
  51.         mov     AX,word [CDSectorAddress]
  52.         xchg    AL,AH
  53.         mov     word [PacketCommand+4],AX
  54. ;        mov   eax,[CDSectorAddress]
  55. ;        mov   [PacketCommand+2],eax
  56.         ; Çàäàòü êîëè÷åñòâî ñ÷èòûâàåìûõ ñåêòîðîâ
  57.         mov     [PacketCommand+8],byte 1
  58.         ; Çàäàòü ñ÷èòûâàíèå äàííûõ â ïîëíîì îáúåìå
  59. ;        mov     [PacketCommand+9],byte 0xF8
  60. ; Ïîäàòü êîìàíäó
  61.         call    SendPacketDatCommand
  62. ;        call test_mario79
  63.         popa
  64.         ret
  65.  
  66. ;********************************************
  67. ;*        ×ÒÅÍÈÅ ÑÅÊÒÎÐÀ Ñ ÏÎÂÒÎÐÀÌÈ        *
  68. ;* Ìíîãîêðàòíîå ïîâòîðåíèå ÷òåíèÿ ïðè ñáîÿõ *
  69. ;********************************************
  70. ReadCDWRetr:
  71.         pusha
  72. ; Öèêë, ïîêà êîìàíäà íå âûïîëíåíà óñïåøíî èëè íå
  73. ; èñ÷åðïàíî êîëè÷åñòâî ïîïûòîê
  74.         mov     ECX,MaxRetr
  75. @@NextRetr:
  76. ; Ïîäàòü êîìàíäó
  77.         call    ReadCD
  78.         cmp     [DevErrorCode],0
  79.         je      @@End_4
  80. ; Çàäåðæêà íà 2,5 ñåêóíäû
  81.         mov     EAX,[timer_ticks]
  82.         add     EAX,250 ;50
  83. @@Wait:
  84.         call    change_task
  85.         cmp     EAX,[timer_ticks]
  86.         ja      @@Wait
  87.         loop    @@NextRetr
  88. ;        call test_mario79
  89. ; Ñîîáùåíèå îá îøèáêå
  90. ;        mov     SI,offset ErrS
  91. ;        call    FatalError
  92. @@End_4:
  93.         popa
  94.         ret
  95.  
  96.  
  97. ;   Óíèâåðñàëüíûå ïðîöåäóðû, îáåñïå÷èâàþùèå âûïîëíåíèå
  98. ;             ïàêåòíûõ êîìàíä â ðåæèìå PIO
  99. ;
  100. ; Àâòîð òåêñòà ïðîãðàììû Êóëàêîâ Âëàäèìèð Ãåííàäüåâè÷.
  101.  
  102. ; Ìàêñèìàëüíî äîïóñòèìîå âðåìÿ îæèäàíèÿ ðåàêöèè
  103. ; óñòðîéñòâà íà ïàêåòíóþ êîìàíäó (â òèêàõ)
  104. MaxCDWaitTime equ 1000 ;200 ;10 ñåêóíä
  105.  
  106. ; Îáëàñòü ïàìÿòè äëÿ ôîðìèðîâàíèÿ ïàêåòíîé êîìàíäû
  107. PacketCommand:   rb 12  ;DB 12 DUP (?)
  108. ; Îáëàñòü ïàìÿòè äëÿ ïðèåìà äàííûõ îò äèñêîâîäà
  109. ;CDDataBuf       DB 4096 DUP (0)
  110. ; Ðàçìåð ïðèíèìàåìîãî áëîêà äàííûõ â áàéòàõ
  111. CDBlockSize     DW ?
  112. ; Àäðåñ ñ÷èòûâàåìîãî ñåêòîðà äàííûõ
  113. CDSectorAddress: DD ?
  114. ; Âðåìÿ íà÷àëà î÷åðåäíîé îïåðàöèè ñ äèñêîì
  115. TickCounter_1 DD 0
  116. ; Âðåìÿ íà÷àëà îæèäàíèÿ ãîòîâíîñòè óñòðîéñòâà
  117. WURStartTime DD 0
  118. ; óêàçàòåëü áóôåðà äëÿ ñ÷èòûâàíèÿ
  119. CDDataBuf_pointer dd 0
  120.  
  121. ;****************************************************
  122. ;*    ÏÎÑËÀÒÜ ÓÑÒÐÎÉÑÒÂÓ ATAPI ÏÀÊÅÒÍÓÞ ÊÎÌÀÍÄÓ,    *
  123. ;* ÏÐÅÄÓÑÌÀÒÐÈÂÀÞÙÓÞ ÏÅÐÅÄÀ×Ó ÎÄÍÎÃÎ ÑÅÊÒÎÐÀ ÄÀÍÍÛÕ *
  124. ;*     ÐÀÇÌÅÐÎÌ 2048 ÁÀÉÒ ÎÒ ÓÑÒÐÎÉÑÒÂÀ Ê ÕÎÑÒÓ     *
  125. ;* Âõîäíûå ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç ãëîáàëüíûå    *
  126. ;* ïåðìåííûå:                                       *
  127. ;* ChannelNumber - íîìåð êàíàëà;                    *
  128. ;* DiskNumber - íîìåð äèñêà íà êàíàëå;              *
  129. ;* PacketCommand - 12-áàéòíûé êîìàíäíûé ïàêåò;      *
  130. ;* CDBlockSize - ðàçìåð ïðèíèìàåìîãî áëîêà äàííûõ.  *
  131. ;****************************************************
  132. SendPacketDatCommand:
  133.         pushad
  134. ; Çàäàòü ðåæèì CHS
  135.         mov     [ATAAddressMode],0
  136. ; Ïîñëàòü ATA-êîìàíäó ïåðåäà÷è ïàêåòíîé êîìàíäû
  137.         mov     [ATAFeatures],0
  138.         mov     [ATASectorCount],0
  139.         mov     [ATASectorNumber],0
  140.         ; Çàãðóçèòü ðàçìåð ïåðåäàâàåìîãî áëîêà
  141.         mov     AX,[CDBlockSize]
  142.         mov     [ATACylinder],AX
  143.         mov     [ATAHead],0
  144.         mov     [ATACommand],0A0h
  145.         call    SendCommandToHDD_1
  146. ;        call test_mario79
  147.         cmp     [DevErrorCode],0 ;ïðîâåðèòü êîä îøèáêè
  148.         jne     @@End_8    ;çàêîí÷èòü, ñîõðàíèâ êîä îøèáêè
  149.  
  150. ; Îæèäàíèå ãîòîâíîñòè äèñêîâîäà ê ïðèåìó
  151. ; ïàêåòíîé êîìàíäû
  152.         mov     DX,[ATABasePortAddr]
  153.         add     DX,7     ;ïîðò 1õ7h
  154. @@WaitDevice0:
  155.         call    change_task
  156.         ; Ïðîâåðèòü âðåìÿ âûïîëíåíèÿ êîìàíäû
  157.         mov     EAX,[timer_ticks]
  158.         sub     EAX,[TickCounter_1]
  159.         cmp     EAX,BSYWaitTime
  160.         ja      @@Err1_1   ;îøèáêà òàéì-àóòà
  161.         ; Ïðîâåðèòü ãîòîâíîñòü
  162.         in      AL,DX
  163.         test    AL,80h   ;ñîñòîÿíèå ñèãíàëà BSY
  164.         jnz     @@WaitDevice0
  165.         test    AL,1     ;ñîñòîÿíèå ñèãíàëà ERR
  166.         jnz     @@Err6
  167.         test    AL,08h   ;ñîñòîÿíèå ñèãíàëà DRQ
  168.         jz      @@WaitDevice0
  169. ; Ïîñëàòü ïàêåòíóþ êîìàíäó
  170.         cli
  171.         mov     DX,[ATABasePortAddr]
  172.         mov     AX,[PacketCommand]
  173.         out     DX,AX
  174.         mov     AX,[PacketCommand+2]
  175.         out     DX,AX
  176.         mov     AX,[PacketCommand+4]
  177.         out     DX,AX
  178.         mov     AX,[PacketCommand+6]
  179.         out     DX,AX
  180.         mov     AX,[PacketCommand+8]
  181.         out     DX,AX
  182.         mov     AX,[PacketCommand+10]
  183.         out     DX,AX
  184.         sti
  185. ; Îæèäàíèå ãîòîâíîñòè äàííûõ
  186.         mov     DX,[ATABasePortAddr]
  187.         add     DX,7   ;ïîðò 1õ7h
  188. @@WaitDevice1:
  189.         call    change_task
  190.         ; Ïðîâåðèòü âðåìÿ âûïîëíåíèÿ êîìàíäû
  191.         mov     EAX,[timer_ticks]
  192.         sub     EAX,[TickCounter_1]
  193.         cmp     EAX,MaxCDWaitTime
  194.         ja      @@Err1_1   ;îøèáêà òàéì-àóòà
  195.         ; Ïðîâåðèòü ãîòîâíîñòü
  196.         in      AL,DX
  197.         test    AL,80h   ;ñîñòîÿíèå ñèãíàëà BSY
  198.         jnz     @@WaitDevice1
  199.         test    AL,1     ;ñîñòîÿíèå ñèãíàëà ERR
  200.         jnz     @@Err6_temp
  201.         test    AL,08h   ;ñîñòîÿíèå ñèãíàëà DRQ
  202.         jz      @@WaitDevice1
  203.         cli
  204. ; Ïðèíÿòü áëîê äàííûõ îò êîíòðîëëåðà
  205.         mov     EDI,[CDDataBuf_pointer] ;0x7000  ;CDDataBuf
  206.         ; Çàãðóçèòü àäðåñ ðåãèñòðà äàííûõ êîíòðîëëåðà
  207.         mov     DX,[ATABasePortAddr] ;ïîðò 1x0h
  208.         ; Çàãðóçèòü â ñ÷åò÷èê ðàçìåð áëîêà â áàéòàõ
  209.         mov     CX,[CDBlockSize]
  210.         ; Âû÷èñëèòü ðàçìåð áëîêà â 16-ðàçðÿäíûõ ñëîâàõ
  211.         shr     CX,1 ;ðàçäåëèòü ðàçìåð áëîêà íà 2
  212.         ; Ïðèíÿòü áëîê äàííûõ
  213.         cld
  214.         rep     insw
  215.         sti
  216.         ; Óñïåøíîå çàâåðøåíèå ïðèåìà äàííûõ
  217.         jmp @@End_8
  218.  
  219. ; Çàïèñàòü êîä îøèáêè
  220. @@Err1_1:
  221.         mov     [DevErrorCode],1
  222.         jmp @@End_8
  223. @@Err6_temp:
  224.         mov     [DevErrorCode],7
  225.         jmp @@End_8
  226. @@Err6:
  227.         mov     [DevErrorCode],6
  228.  
  229. @@End_8:
  230.         popad
  231.         ret
  232.  
  233.  
  234.  
  235. ;***********************************************
  236. ;*  ÏÎÑËÀÒÜ ÓÑÒÐÎÉÑÒÂÓ ATAPI ÏÀÊÅÒÍÓÞ ÊÎÌÀÍÄÓ, *
  237. ;*     ÍÅ ÏÐÅÄÓÑÌÀÒÐÈÂÀÞÙÓÞ ÏÅÐÅÄÀ×È ÄÀÍÍÛÕ    *
  238. ;* Âõîäíûå ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç          *
  239. ;* ãëîáàëüíûå ïåðìåííûå:                       *
  240. ;* ChannelNumber - íîìåð êàíàëà;               *
  241. ;* DiskNumber - íîìåð äèñêà íà êàíàëå;         *
  242. ;* PacketCommand - 12-áàéòíûé êîìàíäíûé ïàêåò. *
  243. ;***********************************************
  244. SendPacketNoDatCommand:
  245.         pushad
  246. ; Çàäàòü ðåæèì CHS
  247.         mov     [ATAAddressMode],0
  248. ; Ïîñëàòü ATA-êîìàíäó ïåðåäà÷è ïàêåòíîé êîìàíäû
  249.         mov     [ATAFeatures],0
  250.         mov     [ATASectorCount],0
  251.         mov     [ATASectorNumber],0
  252.         mov     [ATACylinder],0
  253.         mov     [ATAHead],0
  254.         mov     [ATACommand],0A0h
  255.         call    SendCommandToHDD_1
  256.         cmp     [DevErrorCode],0 ;ïðîâåðèòü êîä îøèáêè
  257.         jne     @@End_9  ;çàêîí÷èòü, ñîõðàíèâ êîä îøèáêè
  258. ; Îæèäàíèå ãîòîâíîñòè äèñêîâîäà ê ïðèåìó
  259. ; ïàêåòíîé êîìàíäû
  260.         mov     DX,[ATABasePortAddr]
  261.         add     DX,7   ;ïîðò 1õ7h
  262. @@WaitDevice0_1:
  263.         call    change_task
  264.         ; Ïðîâåðèòü âðåìÿ îæèäàíèÿ
  265.         mov     EAX,[timer_ticks]
  266.         sub     EAX,[TickCounter_1]
  267.         cmp     EAX,BSYWaitTime
  268.         ja      @@Err1_3   ;îøèáêà òàéì-àóòà
  269.         ; Ïðîâåðèòü ãîòîâíîñòü
  270.         in      AL,DX
  271.         test    AL,80h   ;ñîñòîÿíèå ñèãíàëà BSY
  272.         jnz     @@WaitDevice0_1
  273.         test    AL,1     ;ñîñòîÿíèå ñèãíàëà ERR
  274.         jnz     @@Err6_1
  275.         test    AL,08h   ;ñîñòîÿíèå ñèãíàëà DRQ
  276.         jz      @@WaitDevice0_1
  277. ; Ïîñëàòü ïàêåòíóþ êîìàíäó
  278. ;        cli
  279.         mov     DX,[ATABasePortAddr]
  280.         mov     AX,word [PacketCommand]
  281.         out     DX,AX
  282.         mov     AX,word [PacketCommand+2]
  283.         out     DX,AX
  284.         mov     AX,word [PacketCommand+4]
  285.         out     DX,AX
  286.         mov     AX,word [PacketCommand+6]
  287.         out     DX,AX
  288.         mov     AX,word [PacketCommand+8]
  289.         out     DX,AX
  290.         mov     AX,word [PacketCommand+10]
  291.         out     DX,AX
  292. ;        sti
  293. ; Îæèäàíèå ïîäòâåðæäåíèÿ ïðèåìà êîìàíäû
  294.         mov     DX,[ATABasePortAddr]
  295.         add     DX,7   ;ïîðò 1õ7h
  296. @@WaitDevice1_1:
  297.         call    change_task
  298.         ; Ïðîâåðèòü âðåìÿ âûïîëíåíèÿ êîìàíäû
  299.         mov     EAX,[timer_ticks]
  300.         sub     EAX,[TickCounter_1]
  301.         cmp     EAX,MaxCDWaitTime
  302.         ja      @@Err1_3   ;îøèáêà òàéì-àóòà
  303.         ; Îæèäàòü îñâîáîæäåíèÿ óñòðîéñòâà
  304.         in      AL,DX
  305.         test    AL,80h   ;ñîñòîÿíèå ñèãíàëà BSY
  306.         jnz     @@WaitDevice1_1
  307.         test    AL,1     ;ñîñòîÿíèå ñèãíàëà ERR
  308.         jnz     @@Err6_1
  309.         test    AL,40h   ;ñîñòîÿíèå ñèãíàëà DRDY
  310.         jz      @@WaitDevice1_1
  311.         jmp @@End_9
  312.  
  313. ; Çàïèñàòü êîä îøèáêè
  314. @@Err1_3:
  315.         mov     [DevErrorCode],1
  316.         jmp @@End_9
  317. @@Err6_1:
  318.         mov     [DevErrorCode],6
  319. @@End_9:
  320.         popad
  321.         ret
  322.  
  323. ;****************************************************
  324. ;*          ÏÎÑËÀÒÜ ÊÎÌÀÍÄÓ ÇÀÄÀÍÍÎÌÓ ÄÈÑÊÓ         *
  325. ;* Âõîäíûå ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç ãëîáàëüíûå    *
  326. ;* ïåðåìåííûå:                                      *
  327. ;* ChannelNumber - íîìåð êàíàëà (1 èëè 2);          *
  328. ;* DiskNumber - íîìåð äèñêà (0 èëè 1);              *
  329. ;* ATAFeatures - "îñîáåííîñòè";                     *
  330. ;* ATASectorCount - êîëè÷åñòâî ñåêòîðîâ;            *
  331. ;* ATASectorNumber - íîìåð íà÷àëüíîãî ñåêòîðà;      *
  332. ;* ATACylinder - íîìåð íà÷àëüíîãî öèëèíäðà;         *
  333. ;* ATAHead - íîìåð íà÷àëüíîé ãîëîâêè;               *
  334. ;* ATAAddressMode - ðåæèì àäðåñàöèè (0-CHS, 1-LBA); *
  335. ;* ATACommand - êîä êîìàíäû.                        *
  336. ;* Ïîñëå óñïåøíîãî âûïîëíåíèÿ ôóíêöèè:              *
  337. ;* â ATABasePortAddr - áàçîâûé àäðåñ HDD;           *
  338. ;* â DevErrorCode - íîëü.                           *
  339. ;* Ïðè âîçíèêíîâåíèè îøèáêè â DevErrorCode áóäåò    *
  340. ;* âîçâðàùåí êîä îøèáêè.                            *
  341. ;****************************************************
  342. SendCommandToHDD_1:
  343.         pushad
  344. ; Ïðîâåðèòü çíà÷åíèå êîäà ðåæèìà
  345.         cmp     [ATAAddressMode],1
  346.         ja      @@Err2_4
  347. ; Ïðîâåðèòü êîððåêòíîñòü íîìåðà êàíàëà
  348.         mov     BX,[ChannelNumber]
  349.         cmp     BX,1
  350.         jb      @@Err3_4
  351.         cmp     BX,2
  352.         ja      @@Err3_4
  353. ; Óñòàíîâèòü áàçîâûé àäðåñ
  354.         dec     BX
  355.         shl     BX,1
  356.         movzx   ebx,bx
  357.         mov     AX,[ebx+StandardATABases]
  358.         mov     [ATABasePortAddr],AX
  359. ; Îæèäàíèå ãîòîâíîñòè HDD ê ïðèåìó êîìàíäû
  360.         ; Âûáðàòü íóæíûé äèñê
  361.         mov     DX,[ATABasePortAddr]
  362.         add     DX,6    ;àäðåñ ðåãèñòðà ãîëîâîê
  363.         mov     AL,[DiskNumber]
  364.         cmp     AL,1    ;ïðîâåðèòü íîìåðà äèñêà
  365.         ja      @@Err4_4
  366.         shl     AL,4
  367.         or      AL,10100000b
  368.         out     DX,AL
  369.         ; Îæèäàòü, ïîêà äèñê íå áóäåò ãîòîâ
  370.         inc     DX
  371. ;        mov  ecx,0xfff
  372.         mov     eax,[timer_ticks]
  373.         mov     [TickCounter_1],eax
  374. @@WaitHDReady_2:
  375.         call    change_task
  376.         ; Ïðîâåðèòü âðåìÿ îæèäàíèÿ
  377. ;        dec  ecx
  378. ;        cmp  ecx,0
  379. ;        je     @@Err1
  380.         mov     eax,[timer_ticks]
  381.         sub     eax,[TickCounter_1]
  382.         cmp     eax,BSYWaitTime ;300    ;îæèäàòü 3 ñåê.        
  383.         ja      @@Err1_4   ;îøèáêà òàéì-àóòà
  384.         ; Ïðî÷èòàòü ðåãèñòð ñîñòîÿíèÿ
  385.         in      AL,DX
  386.         ; Ïðîâåðèòü ñîñòîÿíèå ñèãíàëà BSY
  387.         test    AL,80h
  388.         jnz     @@WaitHDReady_2
  389.         ; Ïðîâåðèòü ñîñòîÿíèå ñèãíàëà DRQ
  390.         test    AL,08h
  391.         jnz     @@WaitHDReady_2
  392. ; Çàãðóçèòü êîìàíäó â ðåãèñòðû êîíòðîëëåðà
  393.         cli
  394.         mov     DX,[ATABasePortAddr]
  395.         inc     DX      ;ðåãèñòð "îñîáåííîñòåé"
  396.         mov     AL,[ATAFeatures]
  397.         out     DX,AL
  398.         inc     DX      ;ñ÷åò÷èê ñåêòîðîâ
  399.         mov     AL,[ATASectorCount]
  400.         out     DX,AL
  401.         inc     DX      ;ðåãèñòð íîìåðà ñåêòîðà
  402.         mov     AL,[ATASectorNumber]
  403.         out     DX,AL
  404.         inc     DX      ;íîìåð öèëèíäðà (ìëàäøèé áàéò)
  405.         mov     AX,[ATACylinder]
  406.         out     DX,AL
  407.         inc     DX      ;íîìåð öèëèíäðà (ñòàðøèé áàéò)
  408.         mov     AL,AH
  409.         out     DX,AL
  410.         inc     DX      ;íîìåð ãîëîâêè/íîìåð äèñêà
  411.         mov     AL,[DiskNumber]
  412.         shl     AL,4
  413.         cmp     [ATAHead],0Fh ;ïðîâåðèòü íîìåð ãîëîâêè
  414.         ja      @@Err5_4
  415.         or      AL,[ATAHead]
  416.         or      AL,10100000b
  417.         mov     AH,[ATAAddressMode]
  418.         shl     AH,6
  419.         or      AL,AH
  420.         out     DX,AL
  421. ; Ïîñëàòü êîìàíäó
  422.         mov     AL,[ATACommand]
  423.         inc     DX      ;ðåãèñòð êîìàíä
  424.         out     DX,AL
  425.         sti
  426. ; Ñáðîñèòü ïðèçíàê îøèáêè
  427.         mov     [DevErrorCode],0
  428.         jmp @@End_10
  429. ; Çàïèñàòü êîä îøèáêè
  430. @@Err1_4:
  431.         mov     [DevErrorCode],1
  432.         jmp @@End_10
  433. @@Err2_4:
  434.         mov     [DevErrorCode],2
  435.         jmp @@End_10
  436. @@Err3_4:
  437.         mov     [DevErrorCode],3
  438.         jmp @@End_10
  439. @@Err4_4:
  440.         mov     [DevErrorCode],4
  441.         jmp @@End_10
  442. @@Err5_4:
  443.         mov     [DevErrorCode],5
  444. ; Çàâåðøåíèå ðàáîòû ïðîãðàììû
  445. @@End_10:
  446.         sti
  447.         popad
  448.         ret
  449.        
  450. ;*************************************************
  451. ;*    ÎÆÈÄÀÍÈÅ ÃÎÒÎÂÍÎÑÒÈ ÓÑÒÐÎÉÑÒÂÀ Ê ÐÀÁÎÒÅ    *
  452. ;* Âõîäíûå ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç ãëîáàëüíûå *
  453. ;* ïåðìåííûå:                                    *
  454. ;* ChannelNumber - íîìåð êàíàëà;                 *
  455. ;* DiskNumber - íîìåð äèñêà íà êàíàëå.           *
  456. ;*************************************************
  457. WaitUnitReady:
  458.         pusha
  459. ; Çàïîìíèòü âðåìÿ íà÷àëà îïåðàöèè
  460.         mov     EAX,[timer_ticks]
  461.         mov     [WURStartTime],EAX
  462. ; Î÷èñòèòü áóôåð ïàêåòíîé êîìàíäû
  463.         call  clear_packet_buffer
  464. ; Ñôîðìèðîâàòü êîìàíäó TEST UNIT READY
  465.         mov     [PacketCommand],word 00h
  466. ; ÖÈÊË ÎÆÈÄÀÍÈß ÃÎÒÎÂÍÎÑÒÈ ÓÑÒÐÎÉÑÒÂÀ
  467. @@SendCommand:
  468.         ; Ïîäàòü êîìàíäó ïðîâåðêè ãîòîâíîñòè
  469.         call    SendPacketNoDatCommand
  470.         call    change_task
  471.         ; Ïðîâåðèòü êîä îøèáêè
  472.         cmp     [DevErrorCode],0
  473.         je      @@End_11
  474.         ; Ïðîâåðèòü âðåìÿ îæèäàíèÿ ãîòîâíîñòè
  475.         mov     EAX,[timer_ticks]
  476.         sub     EAX,[WURStartTime]
  477.         cmp     EAX,MaxCDWaitTime
  478.         jb      @@SendCommand
  479.         ; Îøèáêà òàéì-àóòà
  480.         mov     [DevErrorCode],1
  481. @@End_11:
  482.         popa
  483.         ret
  484.  
  485.        
  486. ;*************************************************
  487. ;*         ÇÀÃÐÓÇÈÒÜ ÍÎÑÈÒÅËÜ Â ÄÈÑÊÎÂÎÄ         *
  488. ;* Âõîäíûå ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç ãëîáàëüíûå *
  489. ;* ïåðìåííûå:                                    *
  490. ;* ChannelNumber - íîìåð êàíàëà;                 *
  491. ;* DiskNumber - íîìåð äèñêà íà êàíàëå.           *
  492. ;*************************************************
  493. LoadMedium:
  494.         pusha
  495. ; Î÷èñòèòü áóôåð ïàêåòíîé êîìàíäû
  496.         call  clear_packet_buffer
  497. ; Ñôîðìèðîâàòü êîìàíäó START/STOP UNIT
  498.         ; Çàäàòü êîä êîìàíäû
  499.         mov     [PacketCommand],word 1Bh
  500.         ; Çàäàòü îïåðàöèþ çàãðóçêè íîñèòåëÿ
  501.         mov     [PacketCommand+4],word 00000011b
  502. ; Ïîäàòü êîìàíäó
  503.         call    SendPacketNoDatCommand
  504.         popa
  505.         ret
  506.  
  507. ;*************************************************
  508. ;*         ÈÇÂËÅ×Ü ÍÎÑÈÒÅËÜ ÈÇ ÄÈÑÊÎÂÎÄÀ         *
  509. ;* Âõîäíûå ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç ãëîáàëüíûå *
  510. ;* ïåðìåííûå:                                    *
  511. ;* ChannelNumber - íîìåð êàíàëà;                 *
  512. ;* DiskNumber - íîìåð äèñêà íà êàíàëå.           *
  513. ;*************************************************
  514. UnloadMedium:
  515.         pusha
  516. ; Î÷èñòèòü áóôåð ïàêåòíîé êîìàíäû
  517.         call  clear_packet_buffer
  518. ; Ñôîðìèðîâàòü êîìàíäó START/STOP UNIT
  519.         ; Çàäàòü êîä êîìàíäû
  520.         mov     [PacketCommand],word 1Bh
  521.         ; Çàäàòü îïåðàöèþ èçâëå÷åíèÿ íîñèòåëÿ
  522.         mov     [PacketCommand+4],word 00000010b
  523. ; Ïîäàòü êîìàíäó
  524.         call    SendPacketNoDatCommand
  525.         popa
  526.         ret
  527.  
  528. ;*************************************************
  529. ;* ÎÏÐÅÄÅËÈÒÜ ÎÁÙÅÅ ÊÎËÈ×ÅÑÒÂÎ ÑÅÊÒÎÐΠÍÀ ÄÈÑÊÅ *
  530. ;* Âõîäíûå ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç ãëîáàëüíûå *
  531. ;* ïåðåìåííûå:                                   *
  532. ;* ChannelNumber - íîìåð êàíàëà;                 *
  533. ;* DiskNumber - íîìåð äèñêà íà êàíàëå.           *
  534. ;*************************************************
  535. ReadCapacity:
  536.         pusha
  537. ; Î÷èñòèòü áóôåð ïàêåòíîé êîìàíäû
  538.         call  clear_packet_buffer
  539. ; Çàäàòü ðàçìåð áóôåðà â áàéòàõ
  540.         mov     [CDBlockSize],8
  541. ; Ñôîðìèðîâàòü êîìàíäó READ CAPACITY
  542.         mov     [PacketCommand],word 25h
  543. ; Ïîäàòü êîìàíäó
  544.         call    SendPacketDatCommand
  545.         popa
  546.         ret
  547.  
  548. clear_packet_buffer:        
  549. ; Î÷èñòèòü áóôåð ïàêåòíîé êîìàíäû
  550.         mov     [PacketCommand],dword 0
  551.         mov     [PacketCommand+4],dword 0
  552.         mov     [PacketCommand+8],dword 0
  553.         ret
  554.  
  555.