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