Subversion Repositories Kolibri OS

Rev

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

  1. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  2. ;;                                                              ;;
  3. ;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
  4. ;; Distributed under terms of the GNU General Public License    ;;
  5. ;;                                                              ;;
  6. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  7.  
  8. $Revision: 3534 $
  9.  
  10.  
  11. ;**********************************************************
  12. ;  Íåïîñðåäñòâåííàÿ ðàáîòà ñ êîíòðîëëåðîì ãèáêîãî äèñêà
  13. ;**********************************************************
  14. ; Àâòîð èñõîäíîãî òåêñòà  Êóëàêîâ Âëàäèìèð Ãåííàäüåâè÷.
  15. ; Àäàïòàöèÿ è äîðàáîòêà Mario79
  16.  
  17. ;give_back_application_data:  ; ïåðåñëàòü ïðèëîæåíèþ
  18. ;     mov edi,[TASK_BASE]
  19. ;     mov edi,[edi+TASKDATA.mem_start]
  20. ;     add edi,ecx
  21. give_back_application_data_1:
  22.         mov     esi, FDD_BUFF;FDD_DataBuffer  ;0x40000
  23.         xor     ecx, ecx
  24.         mov     cx, 128
  25.         cld
  26.         rep movsd
  27.         ret
  28.  
  29. ;take_data_from_application:   ; âçÿòü èç ïðèëîæåíè
  30. ;     mov esi,[TASK_BASE]
  31. ;     mov esi,[esi+TASKDATA.mem_start]
  32. ;     add esi,ecx
  33. take_data_from_application_1:
  34.         mov     edi, FDD_BUFF;FDD_DataBuffer  ;0x40000
  35.         xor     ecx, ecx
  36.         mov     cx, 128
  37.         cld
  38.         rep movsd
  39.         ret
  40.  
  41. ; Êîäû çàâåðøåíèÿ îïåðàöèè ñ êîíòðîëëåðîì (FDC_Status)
  42. FDC_Normal         equ 0 ;íîðìàëüíîå çàâåðøåíèå
  43. FDC_TimeOut        equ 1 ;îøèáêà òàéì-àóòà
  44. FDC_DiskNotFound   equ 2 ;â äèñêîâîäå íåò äèñêà
  45. FDC_TrackNotFound  equ 3 ;äîðîæêà íå íàéäåíà
  46. FDC_SectorNotFound equ 4 ;ñåêòîð íå íàéäåí
  47.  
  48. ; Ìàêñèìàëüíûå çíà÷åíèÿ êîîðäèíàò ñåêòîðà (çàäàííûå
  49. ; çíà÷åíèÿ ñîîòâåòñòâóþò ïàðàìåòðàì ñòàíäàðòíîãî
  50. ; òðåõäþéìîâîãî ãèáêîãî äèñêà îáúåìîì 1,44 Ìá)
  51. MAX_Track   equ 79
  52. MAX_Head    equ  1
  53. MAX_Sector  equ 18
  54.  
  55. uglobal
  56. ; Ñ÷åò÷èê òèêîâ òàéìåðà
  57. TickCounter dd ?
  58. ; Êîä çàâåðøåíèÿ îïåðàöèè ñ êîíòðîëëåðîì ÍÃÌÄ
  59. FDC_Status  DB ?
  60. ; Ôëàã ïðåðûâàíèÿ îò ÍÃÌÄ
  61. FDD_IntFlag DB ?
  62. ; Ìîìåíò íà÷àëà ïîñëåäíåé îïåðàöèè ñ ÍÃÌÄ
  63. FDD_Time    DD ?
  64. ; Íîìåð äèñêîâîäà
  65. FDD_Type    db 0
  66. ; Êîîðäèíàòû ñåêòîðà
  67. FDD_Track   DB ?
  68. FDD_Head    DB ?
  69. FDD_Sector  DB ?
  70.  
  71. ; Áëîê ðåçóëüòàòà îïåðàöèè
  72. FDC_ST0 DB ?
  73. FDC_ST1 DB ?
  74. FDC_ST2 DB ?
  75. FDC_C   DB ?
  76. FDC_H   DB ?
  77. FDC_R   DB ?
  78. FDC_N   DB ?
  79. ; Ñ÷åò÷èê ïîâòîðåíèÿ îïåðàöèè ÷òåíè
  80. ReadRepCounter  DB ?
  81. ; Ñ÷åò÷èê ïîâòîðåíèÿ îïåðàöèè ðåêàëèáðîâêè
  82. RecalRepCounter DB ?
  83. endg
  84. ; Îáëàñòü ïàìÿòè äëÿ õðàíåíèÿ ïðî÷èòàííîãî ñåêòîðà
  85. ;FDD_DataBuffer:  times 512 db 0   ;DB 512 DUP (?)
  86. fdd_motor_status db 0
  87. timer_fdd_motor  dd 0
  88.  
  89. ;*************************************
  90. ;* ÈÍÈÖÈÀËÈÇÀÖÈß ÐÅÆÈÌÀ ÏÄÏ ÄËß ÍÃÌÄ *
  91. ;*************************************
  92. Init_FDC_DMA:
  93.         pushad
  94.         mov     al, 0
  95.         out     0x0c, al; reset the flip-flop to a known state.
  96.         mov     al, 6           ; mask channel 2 so we can reprogram it.
  97.         out     0x0a, al
  98.         mov     al, [dmamode]; 0x46 -> Read from floppy - 0x4A Write to floppy
  99.         out     0x0b, al
  100.         mov     al, 0
  101.         out     0x0c, al; reset the flip-flop to a known state.
  102.         mov     eax, 0xD000
  103.         out     0x04, al; set the channel 2 starting address to 0
  104.         shr     eax, 8
  105.         out     0x04, al
  106.         shr     eax, 8
  107.         out     0x81, al
  108.         mov     al, 0
  109.         out     0x0c, al; reset flip-flop
  110.         mov     al, 0xff;set count (actual size -1)
  111.         out     0x5, al
  112.         mov     al, 0x1;[dmasize]       ;(0x1ff = 511 / 0x23ff =9215)
  113.         out     0x5, al
  114.         mov     al, 2
  115.         out     0xa, al
  116.         popad
  117.         ret
  118.  
  119. ;***********************************
  120. ;* ÇÀÏÈÑÀÒÜ ÁÀÉÒ Â ÏÎÐÒ ÄÀÍÍÛÕ FDC *
  121. ;* Ïàðàìåòðû:                      *
  122. ;* AL - âûâîäèìûé áàéò.            *
  123. ;***********************************
  124. FDCDataOutput:
  125. ;        pusha
  126.         push    eax ecx edx
  127.         mov     AH, AL    ;çàïîìíèòü áàéò â AH
  128. ; Ñáðîñèòü ïåðåìåííóþ ñîñòîÿíèÿ êîíòðîëëåðà
  129.         mov     [FDC_Status], FDC_Normal
  130. ; Ïðîâåðèòü ãîòîâíîñòü êîíòðîëëåðà ê ïðèåìó äàííûõ
  131.         mov     DX, 3F4h  ;(ïîðò ñîñòîÿíèÿ FDC)
  132.         mov     ecx, 0x10000 ;óñòàíîâèòü ñ÷åò÷èê òàéì-àóòà
  133. @@TestRS:
  134.         in      AL, DX    ;ïðî÷èòàòü ðåãèñòð RS
  135.         and     AL, 0C0h  ;âûäåëèòü ðàçðÿäû 6 è 7
  136.         cmp     AL, 80h   ;ïðîâåðèòü ðàçðÿäû 6 è 7
  137.         je      @@OutByteToFDC
  138.         loop    @@TestRS
  139. ; Îøèáêà òàéì-àóòà
  140.         mov     [FDC_Status], FDC_TimeOut
  141.         jmp     @@End_5
  142. ; Âûâåñòè áàéò â ïîðò äàííûõ
  143. @@OutByteToFDC:
  144.         inc     DX
  145.         mov     AL, AH
  146.         out     DX, AL
  147. @@End_5:
  148. ;        popa
  149.         pop     edx ecx eax
  150.         ret
  151.  
  152. ;******************************************
  153. ;*   ÏÐÎ×ÈÒÀÒÜ ÁÀÉÒ ÈÇ ÏÎÐÒÀ ÄÀÍÍÛÕ FDC   *
  154. ;* Ïðîöåäóðà íå èìååò âõîäíûõ ïàðàìåòðîâ. *
  155. ;* Âûõîäíûå äàííûå:                       *
  156. ;* AL - ñ÷èòàííûé áàéò.                   *
  157. ;******************************************
  158. FDCDataInput:
  159.         push    ECX
  160.         push    DX
  161. ; Ñáðîñèòü ïåðåìåííóþ ñîñòîÿíèÿ êîíòðîëëåðà
  162.         mov     [FDC_Status], FDC_Normal
  163. ; Ïðîâåðèòü ãîòîâíîñòü êîíòðîëëåðà ê ïåðåäà÷å äàííûõ
  164.         mov     DX, 3F4h  ;(ïîðò ñîñòîÿíèÿ FDC)
  165.         xor     CX, CX    ;óñòàíîâèòü ñ÷åò÷èê òàéì-àóòà
  166. @@TestRS_1:
  167.         in      AL, DX    ;ïðî÷èòàòü ðåãèñòð RS
  168.         and     AL, 0C0h  ;âûäëèòü ðàçðÿäû 6 è 7
  169.         cmp     AL, 0C0h  ;ïðîâåðèòü ðàçðÿäû 6 è 7
  170.         je      @@GetByteFromFDC
  171.         loop    @@TestRS_1
  172. ; Îøèáêà òàéì-àóòà
  173.         mov     [FDC_Status], FDC_TimeOut
  174.         jmp     @@End_6
  175. ; Ââåñòè áàéò èç ïîðòà äàííûõ
  176. @@GetByteFromFDC:
  177.         inc     DX
  178.         in      AL, DX
  179. @@End_6:
  180.         pop     DX
  181.         pop     ECX
  182.         ret
  183.  
  184. ;*********************************************
  185. ;* ÎÁÐÀÁÎÒ×ÈÊ ÏÐÅÐÛÂÀÍÈß ÎÒ ÊÎÍÒÐÎËËÅÐÀ ÍÃÌÄ *
  186. ;*********************************************
  187. FDCInterrupt:
  188. ; Óñòàíîâèòü ôëàã ïðåðûâàíè
  189.         mov     [FDD_IntFlag], 1
  190.         ret
  191.  
  192.  
  193. ;******************************************
  194. ;* ÓÑÒÀÍÎÂÈÒÜ ÍÎÂÛÉ ÎÁÐÀÁÎÒ×ÈÊ ÏÐÅÐÛÂÀÍÈÉ *
  195. ;*             ÍÃÌÄ                       *
  196. ;******************************************
  197. SetUserInterrupts:
  198.         mov     [fdc_irq_func], FDCInterrupt
  199.         ret
  200.  
  201. ;*******************************************
  202. ;* ÎÆÈÄÀÍÈÅ ÏÐÅÐÛÂÀÍÈß ÎÒ ÊÎÍÒÐÎËËÅÐÀ ÍÃÌÄ *
  203. ;*******************************************
  204. WaitFDCInterrupt:
  205.         pusha
  206. ; Ñáðîñèòü áàéò ñîñòîÿíèÿ îïåðàöèè
  207.         mov     [FDC_Status], FDC_Normal
  208. ; Ñáðîñèòü ôëàã ïðåðûâàíè
  209.         mov     [FDD_IntFlag], 0
  210. ; Îáíóëèòü ñ÷åò÷èê òèêîâ
  211.         mov     eax, [timer_ticks]
  212.         mov     [TickCounter], eax
  213. ; Îæèäàòü óñòàíîâêè ôëàãà ïðåðûâàíèÿ ÍÃÌÄ
  214. @@TestRS_2:
  215.         cmp     [FDD_IntFlag], 0
  216.         jnz     @@End_7           ;ïðåðûâàíèå ïðîèçîøëî
  217.         call    change_task
  218.         mov     eax, [timer_ticks]
  219.         sub     eax, [TickCounter]
  220.         cmp     eax, 50 ;25   ;5 ;îæèäàòü 5 òèêîâ
  221.         jb      @@TestRS_2
  222. ;        jl      @@TestRS_2
  223. ; Îøèáêà òàéì-àóòà
  224.         mov     [FDC_Status], FDC_TimeOut
  225. ;        mov   [flp_status],0
  226. @@End_7:
  227.         popa
  228.         ret
  229.  
  230. ;*********************************
  231. ;* ÂÊËÞ×ÈÒÜ ÌÎÒÎÐ ÄÈÑÊÎÂÎÄÀ "A:" *
  232. ;*********************************
  233. FDDMotorON:
  234.         pusha
  235. ;        cmp     [fdd_motor_status],1
  236. ;        je      fdd_motor_on
  237.         mov     al, [flp_number]
  238.         cmp     [fdd_motor_status], al
  239.         je      fdd_motor_on
  240. ; Ïðîèçâåñòè ñáðîñ êîíòðîëëåðà ÍÃÌÄ
  241.         mov     DX, 3F2h;ïîðò óïðàâëåíèÿ äâèãàòåëÿìè
  242.         mov     AL, 0
  243.         out     DX, AL
  244. ; Âûáðàòü è âêëþ÷èòü ìîòîð äèñêîâîäà
  245.         cmp     [flp_number], 1
  246.         jne     FDDMotorON_B
  247. ;        call    FDDMotorOFF_B
  248.         mov     AL, 1Ch   ; Floppy A
  249.         jmp     FDDMotorON_1
  250. FDDMotorON_B:
  251. ;        call    FDDMotorOFF_A
  252.         mov     AL, 2Dh   ; Floppy B
  253. FDDMotorON_1:
  254.         out     DX, AL
  255. ; Îáíóëèòü ñ÷åò÷èê òèêîâ
  256.         mov     eax, [timer_ticks]
  257.         mov     [TickCounter], eax
  258. ; Îæèäàòü 0,5 ñ
  259. @@dT:
  260.         call    change_task
  261.         mov     eax, [timer_ticks]
  262.         sub     eax, [TickCounter]
  263.         cmp     eax, 50 ;10
  264.         jb      @@dT
  265.         cmp     [flp_number], 1
  266.         jne     fdd_motor_on_B
  267.         mov     [fdd_motor_status], 1
  268.         jmp     fdd_motor_on
  269. fdd_motor_on_B:
  270.         mov     [fdd_motor_status], 2
  271. fdd_motor_on:
  272.         call    save_timer_fdd_motor
  273.         popa
  274.         ret
  275.  
  276. ;*****************************************
  277. ;*  ÑÎÕÐÀÍÅÍÈÅ ÓÊÀÇÀÒÅËß ÂÐÅÌÅÍÈ         *
  278. ;*****************************************
  279. save_timer_fdd_motor:
  280.         mov     eax, [timer_ticks]
  281.         mov     [timer_fdd_motor], eax
  282.         ret
  283.  
  284. ;*****************************************
  285. ;*  ÏÐÎÂÅÐÊÀ ÇÀÄÅÐÆÊÈ ÂÛÊËÞ×ÅÍÈß ÌÎÒÎÐÀ  *
  286. ;*****************************************
  287. proc check_fdd_motor_status_has_work?
  288.         cmp     [flp_status], 0
  289.         jnz     .yes
  290.         cmp     [fdd_motor_status], 0
  291.         jz      .no
  292.         mov     eax, [timer_ticks]
  293.         sub     eax, [timer_fdd_motor]
  294.         cmp     eax, 500
  295.         jb      .no
  296. .yes:
  297.         xor     eax, eax
  298.         inc     eax
  299.         ret
  300. .no:
  301.         xor     eax, eax
  302.         ret
  303. endp
  304.  
  305. align 4
  306. check_fdd_motor_status:
  307.         cmp     [fdd_motor_status], 0
  308.         je      end_check_fdd_motor_status_1
  309.         mov     eax, [timer_ticks]
  310.         sub     eax, [timer_fdd_motor]
  311.         cmp     eax, 500
  312.         jb      end_check_fdd_motor_status
  313.         call    FDDMotorOFF
  314.         mov     [fdd_motor_status], 0
  315. end_check_fdd_motor_status_1:
  316.         mov     [flp_status], 0
  317. end_check_fdd_motor_status:
  318.         ret
  319.  
  320. ;**********************************
  321. ;* ÂÛÊËÞ×ÈÒÜ ÌÎÒÎÐ ÄÈÑÊÎÂÎÄÀ      *
  322. ;**********************************
  323. FDDMotorOFF:
  324.         push    AX
  325.         push    DX
  326.         cmp     [flp_number], 1
  327.         jne     FDDMotorOFF_1
  328.         call    FDDMotorOFF_A
  329.         jmp     FDDMotorOFF_2
  330. FDDMotorOFF_1:
  331.         call    FDDMotorOFF_B
  332. FDDMotorOFF_2:
  333.         pop     DX
  334.         pop     AX
  335.         ; ñáðîñ ôëàãîâ êåøèðîâàíèÿ â ñâÿçè ñ óñòàðåâàíèåì èíôîðìàöèè
  336.         mov     [root_read], 0
  337.         mov     [flp_fat], 0
  338.         ret
  339.  
  340. FDDMotorOFF_A:
  341.         mov     DX, 3F2h;ïîðò óïðàâëåíèÿ äâèãàòåëÿìè
  342.         mov     AL, 0Ch ; Floppy A
  343.         out     DX, AL
  344.         ret
  345.  
  346. FDDMotorOFF_B:
  347.         mov     DX, 3F2h;ïîðò óïðàâëåíèÿ äâèãàòåëÿìè
  348.         mov     AL, 5h ; Floppy B
  349.         out     DX, AL
  350.         ret
  351.  
  352. ;*******************************
  353. ;* ÐÅÊÀËÈÁÐÎÂÊÀ ÄÈÑÊÎÂÎÄÀ "A:" *
  354. ;*******************************
  355. RecalibrateFDD:
  356.         pusha
  357.         call    save_timer_fdd_motor
  358. ; Ïîäàòü êîìàíäó "Ðåêàëèáðîâêà"
  359.         mov     AL, 07h
  360.         call    FDCDataOutput
  361.         mov     AL, 00h
  362.         call    FDCDataOutput
  363. ; Îæèäàòü çàâåðøåíèÿ îïåðàöèè
  364.         call    WaitFDCInterrupt
  365. ;        cmp    [FDC_Status],0
  366. ;        je    no_fdc_status_error
  367. ;        mov   [flp_status],0
  368. ;no_fdc_status_error:
  369.         call    save_timer_fdd_motor
  370.         popa
  371.         ret
  372.  
  373. ;*****************************************************
  374. ;*                    ÏÎÈÑÊ ÄÎÐÎÆÊÈ                  *
  375. ;* Ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç ãëîáàëüíûå ïåðåìåííûå: *
  376. ;* FDD_Track - íîìåð äîðîæêè (0-79);                 *
  377. ;* FDD_Head - íîìåð ãîëîâêè (0-1).                   *
  378. ;* Ðåçóëüòàò îïåðàöèè çàíîñèòñÿ â FDC_Status.        *
  379. ;*****************************************************
  380. SeekTrack:
  381.         pusha
  382.         call    save_timer_fdd_motor
  383. ; Ïîäàòü êîìàíäó "Ïîèñê"
  384.         mov     AL, 0Fh
  385.         call    FDCDataOutput
  386.         ; Ïåðåäàòü áàéò íîìåðà ãîëîâêè/íàêîïèòåë
  387.         mov     AL, [FDD_Head]
  388.         shl     AL, 2
  389.         call    FDCDataOutput
  390.         ; Ïåðåäàòü áàéò íîìåðà äîðîæêè
  391.         mov     AL, [FDD_Track]
  392.         call    FDCDataOutput
  393. ; Îæèäàòü çàâåðøåíèÿ îïåðàöèè
  394.         call    WaitFDCInterrupt
  395.         cmp     [FDC_Status], FDC_Normal
  396.         jne     @@Exit
  397. ; Ñîõðàíèòü ðåçóëüòàò ïîèñêà
  398.         mov     AL, 08h
  399.         call    FDCDataOutput
  400.         call    FDCDataInput
  401.         mov     [FDC_ST0], AL
  402.         call    FDCDataInput
  403.         mov     [FDC_C], AL
  404. ; Ïðîâåðèòü ðåçóëüòàò ïîèñêà
  405.         ; Ïîèñê çàâåðøåí?
  406.         test    [FDC_ST0], 100000b
  407.         je      @@Err
  408.         ; Çàäàííûé òðåê íàéäåí?
  409.         mov     AL, [FDC_C]
  410.         cmp     AL, [FDD_Track]
  411.         jne     @@Err
  412.         ; Íîìåð ãîëîâêè ñîâïàäàåò ñ çàäàííûì?
  413.         mov     AL, [FDC_ST0]
  414.         and     AL, 100b
  415.         shr     AL, 2
  416.         cmp     AL, [FDD_Head]
  417.         jne     @@Err
  418.         ; Îïåðàöèÿ çàâåðøåíà óñïåøíî
  419.         mov     [FDC_Status], FDC_Normal
  420.         jmp     @@Exit
  421. @@Err:  ; Òðåê íå íàéäåí
  422.         mov     [FDC_Status], FDC_TrackNotFound
  423. ;        mov   [flp_status],0
  424. @@Exit:
  425.         call    save_timer_fdd_motor
  426.         popa
  427.         ret
  428.  
  429. ;*******************************************************
  430. ;*               ×ÒÅÍÈÅ ÑÅÊÒÎÐÀ ÄÀÍÍÛÕ                 *
  431. ;* Ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç ãëîáàëüíûå ïåðåìåííûå:   *
  432. ;* FDD_Track - íîìåð äîðîæêè (0-79);                   *
  433. ;* FDD_Head - íîìåð ãîëîâêè (0-1);                     *
  434. ;* FDD_Sector - íîìåð ñåêòîðà (1-18).                  *
  435. ;* Ðåçóëüòàò îïåðàöèè çàíîñèòñÿ â FDC_Status.          *
  436. ;*  ñëó÷àå óñïåøíîãî âûïîëíåíèÿ îïåðàöèè ÷òåíèÿ       *
  437. ;* ñîäåðæèìîå ñåêòîðà áóäåò çàíåñåíî â FDD_DataBuffer. *
  438. ;*******************************************************
  439. ReadSector:
  440.         pushad
  441.         call    save_timer_fdd_motor
  442. ; Óñòàíîâèòü ñêîðîñòü ïåðåäà÷è 500 Êáàéò/ñ
  443.         mov     AX, 0
  444.         mov     DX, 03F7h
  445.         out     DX, AL
  446. ; Èíèöèàëèçèðîâàòü êàíàë ïðÿìîãî äîñòóïà ê ïàìÿòè
  447.         mov     [dmamode], 0x46
  448.         call    Init_FDC_DMA
  449. ; Ïîäàòü êîìàíäó "×òåíèå äàííûõ"
  450.         mov     AL, 0E6h ;÷òåíèå â ìóëüòèòðåêîâîì ðåæèìå
  451.         call    FDCDataOutput
  452.         mov     AL, [FDD_Head]
  453.         shl     AL, 2
  454.         call    FDCDataOutput
  455.         mov     AL, [FDD_Track]
  456.         call    FDCDataOutput
  457.         mov     AL, [FDD_Head]
  458.         call    FDCDataOutput
  459.         mov     AL, [FDD_Sector]
  460.         call    FDCDataOutput
  461.         mov     AL, 2   ;êîä ðàçìåðà ñåêòîðà (512 áàéò)
  462.         call    FDCDataOutput
  463.         mov     AL, 18 ;+1; 3Fh  ;÷èñëî ñåêòîðîâ íà äîðîæêå
  464.         call    FDCDataOutput
  465.         mov     AL, 1Bh ;çíà÷åíèå GPL
  466.         call    FDCDataOutput
  467.         mov     AL, 0FFh;çíà÷åíèå DTL
  468.         call    FDCDataOutput
  469. ; Îæèäàåì ïðåðûâàíèå ïî çàâåðøåíèè îïåðàöèè
  470.         call    WaitFDCInterrupt
  471.         cmp     [FDC_Status], FDC_Normal
  472.         jne     @@Exit_1
  473. ; Ñ÷èòûâàåì ñòàòóñ çàâåðøåíèÿ îïåðàöèè
  474.         call    GetStatusInfo
  475.         test    [FDC_ST0], 11011000b
  476.         jnz     @@Err_1
  477.         mov     [FDC_Status], FDC_Normal
  478.         jmp     @@Exit_1
  479. @@Err_1:
  480.         mov     [FDC_Status], FDC_SectorNotFound
  481. ;        mov   [flp_status],0
  482. @@Exit_1:
  483.         call    save_timer_fdd_motor
  484.         popad
  485.         ret
  486.  
  487. ;*******************************************************
  488. ;*   ×ÒÅÍÈÅ ÑÅÊÒÎÐÀ (Ñ ÏÎÂÒÎÐÅÍÈÅÌ ÎÏÅÐÀÖÈÈ ÏÐÈ ÑÁÎÅ)  *
  489. ;* Ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç ãëîáàëüíûå ïåðåìåííûå:   *
  490. ;* FDD_Track - íîìåð äîðîæêè (0-79);                   *
  491. ;* FDD_Head - íîìåð ãîëîâêè (0-1);                     *
  492. ;* FDD_Sector - íîìåð ñåêòîðà (1-18).                  *
  493. ;* Ðåçóëüòàò îïåðàöèè çàíîñèòñÿ â FDC_Status.          *
  494. ;*  ñëó÷àå óñïåøíîãî âûïîëíåíèÿ îïåðàöèè ÷òåíèÿ       *
  495. ;* ñîäåðæèìîå ñåêòîðà áóäåò çàíåñåíî â FDD_DataBuffer. *
  496. ;*******************************************************
  497. ReadSectWithRetr:
  498.         pusha
  499. ; Îáíóëèòü ñ÷åò÷èê ïîâòîðåíèÿ îïåðàöèè ðåêàëèáðîâêè
  500.         mov     [RecalRepCounter], 0
  501. @@TryAgain:
  502. ; Îáíóëèòü ñ÷åò÷èê ïîâòîðåíèÿ îïåðàöèè ÷òåíè
  503.         mov     [ReadRepCounter], 0
  504. @@ReadSector_1:
  505.         call    ReadSector
  506.         cmp     [FDC_Status], 0
  507.         je      @@Exit_2
  508.         cmp     [FDC_Status], 1
  509.         je      @@Err_3
  510.         ; Òðîåêðàòíîå ïîâòîðåíèå ÷òåíè
  511.         inc     [ReadRepCounter]
  512.         cmp     [ReadRepCounter], 3
  513.         jb      @@ReadSector_1
  514.         ; Òðîåêðàòíîå ïîâòîðåíèå ðåêàëèáðîâêè
  515.         call    RecalibrateFDD
  516.         call    SeekTrack
  517.         inc     [RecalRepCounter]
  518.         cmp     [RecalRepCounter], 3
  519.         jb      @@TryAgain
  520. ;        mov   [flp_status],0
  521. @@Exit_2:
  522.         popa
  523.         ret
  524. @@Err_3:
  525.         mov     [flp_status], 0
  526.         popa
  527.         ret
  528.  
  529. ;*******************************************************
  530. ;*               ÇÀÏÈÑÜ ÑÅÊÒÎÐÀ ÄÀÍÍÛÕ                 *
  531. ;* Ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç ãëîáàëüíûå ïåðåìåííûå:   *
  532. ;* FDD_Track - íîìåð äîðîæêè (0-79);                   *
  533. ;* FDD_Head - íîìåð ãîëîâêè (0-1);                     *
  534. ;* FDD_Sector - íîìåð ñåêòîðà (1-18).                  *
  535. ;* Ðåçóëüòàò îïåðàöèè çàíîñèòñÿ â FDC_Status.          *
  536. ;*  ñëó÷àå óñïåøíîãî âûïîëíåíèÿ îïåðàöèè çàïèñè       *
  537. ;* ñîäåðæèìîå FDD_DataBuffer áóäåò çàíåñåíî â ñåêòîð.  *
  538. ;*******************************************************
  539. WriteSector:
  540.         pushad
  541.         call    save_timer_fdd_motor
  542. ; Óñòàíîâèòü ñêîðîñòü ïåðåäà÷è 500 Êáàéò/ñ
  543.         mov     AX, 0
  544.         mov     DX, 03F7h
  545.         out     DX, AL
  546. ; Èíèöèàëèçèðîâàòü êàíàë ïðÿìîãî äîñòóïà ê ïàìÿòè
  547.         mov     [dmamode], 0x4A
  548.         call    Init_FDC_DMA
  549. ; Ïîäàòü êîìàíäó "Çàïèñü äàííûõ"
  550.         mov     AL, 0xC5 ;0x45  ;çàïèñü â ìóëüòèòðåêîâîì ðåæèìå
  551.         call    FDCDataOutput
  552.         mov     AL, [FDD_Head]
  553.         shl     AL, 2
  554.         call    FDCDataOutput
  555.         mov     AL, [FDD_Track]
  556.         call    FDCDataOutput
  557.         mov     AL, [FDD_Head]
  558.         call    FDCDataOutput
  559.         mov     AL, [FDD_Sector]
  560.         call    FDCDataOutput
  561.         mov     AL, 2   ;êîä ðàçìåðà ñåêòîðà (512 áàéò)
  562.         call    FDCDataOutput
  563.         mov     AL, 18; 3Fh  ;÷èñëî ñåêòîðîâ íà äîðîæêå
  564.         call    FDCDataOutput
  565.         mov     AL, 1Bh ;çíà÷åíèå GPL
  566.         call    FDCDataOutput
  567.         mov     AL, 0FFh;çíà÷åíèå DTL
  568.         call    FDCDataOutput
  569. ; Îæèäàåì ïðåðûâàíèå ïî çàâåðøåíèè îïåðàöèè
  570.         call    WaitFDCInterrupt
  571.         cmp     [FDC_Status], FDC_Normal
  572.         jne     @@Exit_3
  573. ; Ñ÷èòûâàåì ñòàòóñ çàâåðøåíèÿ îïåðàöèè
  574.         call    GetStatusInfo
  575.         test    [FDC_ST0], 11000000b ;11011000b
  576.         jnz     @@Err_2
  577.         mov     [FDC_Status], FDC_Normal
  578.         jmp     @@Exit_3
  579. @@Err_2:
  580.         mov     [FDC_Status], FDC_SectorNotFound
  581. @@Exit_3:
  582.         call    save_timer_fdd_motor
  583.         popad
  584.         ret
  585.  
  586. ;*******************************************************
  587. ;*   ÇÀÏÈÑÜ ÑÅÊÒÎÐÀ (Ñ ÏÎÂÒÎÐÅÍÈÅÌ ÎÏÅÐÀÖÈÈ ÏÐÈ ÑÁÎÅ)  *
  588. ;* Ïàðàìåòðû ïåðåäàþòñÿ ÷åðåç ãëîáàëüíûå ïåðåìåííûå:   *
  589. ;* FDD_Track - íîìåð äîðîæêè (0-79);                   *
  590. ;* FDD_Head - íîìåð ãîëîâêè (0-1);                     *
  591. ;* FDD_Sector - íîìåð ñåêòîðà (1-18).                  *
  592. ;* Ðåçóëüòàò îïåðàöèè çàíîñèòñÿ â FDC_Status.          *
  593. ;*  ñëó÷àå óñïåøíîãî âûïîëíåíèÿ îïåðàöèè çàïèñè       *
  594. ;* ñîäåðæèìîå FDD_DataBuffer áóäåò çàíåñåíî â ñåêòîð.  *
  595. ;*******************************************************
  596. WriteSectWithRetr:
  597.         pusha
  598. ; Îáíóëèòü ñ÷åò÷èê ïîâòîðåíèÿ îïåðàöèè ðåêàëèáðîâêè
  599.         mov     [RecalRepCounter], 0
  600. @@TryAgain_1:
  601. ; Îáíóëèòü ñ÷åò÷èê ïîâòîðåíèÿ îïåðàöèè ÷òåíè
  602.         mov     [ReadRepCounter], 0
  603. @@WriteSector_1:
  604.         call    WriteSector
  605.         cmp     [FDC_Status], 0
  606.         je      @@Exit_4
  607.         cmp     [FDC_Status], 1
  608.         je      @@Err_4
  609.         ; Òðîåêðàòíîå ïîâòîðåíèå ÷òåíè
  610.         inc     [ReadRepCounter]
  611.         cmp     [ReadRepCounter], 3
  612.         jb      @@WriteSector_1
  613.         ; Òðîåêðàòíîå ïîâòîðåíèå ðåêàëèáðîâêè
  614.         call    RecalibrateFDD
  615.         call    SeekTrack
  616.         inc     [RecalRepCounter]
  617.         cmp     [RecalRepCounter], 3
  618.         jb      @@TryAgain_1
  619. @@Exit_4:
  620.         popa
  621.         ret
  622. @@Err_4:
  623.         mov     [flp_status], 0
  624.         popa
  625.         ret
  626.  
  627. ;*********************************************
  628. ;* ÏÎËÓ×ÈÒÜ ÈÍÔÎÐÌÀÖÈÞ Î ÐÅÇÓËÜÒÀÒÅ ÎÏÅÐÀÖÈÈ *
  629. ;*********************************************
  630. GetStatusInfo:
  631.         push    AX
  632.         call    FDCDataInput
  633.         mov     [FDC_ST0], AL
  634.         call    FDCDataInput
  635.         mov     [FDC_ST1], AL
  636.         call    FDCDataInput
  637.         mov     [FDC_ST2], AL
  638.         call    FDCDataInput
  639.         mov     [FDC_C], AL
  640.         call    FDCDataInput
  641.         mov     [FDC_H], AL
  642.         call    FDCDataInput
  643.         mov     [FDC_R], AL
  644.         call    FDCDataInput
  645.         mov     [FDC_N], AL
  646.         pop     AX
  647.         ret
  648.  
  649.