?? floppy.c
字號:
{ floppy_deselect (current_drive); end_request (0); }// 如果當前請求項出錯次數大于最大允許出錯次數的一半,則置復位標志,需對軟驅進行復位操作,// 然后再試。否則軟驅需重新校正一下,再試。 if (CURRENT->errors > MAX_ERRORS / 2) reset = 1; else recalibrate = 1;}/** OK,下面該中斷處理函數是在DMA 讀/寫成功后調用的,這樣我們就可以檢查執行結果,* 并復制緩沖區中的數據。*///// 軟盤讀寫操作成功中斷調用函數。。static voidrw_interrupt (void){// 如果返回結果字節數不等于7,或者狀態字節0、1 或2 中存在出錯標志,則若是寫保護// 就顯示出錯信息,釋放當前驅動器,并結束當前請求項。否則就執行出錯計數處理。// 然后繼續執行軟盤請求操作。// ( 0xf8 = ST0_INTR | ST0_SE | ST0_ECE | ST0_NR )// ( 0xbf = ST1_EOC | ST1_CRC | ST1_OR | ST1_ND | ST1_WP | ST1_MAM,應該是0xb7)// ( 0x73 = ST2_CM | ST2_CRC | ST2_WC | ST2_BC | ST2_MAM ) if (result () != 7 || (ST0 & 0xf8) || (ST1 & 0xbf) || (ST2 & 0x73)) { if (ST1 & 0x02) { // 0x02 = ST1_WP - Write Protected。 printk ("Drive %d is write protected\n\r", current_drive); floppy_deselect (current_drive); end_request (0); } else bad_flp_intr (); do_fd_request (); return; }// 如果當前請求項的緩沖區位于1M 地址以上,則說明此次軟盤讀操作的內容還放在臨時緩沖區內,// 需要復制到請求項的緩沖區中(因為DMA 只能在1M 地址范圍尋址)。 if (command == FD_READ && (unsigned long) (CURRENT->buffer) >= 0x100000) copy_buffer (tmp_floppy_area, CURRENT->buffer);// 釋放當前軟盤,結束當前請求項(置更新標志),再繼續執行其它軟盤請求項。 floppy_deselect (current_drive); end_request (1); do_fd_request ();}//// 設置DMA 并輸出軟盤操作命令和參數(輸出1 字節命令+ 0~7 字節參數)。_inline voidsetup_rw_floppy (void){ setup_DMA (); // 初始化軟盤DMA 通道。 do_floppy = rw_interrupt; // 置軟盤中斷調用函數指針。 output_byte (command); // 發送命令字節。 output_byte (head << 2 | current_drive); // 發送參數(磁頭號+驅動器號)。 output_byte (track); // 發送參數(磁道號)。 output_byte (head); // 發送參數(磁頭號)。 output_byte (sector); // 發送參數(起始扇區號)。 output_byte (2); /* sector size = 512 */// 發送參數(字節數(N=2)512 字節)。 output_byte (floppy->sect); // 發送參數(每磁道扇區數)。 output_byte (floppy->gap); // 發送參數(扇區間隔長度)。 output_byte ((char)0xFF); /* sector size (0xff when n!=0 ?) */// 發送參數(當N=0 時,扇區定義的字節長度),這里無用。// 若在發送命令和參數時發生錯誤,則繼續執行下一軟盤操作請求。 if (reset) do_fd_request ();}/** 該子程序是在每次軟盤控制器尋道(或重新校正)中斷后被調用的。注意* "unexpected interrupt"(意外中斷)子程序也會執行重新校正操作,但不在此地。*///// 尋道處理中斷調用函數。// 首先發送檢測中斷狀態命令,獲得狀態信息ST0 和磁頭所在磁道信息。若出錯則執行錯誤計數// 檢測處理或取消本次軟盤操作請求項。否則根據狀態信息設置當前磁道變量,然后調用函數// setup_rw_floppy()設置DMA 并輸出軟盤讀寫命令和參數。static voidseek_interrupt (void){/* sense drive status *//* 檢測中斷狀態 */// 發送檢測中斷狀態命令,該命令不帶參數。返回結果信息兩個字節:ST0 和磁頭當前磁道號。 output_byte (FD_SENSEI);// 如果返回結果字節數不等于2,或者ST0 不為尋道結束,或者磁頭所在磁道(ST1)不等于設定磁道,// 則說明發生了錯誤,于是執行檢測錯誤計數處理,然后繼續執行軟盤請求項,并退出。 if (result () != 2 || (ST0 & 0xF8) != 0x20 || ST1 != seek_track) { bad_flp_intr (); do_fd_request (); return; } current_track = ST1; // 設置當前磁道。 setup_rw_floppy (); // 設置DMA 并輸出軟盤操作命令和參數。}/** 該函數是在傳輸操作的所有信息都正確設置好后被調用的(也即軟驅馬達已開啟* 并且已選擇了正確的軟盤(軟驅)。*///// 讀寫數據傳輸函數。static voidtransfer (void){// 首先看當前驅動器參數是否就是指定驅動器的參數,若不是就發送設置驅動器參數命令及相應// 參數(參數1:高4 位步進速率,低四位磁頭卸載時間;參數2:磁頭加載時間)。 if (cur_spec1 != floppy->spec1) { cur_spec1 = floppy->spec1; output_byte (FD_SPECIFY); // 發送設置磁盤參數命令。 output_byte (cur_spec1); /* hut etc */// 發送參數。 output_byte (6); /* Head load time =6ms, DMA */ }// 判斷當前數據傳輸速率是否與指定驅動器的一致,若不是就發送指定軟驅的速率值到數據傳輸// 速率控制寄存器(FD_DCR)。 if (cur_rate != floppy->rate) outb_p (cur_rate = floppy->rate, FD_DCR);// 若返回結果信息表明出錯,則再調用軟盤請求函數,并返回。 if (reset) { do_fd_request (); return; }// 若尋道標志為零(不需要尋道),則設置DMA 并發送相應讀寫操作命令和參數,然后返回。 if (!seek) { setup_rw_floppy (); return; }// 否則執行尋道處理。置軟盤中斷處理調用函數為尋道中斷函數。 do_floppy = seek_interrupt;// 如果器始磁道號不等于零則發送磁頭尋道命令和參數 if (seek_track) { output_byte (FD_SEEK); // 發送磁頭尋道命令。 output_byte (head << 2 | current_drive); //發送參數:磁頭號+當前軟驅號。 output_byte (seek_track); // 發送參數:磁道號。 } else { output_byte (FD_RECALIBRATE); // 發送重新校正命令。 output_byte (head << 2 | current_drive); //發送參數:磁頭號+當前軟驅號。 }// 如果復位標志已置位,則繼續執行軟盤請求項。 if (reset) do_fd_request ();}/** 特殊情況 - 用于意外中斷(或復位)處理后。*///// 軟驅重新校正中斷調用函數。// 首先發送檢測中斷狀態命令(無參數),如果返回結果表明出錯,則置復位標志,否則復位重新// 校正標志。然后再次執行軟盤請求。static voidrecal_interrupt (void){ output_byte (FD_SENSEI); // 發送檢測中斷狀態命令。 if (result () != 2 || (ST0 & 0xE0) == 0x60) // 如果返回結果字節數不等于2 或命令 reset = 1; // 異常結束,則置復位標志。 else // 否則復位重新校正標志。 recalibrate = 0; do_fd_request (); // 執行軟盤請求項。}//// 意外軟盤中斷請求中斷調用函數。// 首先發送檢測中斷狀態命令(無參數),如果返回結果表明出錯,則置復位標志,否則置重新// 校正標志。voidunexpected_floppy_interrupt (void){ output_byte (FD_SENSEI); // 發送檢測中斷狀態命令。 if (result () != 2 || (ST0 & 0xE0) == 0x60) // 如果返回結果字節數不等于2 或命令 reset = 1; // 異常結束,則置復位標志。 else // 否則置重新校正標志。 recalibrate = 1;}//// 軟盤重新校正處理函數。// 向軟盤控制器FDC 發送重新校正命令和參數,并復位重新校正標志。static voidrecalibrate_floppy (void){ recalibrate = 0; // 復位重新校正標志。 current_track = 0; // 當前磁道號歸零。 do_floppy = recal_interrupt; // 置軟盤中斷調用函數指針指向重新校正調用函數。 output_byte (FD_RECALIBRATE); // 發送命令:重新校正。 output_byte (head << 2 | current_drive); // 發送參數:(磁頭號加)當前驅動器號。 if (reset) // 如果出錯(復位標志被置位)則繼續執行軟盤請求。 do_fd_request ();}//// 軟盤控制器FDC 復位中斷調用函數。在軟盤中斷處理程序中調用。// 首先發送檢測中斷狀態命令(無參數),然后讀出返回的結果字節。接著發送設定軟驅參數命令// 和相關參數,最后再次調用執行軟盤請求。static voidreset_interrupt (void){ output_byte (FD_SENSEI); // 發送檢測中斷狀態命令。 (void) result (); // 讀取命令執行結果字節。 output_byte (FD_SPECIFY); // 發送設定軟驅參數命令。 output_byte (cur_spec1); /* hut etc */// 發送參數。 output_byte (6); /* Head load time =6ms, DMA */ do_fd_request (); // 調用執行軟盤請求。}/* FDC 復位是通過將數字輸出寄存器(DOR)位2 置0 一會兒實現的 *///// 復位軟盤控制器。static voidreset_floppy (void){ int i; reset = 0; // 復位標志置0。 cur_spec1 = -1; cur_rate = -1; recalibrate = 1; // 重新校正標志置位。 printk ("Reset-floppy called\n\r"); // 顯示執行軟盤復位操作信息。 cli (); // 關中斷。 do_floppy = reset_interrupt; // 設置在軟盤中斷處理程序中調用的函數。 outb_p (current_DOR & ~0x04, FD_DOR); // 對軟盤控制器FDC 執行復位操作。 for (i = 0; i < 100; i++) // 空操作,延遲。 _asm nop; outb (current_DOR, FD_DOR); // 再啟動軟盤控制器。 sti (); // 開中斷。}//// 軟驅啟動定時中斷調用函數。// 首先檢查數字輸出寄存器(DOR),使其選擇當前指定的驅動器。然后調用執行軟盤讀寫傳輸// 函數transfer()。static voidfloppy_on_interrupt (void){/* 我們不能任意設置選擇的軟驅,因為這樣做可能會引起進程睡眠。我們只是迫使它自己選擇 */ selected = 1; // 置已選擇當前驅動器標志。// 如果當前驅動器號與數字輸出寄存器DOR 中的不同,則重新設置DOR 為當前驅動器current_drive。// 定時延遲2 個滴答時間,然后調用軟盤讀寫傳輸函數transfer()。否則直接調用軟盤讀寫傳輸函數。 if (current_drive != (current_DOR & 3)) { current_DOR &= 0xFC; current_DOR |= current_drive; outb (current_DOR, FD_DOR); // 向數字輸出寄存器輸出當前DOR。 add_timer (2, &transfer); // 添加定時器并執行傳輸函數。 } else transfer (); // 執行軟盤讀寫傳輸函數。}//// 軟盤讀寫請求項處理函數。voiddo_fd_request (void){ unsigned int block; seek = 0;// 如果復位標志已置位,則執行軟盤復位操作,并返回。 if (reset) { reset_floppy (); return; }// 如果重新校正標志已置位,則執行軟盤重新校正操作,并返回。 if (recalibrate) { recalibrate_floppy (); return; }// 檢測請求項的合法性(參見kernel/blk_drv/blk.h,127)。 INIT_REQUEST;// 將請求項結構中軟盤設備號中的軟盤類型(MINOR(CURRENT->dev)>>2)作為索引取得軟盤參數塊。 floppy = (MINOR (CURRENT->dev) >> 2) + floppy_type;// 如果當前驅動器不是請求項中指定的驅動器,則置標志seek,表示需要進行尋道操作。// 然后置請求項設備為當前驅動器。 if (current_drive != CURRENT_DEV) seek = 1; current_drive = CURRENT_DEV;// 設置讀寫起始扇區。因為每次讀寫是以塊為單位(1 塊2 個扇區),所以起始扇區需要起碼比// 磁盤總扇區數小2 個扇區。否則結束該次軟盤請求項,執行下一個請求項。 block = CURRENT->sector; // 取當前軟盤請求項中起始扇區號??block。 if (block + 2 > floppy->size) { // 如果block+2 大于磁盤扇區總數,則 end_request (0); // 結束本次軟盤請求項。 goto repeat; }// 求對應在磁道上的扇區號,磁頭號,磁道號,搜尋磁道號(對于軟驅讀不同格式的盤)。 sector = block % floppy->sect; // 起始扇區對每磁道扇區數取模,得磁道上扇區號。 block /= floppy->sect; // 起始扇區對每磁道扇區數取整,得起始磁道數。 head = block % floppy->head; // 起始磁道數對磁頭數取模,得操作的磁頭號。 track = block / floppy->head; // 起始磁道數對磁頭數取整,得操作的磁道號。 seek_track = track << floppy->stretch; // 相應于驅動器中盤類型進行調整,得尋道號。// 如果尋道號與當前磁頭所在磁道不同,則置需要尋道標志seek。 if (seek_track != current_track) seek = 1; sector++; // 磁盤上實際扇區計數是從1 算起。 if (CURRENT->cmd == READ) // 如果請求項中是讀操作,則置軟盤讀命令碼。 command = FD_READ; else if (CURRENT->cmd == WRITE) // 如果請求項中是寫操作,則置軟盤寫命令碼。 command = FD_WRITE; else panic ("do_fd_request: unknown command");// 添加定時器,用于指定驅動器到能正常運行所需延遲的時間(滴答數),當定時時間到時就調用// 函數floppy_on_interrupt(), add_timer (ticks_to_floppy_on (current_drive), &floppy_on_interrupt);}//// 軟盤系統初始化。// 設置軟盤塊設備的請求處理函數(do_fd_request()),并設置軟盤中斷門(int 0x26,對應硬件// 中斷請求信號IRQ6),然后取消對該中斷信號的屏蔽,允許軟盤控制器FDC 發送中斷請求信號。voidfloppy_init (void){ blk_dev[MAJOR_NR].request_fn = DEVICE_REQUEST; // = do_fd_request()。 set_trap_gate (0x26, &floppy_interrupt); //設置軟盤中斷門 int 0x26(38)。 outb (inb_p (0x21) & ~0x40, 0x21); // 復位軟盤的中斷請求屏蔽位,允許 // 軟盤控制器發送中斷請求信號。}
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -