Subversion Repositories Kolibri OS

Rev

Rev 2465 | Rev 3908 | 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: 3555 $
  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.