reactos操作系统实现(111)
IdeSendSmartCommand函数主要发送IDE的命令。具体实现代码如下:
#001 ULONG
#002 NTAPI
#003 IdeSendSmartCommand(
#004 IN PVOID HwDeviceExtension,
#005 IN PSCSI_REQUEST_BLOCK Srb
#006 )
#007
#008 /*++
#009
#010 Routine Description:
#011
#012 This routine handles SMART enable, disable, read attributes and threshold commands.
#013
#014 Arguments:
#015
#016 HwDeviceExtension - HBA miniport driver's adapter data storage
#017 Srb - IO request packet
#018
#019 Return Value:
#020
#021 SRB status
#022
#023 --*/
#024
#025 {
取得驱动对象和控制器的基地址。
#026 PHW_DEVICE_EXTENSION deviceExtension = HwDeviceExtension;
#027 PIDE_REGISTERS_1 baseIoAddress1 = deviceExtension->BaseIoAddress1[Srb->TargetId >> 1];
#028 PIDE_REGISTERS_2 baseIoAddress2 = deviceExtension->BaseIoAddress2[Srb->TargetId >> 1];
从SRB获取输入参数和输出参数。
#029 PSENDCMDOUTPARAMS cmdOutParameters = (PSENDCMDOUTPARAMS)(((PUCHAR)Srb->DataBuffer) + sizeof(SRB_IO_CONTROL));
#030 SENDCMDINPARAMS cmdInParameters = *(PSENDCMDINPARAMS)(((PUCHAR)Srb->DataBuffer) + sizeof(SRB_IO_CONTROL));
#031 PIDEREGS regs = &cmdInParameters.irDriveRegs;
#032 ULONG i;
#033 UCHAR statusByte,targetId;
#034
#035
检查是否合法的操作。
#036 if (cmdInParameters.irDriveRegs.bCommandReg == SMART_CMD) {
#037
#038 targetId = cmdInParameters.bDriveNumber;
#039
#040 //TODO optimize this check
#041
#042 if ((!(deviceExtension->DeviceFlags[targetId] & DFLAGS_DEVICE_PRESENT)) ||
#043 (deviceExtension->DeviceFlags[targetId] & DFLAGS_ATAPI_DEVICE)) {
#044
#045 return SRB_STATUS_SELECTION_TIMEOUT;
#046 }
#047
获取输出的命令。
#048 deviceExtension->SmartCommand = cmdInParameters.irDriveRegs.bFeaturesReg;
#049
#050 //
#051 // Determine which of the commands to carry out.
#052 //
#053
检查命令是否读取的操作。
#054 if ((cmdInParameters.irDriveRegs.bFeaturesReg == READ_ATTRIBUTES) ||
#055 (cmdInParameters.irDriveRegs.bFeaturesReg == READ_THRESHOLDS)) {
#056
等待IDE设备空闲。
#057 WaitOnBusy(baseIoAddress2,statusByte);
#058
#059 if (statusByte & IDE_STATUS_BUSY) {
#060 DebugPrint((1,
#061 "IdeSendSmartCommand: Returning BUSY status/n"));
#062 return SRB_STATUS_BUSY;
#063 }
#064
#065 //
#066 // Zero the ouput buffer as the input buffer info. has been saved off locally (the buffers are the same).
#067 //
#068
清空输出缓冲区。
#069 for (i = 0; i < (sizeof(SENDCMDOUTPARAMS) + READ_ATTRIBUTE_BUFFER_SIZE - 1); i++) {
#070 ((PUCHAR)cmdOutParameters)[i] = 0;
#071 }
#072
#073 //
#074 // Set data buffer pointer and words left.
#075 //
#076
设置输出缓冲区作为接收IDE设备的数据保存区。
#077 deviceExtension->DataBuffer = (PUSHORT)cmdOutParameters->bBuffer;
#078 deviceExtension->WordsLeft = READ_ATTRIBUTE_BUFFER_SIZE / 2;
#079
#080 //
#081 // Indicate expecting an interrupt.
#082 //
#083
这里设置希望使用中断的方式返回。
#084 deviceExtension->ExpectingInterrupt = TRUE;
#085
把SRB的命令发送给IDE设备。
#086 ScsiPortWritePortUchar(&baseIoAddress1->DriveSelect,(UCHAR)(((targetId & 0x1) << 4) | 0xA0));
#087 ScsiPortWritePortUchar((PUCHAR)baseIoAddress1 + 1,regs->bFeaturesReg);
#088 ScsiPortWritePortUchar(&baseIoAddress1->BlockCount,regs->bSectorCountReg);
#089 ScsiPortWritePortUchar(&baseIoAddress1->BlockNumber,regs->bSectorNumberReg);
#090 ScsiPortWritePortUchar(&baseIoAddress1->CylinderLow,regs->bCylLowReg);
#091 ScsiPortWritePortUchar(&baseIoAddress1->CylinderHigh,regs->bCylHighReg);
#092 ScsiPortWritePortUchar(&baseIoAddress1->Command,regs->bCommandReg);
#093
#094 //
#095 // Wait for interrupt.
#096 //
#097
进入等待中断读取数据返回。
#098 return SRB_STATUS_PENDING;
#099
#100 } else if ((cmdInParameters.irDriveRegs.bFeaturesReg == ENABLE_SMART) ||
#101 (cmdInParameters.irDriveRegs.bFeaturesReg == DISABLE_SMART) ||
#102 (cmdInParameters.irDriveRegs.bFeaturesReg == RETURN_SMART_STATUS) ||
#103 (cmdInParameters.irDriveRegs.bFeaturesReg == ENABLE_DISABLE_AUTOSAVE) ||
#104 (cmdInParameters.irDriveRegs.bFeaturesReg == EXECUTE_OFFLINE_DIAGS) ||
#105 (cmdInParameters.irDriveRegs.bFeaturesReg == SAVE_ATTRIBUTE_VALUES)) {
#106
这是设置一些属性,没有数据返回。
#107 WaitOnBusy(baseIoAddress2,statusByte);
#108
#109 if (statusByte & IDE_STATUS_BUSY) {
#110 DebugPrint((1,
#111 "IdeSendSmartCommand: Returning BUSY status/n"));
#112 return SRB_STATUS_BUSY;
#113 }
#114
#115 //
#116 // Zero the ouput buffer as the input buffer info. has been saved off locally (the buffers are the same).
#117 //
#118
#119 for (i = 0; i < (sizeof(SENDCMDOUTPARAMS) - 1); i++) {
#120 ((PUCHAR)cmdOutParameters)[i] = 0;
#121 }
#122
#123 //
#124 // Set data buffer pointer and indicate no data transfer.
#125 //
#126
#127 deviceExtension->DataBuffer = (PUSHORT)cmdOutParameters->bBuffer;
#128 deviceExtension->WordsLeft = 0;
#129
#130 //
#131 // Indicate expecting an interrupt.
#132 //
#133
#134 deviceExtension->ExpectingInterrupt = TRUE;
#135
#136 ScsiPortWritePortUchar(&baseIoAddress1->DriveSelect,(UCHAR)(((targetId & 0x1) << 4) | 0xA0));
#137 ScsiPortWritePortUchar((PUCHAR)baseIoAddress1 + 1,regs->bFeaturesReg);
#138 ScsiPortWritePortUchar(&baseIoAddress1->BlockCount,regs->bSectorCountReg);
#139 ScsiPortWritePortUchar(&baseIoAddress1->BlockNumber,regs->bSectorNumberReg);
#140 ScsiPortWritePortUchar(&baseIoAddress1->CylinderLow,regs->bCylLowReg);
#141 ScsiPortWritePortUchar(&baseIoAddress1->CylinderHigh,regs->bCylHighReg);
#142 ScsiPortWritePortUchar(&baseIoAddress1->Command,regs->bCommandReg);
#143
#144 //
#145 // Wait for interrupt.
#146 //
#147
#148 return SRB_STATUS_PENDING;
#149 }
#150 }
#151
如果到这里运行,就是非法命令,不能处理。
#152 return SRB_STATUS_INVALID_REQUEST;
#153
#154 } // end IdeSendSmartCommand()