Rev 3519 | Details | Compare with Previous | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 431 | serge | 1 | ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; |
| 2 | ;; ;; |
||
| 3 | ;; Copyright (C) KolibriOS team 2004-2007. All rights reserved. ;; |
||
| 4 | ;; Distributed under terms of the GNU General Public License ;; |
||
| 5 | ;; ;; |
||
| 6 | ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; |
||
| 7 | |||
| 593 | mikedld | 8 | $Revision: 3531 $ |
| 9 | |||
| 10 | |||
| 1 | ha | 11 | ;****************************************************** |
| 12 | ; поиск приводов HDD и CD |
||
| 13 | ; автор исходного текста Кулаков Владимир Геннадьевич. |
||
| 14 | ; адаптация и доработка Mario79 |
||
| 15 | ;****************************************************** |
||
| 16 | |||
| 17 | ;**************************************************** |
||
| 18 | ;* ПОИСК HDD и CD * |
||
| 19 | ;**************************************************** |
||
| 20 | FindHDD: |
||
| 3531 | art_zh | 21 | mov [ChannelNumber],1 |
| 22 | mov [DiskNumber],0 |
||
| 23 | call FindHDD_3 |
||
| 24 | ; mov ax,[Sector512+176] |
||
| 25 | ; mov [DRIVE_DATA+6],ax |
||
| 26 | ; mov ax,[Sector512+126] |
||
| 27 | ; mov [DRIVE_DATA+8],ax |
||
| 28 | ; mov ax,[Sector512+128] |
||
| 29 | ; mov [DRIVE_DATA+8],ax |
||
| 30 | mov [DiskNumber],1 |
||
| 31 | call FindHDD_3 |
||
| 32 | ; mov al,[Sector512+176] |
||
| 33 | ; mov [DRIVE_DATA+7],al |
||
| 34 | inc [ChannelNumber] |
||
| 35 | mov [DiskNumber],0 |
||
| 36 | call FindHDD_3 |
||
| 37 | ; mov al,[Sector512+176] |
||
| 38 | ; mov [DRIVE_DATA+8],al |
||
| 39 | mov [DiskNumber],1 |
||
| 40 | call FindHDD_1 |
||
| 41 | ; mov al,[Sector512+176] |
||
| 42 | ; mov [DRIVE_DATA+9],al |
||
| 389 | serge | 43 | |
| 3531 | art_zh | 44 | jmp EndFindHDD |
| 1 | ha | 45 | |
| 46 | FindHDD_1: |
||
| 3531 | art_zh | 47 | call ReadHDD_ID |
| 48 | cmp [DevErrorCode],0 |
||
| 49 | jne FindHDD_2 |
||
| 50 | cmp [Sector512+6],word 16 |
||
| 51 | ja FindHDD_2 |
||
| 52 | cmp [Sector512+12],word 255 |
||
| 53 | ja FindHDD_2 |
||
| 54 | inc byte [DRIVE_DATA+1] |
||
| 55 | jmp FindHDD_2_2 |
||
| 1 | ha | 56 | FindHDD_2: |
| 3531 | art_zh | 57 | call DeviceReset |
| 58 | cmp [DevErrorCode],0 |
||
| 59 | ;; jne FindHDD_2_2 |
||
| 3519 | art_zh | 60 | ; call ReadCD_ID |
| 61 | ; cmp [DevErrorCode],0 |
||
| 3531 | art_zh | 62 | jne FindHDD_2_2 |
| 63 | inc byte [DRIVE_DATA+1] |
||
| 64 | inc byte [DRIVE_DATA+1] |
||
| 1 | ha | 65 | FindHDD_2_2: |
| 3531 | art_zh | 66 | ret |
| 1 | ha | 67 | |
| 68 | FindHDD_3: |
||
| 3531 | art_zh | 69 | call FindHDD_1 |
| 70 | shl byte [DRIVE_DATA+1],2 |
||
| 71 | ret |
||
| 1 | ha | 72 | |
| 73 | |||
| 74 | ; Адрес считываемого сектора в режиме LBA |
||
| 1276 | Lrz | 75 | uglobal |
| 3531 | art_zh | 76 | SectorAddress DD ? |
| 1276 | Lrz | 77 | endg |
| 1 | ha | 78 | ;************************************************* |
| 79 | ;* ЧТЕНИЕ ИДЕНТИФИКАТОРА ЖЕСТКОГО ДИСКА * |
||
| 80 | ;* Входные параметры передаются через глобальные * |
||
| 81 | ;* переменные: * |
||
| 82 | ;* ChannelNumber - номер канала (1 или 2); * |
||
| 83 | ;* DiskNumber - номер диска на канале (0 или 1). * |
||
| 84 | ;* Идентификационный блок данных считывается * |
||
| 85 | ;* в массив Sector512. * |
||
| 86 | ;************************************************* |
||
| 87 | ReadHDD_ID: |
||
| 88 | ; Задать режим CHS |
||
| 3531 | art_zh | 89 | mov [ATAAddressMode],0 |
| 1 | ha | 90 | ; Послать команду идентификации устройства |
| 3531 | art_zh | 91 | mov [ATAFeatures],0 |
| 92 | mov [ATAHead],0 |
||
| 93 | mov [ATACommand],0ECh |
||
| 94 | call SendCommandToHDD |
||
| 95 | cmp [DevErrorCode],0 ;проверить код ошибки |
||
| 96 | jne @@End ;закончить, сохранив код ошибки |
||
| 97 | mov DX,[ATABasePortAddr] |
||
| 98 | add DX,7 ;адрес регистра состояни |
||
| 99 | mov ecx,0xffff |
||
| 1 | ha | 100 | @@WaitCompleet: |
| 3531 | art_zh | 101 | ; Проверить время выполнения команды |
| 102 | dec ecx |
||
| 1276 | Lrz | 103 | ; cmp ecx,0 |
| 3531 | art_zh | 104 | jz @@Error1 ;ошибка тайм-аута |
| 105 | ; Проверить готовность |
||
| 106 | in AL,DX |
||
| 107 | test AL,80h ;состояние сигнала BSY |
||
| 108 | jnz @@WaitCompleet |
||
| 109 | test AL,1 ;состояние сигнала ERR |
||
| 110 | jnz @@Error6 |
||
| 111 | test AL,08h ;состояние сигнала DRQ |
||
| 112 | jz @@WaitCompleet |
||
| 1 | ha | 113 | ; Принять блок данных от контроллера |
| 3531 | art_zh | 114 | ; mov AX,DS |
| 115 | ; mov ES,AX |
||
| 116 | mov EDI,Sector512 ;offset Sector512 |
||
| 117 | mov DX,[ATABasePortAddr] ;регистр данных |
||
| 118 | mov CX,256 ;число считываемых слов |
||
| 119 | rep insw ;принять блок данных |
||
| 1276 | Lrz | 120 | ret |
| 1 | ha | 121 | ; Записать код ошибки |
| 122 | @@Error1: |
||
| 3531 | art_zh | 123 | mov [DevErrorCode],1 |
| 1276 | Lrz | 124 | ret |
| 1 | ha | 125 | @@Error6: |
| 3531 | art_zh | 126 | mov [DevErrorCode],6 |
| 127 | @@End: ret |
||
| 1 | ha | 128 | |
| 129 | |||
| 1276 | Lrz | 130 | iglobal |
| 1 | ha | 131 | ; Стандартные базовые адреса каналов 1 и 2 |
| 132 | StandardATABases DW 1F0h, 170h |
||
| 1276 | Lrz | 133 | endg |
| 134 | uglobal |
||
| 1 | ha | 135 | ; Номер канала |
| 3531 | art_zh | 136 | ChannelNumber DW ? |
| 1 | ha | 137 | ; Номер диска |
| 3531 | art_zh | 138 | DiskNumber DB ? |
| 1 | ha | 139 | ; Базовый адрес группы портов контроллера ATA |
| 140 | ATABasePortAddr DW ? |
||
| 141 | ; Параметры ATA-команды |
||
| 3531 | art_zh | 142 | ATAFeatures DB ? ;особенности |
| 143 | ATASectorCount DB ? ;количество обрабатываемых секторов |
||
| 1 | ha | 144 | ATASectorNumber DB ? ;номер начального сектора |
| 3531 | art_zh | 145 | ATACylinder DW ? ;номер начального цилиндра |
| 146 | ATAHead DB ? ;номер начальной головки |
||
| 147 | ATAAddressMode DB ? ;режим адресации (0 - CHS, 1 - LBA) |
||
| 148 | ATACommand DB ? ;код команды, подлежащей выполнению |
||
| 1 | ha | 149 | ; Код ошибки (0 - нет ошибок, 1 - превышен допустимый |
| 150 | ; интервал ожидания, 2 - неверный код режима адресации, |
||
| 151 | ; 3 - неверный номер канала, 4 - неверный номер диска, |
||
| 152 | ; 5 - неверный номер головки, 6 - ошибка при выполнении |
||
| 153 | ; команды) |
||
| 1276 | Lrz | 154 | DevErrorCode dd ? |
| 155 | endg |
||
| 1 | ha | 156 | ;**************************************************** |
| 157 | ;* ПОСЛАТЬ КОМАНДУ ЗАДАННОМУ ДИСКУ * |
||
| 158 | ;* Входные параметры передаются через глобальные * |
||
| 159 | ;* переменные: * |
||
| 160 | ;* ChannelNumber - номер канала (1 или 2); * |
||
| 161 | ;* DiskNumber - номер диска (0 или 1); * |
||
| 162 | ;* ATAFeatures - "особенности"; * |
||
| 163 | ;* ATASectorCount - количество секторов; * |
||
| 164 | ;* ATASectorNumber - номер начального сектора; * |
||
| 165 | ;* ATACylinder - номер начального цилиндра; * |
||
| 166 | ;* ATAHead - номер начальной головки; * |
||
| 167 | ;* ATAAddressMode - режим адресации (0-CHS, 1-LBA); * |
||
| 168 | ;* ATACommand - код команды. * |
||
| 169 | ;* После успешного выполнения функции: * |
||
| 170 | ;* в ATABasePortAddr - базовый адрес HDD; * |
||
| 171 | ;* в DevErrorCode - ноль. * |
||
| 172 | ;* При возникновении ошибки в DevErrorCode будет * |
||
| 173 | ;* возвращен код ошибки. * |
||
| 174 | ;**************************************************** |
||
| 175 | SendCommandToHDD: |
||
| 176 | ; Проверить значение кода режима |
||
| 3531 | art_zh | 177 | cmp [ATAAddressMode],1 |
| 178 | ja @@Err2 |
||
| 1 | ha | 179 | ; Проверить корректность номера канала |
| 3531 | art_zh | 180 | mov BX,[ChannelNumber] |
| 181 | cmp BX,1 |
||
| 182 | jb @@Err3 |
||
| 183 | cmp BX,2 |
||
| 184 | ja @@Err3 |
||
| 1 | ha | 185 | ; Установить базовый адрес |
| 3531 | art_zh | 186 | dec BX |
| 187 | shl BX,1 |
||
| 188 | movzx ebx,bx |
||
| 189 | mov AX,[ebx+StandardATABases] |
||
| 190 | mov [ATABasePortAddr],AX |
||
| 1 | ha | 191 | ; Ожидание готовности HDD к приему команды |
| 3531 | art_zh | 192 | ; Выбрать нужный диск |
| 193 | mov DX,[ATABasePortAddr] |
||
| 194 | add DX,6 ;адрес регистра головок |
||
| 195 | mov AL,[DiskNumber] |
||
| 196 | cmp AL,1 ;проверить номера диска |
||
| 197 | ja @@Err4 |
||
| 198 | shl AL,4 |
||
| 199 | or AL,10100000b |
||
| 200 | out DX,AL |
||
| 201 | ; Ожидать, пока диск не будет готов |
||
| 202 | inc DX |
||
| 203 | mov ecx,0xfff |
||
| 204 | ; mov eax,[timer_ticks] |
||
| 205 | ; mov [TickCounter_1],eax |
||
| 1 | ha | 206 | @@WaitHDReady: |
| 3531 | art_zh | 207 | ; Проверить время ожидани |
| 208 | dec ecx |
||
| 209 | ; cmp ecx,0 |
||
| 210 | jz @@Err1 |
||
| 211 | ; mov eax,[timer_ticks] |
||
| 212 | ; sub eax,[TickCounter_1] |
||
| 213 | ; cmp eax,300 ;ожидать 300 тиков |
||
| 214 | ; ja @@Err1 ;ошибка тайм-аута |
||
| 215 | ; Прочитать регистр состояни |
||
| 216 | in AL,DX |
||
| 217 | ; Проверить состояние сигнала BSY |
||
| 218 | test AL,80h |
||
| 219 | jnz @@WaitHDReady |
||
| 220 | ; Проверить состояние сигнала DRQ |
||
| 221 | test AL,08h |
||
| 222 | jnz @@WaitHDReady |
||
| 1 | ha | 223 | ; Загрузить команду в регистры контроллера |
| 3531 | art_zh | 224 | cli |
| 225 | mov DX,[ATABasePortAddr] |
||
| 226 | inc DX ;регистр "особенностей" |
||
| 227 | mov AL,[ATAFeatures] |
||
| 228 | out DX,AL |
||
| 229 | inc DX ;счетчик секторов |
||
| 230 | mov AL,[ATASectorCount] |
||
| 231 | out DX,AL |
||
| 232 | inc DX ;регистр номера сектора |
||
| 233 | mov AL,[ATASectorNumber] |
||
| 234 | out DX,AL |
||
| 235 | inc DX ;номер цилиндра (младший байт) |
||
| 236 | mov AX,[ATACylinder] |
||
| 237 | out DX,AL |
||
| 238 | inc DX ;номер цилиндра (старший байт) |
||
| 239 | mov AL,AH |
||
| 240 | out DX,AL |
||
| 241 | inc DX ;номер головки/номер диска |
||
| 242 | mov AL,[DiskNumber] |
||
| 243 | shl AL,4 |
||
| 244 | cmp [ATAHead],0Fh ;проверить номер головки |
||
| 245 | ja @@Err5 |
||
| 246 | or AL,[ATAHead] |
||
| 247 | or AL,10100000b |
||
| 248 | mov AH,[ATAAddressMode] |
||
| 249 | shl AH,6 |
||
| 250 | or AL,AH |
||
| 251 | out DX,AL |
||
| 1 | ha | 252 | ; Послать команду |
| 3531 | art_zh | 253 | mov AL,[ATACommand] |
| 254 | inc DX ;регистр команд |
||
| 255 | out DX,AL |
||
| 256 | sti |
||
| 1 | ha | 257 | ; Сбросить признак ошибки |
| 3531 | art_zh | 258 | mov [DevErrorCode],0 |
| 259 | ret |
||
| 1 | ha | 260 | ; Записать код ошибки |
| 3531 | art_zh | 261 | @@Err1: mov [DevErrorCode],1 |
| 262 | ret |
||
| 263 | @@Err2: mov [DevErrorCode],2 |
||
| 264 | ret |
||
| 265 | @@Err3: mov [DevErrorCode],3 |
||
| 266 | ret |
||
| 267 | @@Err4: mov [DevErrorCode],4 |
||
| 268 | ret |
||
| 269 | @@Err5: mov [DevErrorCode],5 |
||
| 1 | ha | 270 | ; Завершение работы программы |
| 3531 | art_zh | 271 | ret |
| 1 | ha | 272 | |
| 273 | ;************************************************* |
||
| 274 | ;* ЧТЕНИЕ ИДЕНТИФИКАТОРА УСТРОЙСТВА ATAPI * |
||
| 275 | ;* Входные параметры передаются через глобальные * |
||
| 276 | ;* перменные: * |
||
| 277 | ;* ChannelNumber - номер канала; * |
||
| 278 | ;* DiskNumber - номер диска на канале. * |
||
| 279 | ;* Идентификационный блок данных считывается * |
||
| 280 | ;* в массив Sector512. * |
||
| 281 | ;************************************************* |
||
| 282 | ReadCD_ID: |
||
| 283 | ; Задать режим CHS |
||
| 3531 | art_zh | 284 | mov [ATAAddressMode],0 |
| 1 | ha | 285 | ; Послать команду идентификации устройства |
| 3531 | art_zh | 286 | mov [ATAFeatures],0 |
| 287 | mov [ATASectorCount],0 |
||
| 288 | mov [ATASectorNumber],0 |
||
| 289 | mov [ATACylinder],0 |
||
| 290 | mov [ATAHead],0 |
||
| 291 | mov [ATACommand],0A1h |
||
| 292 | call SendCommandToHDD |
||
| 293 | cmp [DevErrorCode],0 ;проверить код ошибки |
||
| 294 | jne @@End_1 ;закончить, сохранив код ошибки |
||
| 1 | ha | 295 | ; Ожидать готовность данных HDD |
| 3531 | art_zh | 296 | mov DX,[ATABasePortAddr] |
| 297 | add DX,7 ;порт 1х7h |
||
| 298 | mov ecx,0xffff |
||
| 1 | ha | 299 | @@WaitCompleet_1: |
| 3531 | art_zh | 300 | ; Проверить врем |
| 301 | dec ecx |
||
| 302 | ; cmp ecx,0 |
||
| 303 | jz @@Error1_1 ;ошибка тайм-аута |
||
| 304 | ; Проверить готовность |
||
| 305 | in AL,DX |
||
| 306 | test AL,80h ;состояние сигнала BSY |
||
| 307 | jnz @@WaitCompleet_1 |
||
| 308 | test AL,1 ;состояние сигнала ERR |
||
| 309 | jnz @@Error6_1 |
||
| 310 | test AL,08h ;состояние сигнала DRQ |
||
| 311 | jz @@WaitCompleet_1 |
||
| 1 | ha | 312 | ; Принять блок данных от контроллера |
| 3531 | art_zh | 313 | ; mov AX,DS |
| 314 | ; mov ES,AX |
||
| 315 | mov EDI,Sector512 ;offset Sector512 |
||
| 316 | mov DX,[ATABasePortAddr] ;порт 1x0h |
||
| 317 | mov CX,256 ;число считываемых слов |
||
| 318 | rep insw |
||
| 319 | ret |
||
| 1 | ha | 320 | ; Записать код ошибки |
| 321 | @@Error1_1: |
||
| 3531 | art_zh | 322 | mov [DevErrorCode],1 |
| 323 | ret |
||
| 1 | ha | 324 | @@Error6_1: |
| 3531 | art_zh | 325 | mov [DevErrorCode],6 |
| 1 | ha | 326 | @@End_1: |
| 3531 | art_zh | 327 | ret |
| 1 | ha | 328 | |
| 329 | ;************************************************* |
||
| 330 | ;* СБРОС УСТРОЙСТВА * |
||
| 331 | ;* Входные параметры передаются через глобальные * |
||
| 332 | ;* переменные: * |
||
| 333 | ;* ChannelNumber - номер канала (1 или 2); * |
||
| 334 | ;* DiskNumber - номер диска (0 или 1). * |
||
| 335 | ;************************************************* |
||
| 336 | DeviceReset: |
||
| 337 | ; Проверить корректность номера канала |
||
| 3531 | art_zh | 338 | mov BX,[ChannelNumber] |
| 339 | cmp BX,1 |
||
| 340 | jb @@Err3_2 |
||
| 341 | cmp BX,2 |
||
| 342 | ja @@Err3_2 |
||
| 1 | ha | 343 | ; Установить базовый адрес |
| 3531 | art_zh | 344 | dec BX |
| 345 | shl BX,1 |
||
| 346 | movzx ebx,bx |
||
| 347 | mov DX,[ebx+StandardATABases] |
||
| 348 | mov [ATABasePortAddr],DX |
||
| 1 | ha | 349 | ; Выбрать нужный диск |
| 3531 | art_zh | 350 | add DX,6 ;адрес регистра головок |
| 351 | mov AL,[DiskNumber] |
||
| 352 | cmp AL,1 ;проверить номера диска |
||
| 353 | ja @@Err4_2 |
||
| 354 | shl AL,4 |
||
| 355 | or AL,10100000b |
||
| 356 | out DX,AL |
||
| 1 | ha | 357 | ; Послать команду "Сброс" |
| 3531 | art_zh | 358 | mov AL,08h |
| 359 | inc DX ;регистр команд |
||
| 360 | out DX,AL |
||
| 361 | mov ecx,0x80000 |
||
| 1 | ha | 362 | @@WaitHDReady_1: |
| 3531 | art_zh | 363 | ; Проверить время ожидани |
| 364 | dec ecx |
||
| 1276 | Lrz | 365 | ; cmp ecx,0 |
| 3531 | art_zh | 366 | je @@Err1_2 ;ошибка тайм-аута |
| 367 | ; Прочитать регистр состояни |
||
| 368 | in AL,DX |
||
| 369 | ; Проверить состояние сигнала BSY |
||
| 370 | test AL,80h |
||
| 371 | jnz @@WaitHDReady_1 |
||
| 1 | ha | 372 | ; Сбросить признак ошибки |
| 3531 | art_zh | 373 | mov [DevErrorCode],0 |
| 374 | ret |
||
| 1 | ha | 375 | ; Обработка ошибок |
| 3531 | art_zh | 376 | @@Err1_2: mov [DevErrorCode],1 |
| 377 | ret |
||
| 378 | @@Err3_2: mov [DevErrorCode],3 |
||
| 379 | ret |
||
| 380 | @@Err4_2: mov [DevErrorCode],4 |
||
| 1 | ha | 381 | ; Записать код ошибки |
| 3531 | art_zh | 382 | ret |
| 1 | ha | 383 | |
| 384 | EndFindHDD: |
||
| 385 |