天天看點

41、過濾驅動程式

    過濾驅動程式可以修改已有驅動的功能,也可以對資料進行過濾加密。WDM驅動需要通過系統資料庫記錄指定加裁的過濾驅動,OS會讀取這些值完成加載,其可以是高層過濾,也可以是低層過濾。而NT較為靈活,不用設定系統資料庫,直接在記憶體中尋找裝置對象,然後自行建立過濾驅動并将自己附加在這個驅動之上。

    過濾驅動的入口函數需要将所有的IRP都設定派遣例程,因為過濾驅動要保證所有上層傳遞下來的IRP都能夠接收到。如果想修改某個IRP的處理,例如鍵盤讀取輸入的鍵盤掃描碼,可以在派遣例程中設定完成例程,在完成例程中修改IRP的處理。

    一般,将介于FDO與PDO間的過濾驅動程式稱為低層過濾驅動程式,而将附加在FDO上面的稱為高層過濾驅動程式。

1、WDM式過濾示例

    檔案過濾驅動,它将挂載在磁盤驅動上,它将所有發往磁盤驅動的IRP全部攔截。一般都是将上層驅動程式傳進來的IRP進行攔截并不做處理,而轉發給底層驅動程式,稱為Pass-Through。特殊IRP,特殊處理。将需要過濾的操作放在完成例程中。

41、過濾驅動程式

圖示 過濾驅動程式 P507

41、過濾驅動程式
41、過濾驅動程式

代碼

typedef struct tagDEVICE_EXTENSION {

PDEVICE_OBJECT DeviceObject; // device object this extension belongs to

PDEVICE_OBJECT LowerDeviceObject; // next lower driver in same stack

PDEVICE_OBJECT Pdo; // the PDO

IO_REMOVE_LOCK RemoveLock;

} DEVICE_EXTENSION, *PDEVICE_EXTENSION;

#pragma INITCODE

extern "C" NTSTATUS DriverEntry(IN PDRIVER_OBJECT DriverObject,

IN PUNICODE_STRING RegistryPath)

{ // DriverEntry

KdPrint((DRIVERNAME " - Entering DriverEntry: DriverObject %8.8lX\n", DriverObject));

// Initialize function pointers

DriverObject->DriverUnload = DriverUnload;

DriverObject->DriverExtension->AddDevice = AddDevice;

for (int i = 0; i < arraysize(DriverObject->MajorFunction); ++i)

DriverObject->MajorFunction[i] = DispatchAny;

DriverObject->MajorFunction[IRP_MJ_POWER] = DispatchPower;

DriverObject->MajorFunction[IRP_MJ_PNP] = DispatchPnp;

DriverObject->MajorFunction[IRP_MJ_SCSI] = DispatchForSCSI;

return STATUS_SUCCESS;

} // DriverEntry

///////////////////////////////////////////////////////////////////////////////

#pragma PAGEDCODE

VOID DriverUnload(IN PDRIVER_OBJECT DriverObject)

{ // DriverUnload

PAGED_CODE();

KdPrint((DRIVERNAME " - Entering DriverUnload: DriverObject %8.8lX\n", DriverObject));

} // DriverUnload

NTSTATUS AddDevice(IN PDRIVER_OBJECT DriverObject, IN PDEVICE_OBJECT pdo)

{ // AddDevice

NTSTATUS status;

PDEVICE_OBJECT fido;

status = IoCreateDevice(DriverObject, sizeof(DEVICE_EXTENSION), NULL,

GetDeviceTypeToUse(pdo), 0, FALSE, &fido);

if (!NT_SUCCESS(status))

{ // can't create device object

KdPrint((DRIVERNAME " - IoCreateDevice failed - %X\n", status));

return status;

} // can't create device object

PDEVICE_EXTENSION pdx = (PDEVICE_EXTENSION) fido->DeviceExtension;

do

{ // finish initialization

IoInitializeRemoveLock(&pdx->RemoveLock, 0, 0, 0);

pdx->DeviceObject = fido;

pdx->Pdo = pdo;

//将過濾驅動附加在底層驅動之上

PDEVICE_OBJECT fdo = IoAttachDeviceToDeviceStack(fido, pdo);

if (!fdo)

{ // can't attach

KdPrint((DRIVERNAME " - IoAttachDeviceToDeviceStack failed\n"));

status = STATUS_DEVICE_REMOVED;

break;

} // can't attach

//記錄底層驅動

pdx->LowerDeviceObject = fdo;

//由于不知道底層驅動是直接IO還是BufferIO,是以将标志都置上

fido->Flags |= fdo->Flags & (DO_DIRECT_IO | DO_BUFFERED_IO | DO_POWER_PAGABLE);

// Clear the "initializing" flag so that we can get IRPs

fido->Flags &= ~DO_DEVICE_INITIALIZING;

} while (FALSE); // finish initialization

{ // need to cleanup

if (pdx->LowerDeviceObject)

IoDetachDevice(pdx->LowerDeviceObject);

IoDeleteDevice(fido);

} // need to cleanup

} // AddDevice

#pragma LOCKEDCODE

NTSTATUS CompleteRequest(IN PIRP Irp, IN NTSTATUS status, IN ULONG_PTR info)

{ // CompleteRequest

Irp->IoStatus.Status = status;

Irp->IoStatus.Information = info;

IoCompleteRequest(Irp, IO_NO_INCREMENT);

} // CompleteRequest

NTSTATUS

USBSCSICompletion( IN PDEVICE_OBJECT DeviceObject,

IN PIRP Irp,

IN PVOID Context )

{

PDEVICE_EXTENSION pdx = ( PDEVICE_EXTENSION )

DeviceObject->DeviceExtension;

IoAcquireRemoveLock(&pdx->RemoveLock,Irp);

PIO_STACK_LOCATION irpStack = IoGetCurrentIrpStackLocation( Irp );

PSCSI_REQUEST_BLOCK CurSrb=irpStack->Parameters.Scsi.Srb;

PCDB cdb = (PCDB)CurSrb->Cdb;

UCHAR opCode=cdb->CDB6GENERIC.OperationCode;

if(opCode==SCSIOP_MODE_SENSE && CurSrb->DataBuffer

&& CurSrb->DataTransferLength >=

sizeof(MODE_PARAMETER_HEADER))

KdPrint(("SCSIOP_MODE_SENSE comming!\n"));

PMODE_PARAMETER_HEADER modeData = (PMODE_PARAMETER_HEADER)CurSrb->DataBuffer;

modeData->DeviceSpecificParameter |= MODE_DSP_WRITE_PROTECT;

}

if ( Irp->PendingReturned )

IoMarkIrpPending( Irp );

IoReleaseRemoveLock(&pdx->RemoveLock,Irp);

return Irp->IoStatus.Status ;

NTSTATUS DispatchForSCSI(IN PDEVICE_OBJECT fido, IN PIRP Irp)

// KdPrint((DRIVERNAME " - Enter DispatchForSCSI \n"));

PIO_STACK_LOCATION irpStack = IoGetCurrentIrpStackLocation(Irp);

// Pass request down without additional processing

status = IoAcquireRemoveLock(&pdx->RemoveLock, Irp);

return CompleteRequest(Irp, status, 0);

IoCopyCurrentIrpStackLocationToNext(Irp);

IoSetCompletionRoutine( Irp,

USBSCSICompletion,

NULL,

TRUE,

TRUE );

status = IoCallDriver(pdx->LowerDeviceObject, Irp);

IoReleaseRemoveLock(&pdx->RemoveLock, Irp);

#pragma LOCKEDCODE // make no assumptions about pageability of dispatch fcns

NTSTATUS DispatchAny(IN PDEVICE_OBJECT fido, IN PIRP Irp)

{ // DispatchAny

PIO_STACK_LOCATION stack = IoGetCurrentIrpStackLocation(Irp);

#if DBG

static char* irpname[] =

"IRP_MJ_CREATE",

"IRP_MJ_CREATE_NAMED_PIPE",

"IRP_MJ_CLOSE",

"IRP_MJ_READ",

"IRP_MJ_WRITE",

"IRP_MJ_QUERY_INFORMATION",

"IRP_MJ_SET_INFORMATION",

"IRP_MJ_QUERY_EA",

"IRP_MJ_SET_EA",

"IRP_MJ_FLUSH_BUFFERS",

"IRP_MJ_QUERY_VOLUME_INFORMATION",

"IRP_MJ_SET_VOLUME_INFORMATION",

"IRP_MJ_DIRECTORY_CONTROL",

"IRP_MJ_FILE_SYSTEM_CONTROL",

"IRP_MJ_DEVICE_CONTROL",

"IRP_MJ_INTERNAL_DEVICE_CONTROL",

"IRP_MJ_SHUTDOWN",

"IRP_MJ_LOCK_CONTROL",

"IRP_MJ_CLEANUP",

"IRP_MJ_CREATE_MAILSLOT",

"IRP_MJ_QUERY_SECURITY",

"IRP_MJ_SET_SECURITY",

"IRP_MJ_POWER",

"IRP_MJ_SYSTEM_CONTROL",

"IRP_MJ_DEVICE_CHANGE",

"IRP_MJ_QUERY_QUOTA",

"IRP_MJ_SET_QUOTA",

"IRP_MJ_PNP",

};

UCHAR type = stack->MajorFunction;

// if (type >= arraysize(irpname))

// KdPrint((DRIVERNAME " - Unknown IRP, major type %X\n", type));

// else

// KdPrint((DRIVERNAME " - %s\n", irpname[type]));

#endif

IoSkipCurrentIrpStackLocation(Irp);

} // DispatchAny

NTSTATUS DispatchPower(IN PDEVICE_OBJECT fido, IN PIRP Irp)

{ // DispatchPower

ULONG fcn = stack->MinorFunction;

static char* fcnname[] =

"IRP_MN_WAIT_WAKE",

"IRP_MN_POWER_SEQUENCE",

"IRP_MN_SET_POWER",

"IRP_MN_QUERY_POWER",

if (fcn == IRP_MN_SET_POWER || fcn == IRP_MN_QUERY_POWER)

static char* sysstate[] =

"PowerSystemUnspecified",

"PowerSystemWorking",

"PowerSystemSleeping1",

"PowerSystemSleeping2",

"PowerSystemSleeping3",

"PowerSystemHibernate",

"PowerSystemShutdown",

"PowerSystemMaximum",

static char* devstate[] =

"PowerDeviceUnspecified",

"PowerDeviceD0",

"PowerDeviceD1",

"PowerDeviceD2",

"PowerDeviceD3",

"PowerDeviceMaximum",

ULONG context = stack->Parameters.Power.SystemContext;

POWER_STATE_TYPE type = stack->Parameters.Power.Type;

KdPrint((DRIVERNAME " - IRP_MJ_POWER (%s)", fcnname[fcn]));

if (type == SystemPowerState)

KdPrint((", SystemPowerState = %s\n", sysstate[stack->Parameters.Power.State.SystemState]));

else

KdPrint((", DevicePowerState = %s\n", devstate[stack->Parameters.Power.State.DeviceState]));

else if (fcn < arraysize(fcnname))

KdPrint((DRIVERNAME " - IRP_MJ_POWER (%s)\n", fcnname[fcn]));

KdPrint((DRIVERNAME " - IRP_MJ_POWER (%2.2X)\n", fcn));

#endif // DBG

PoStartNextPowerIrp(Irp); // must be done while we own the IRP

status = PoCallDriver(pdx->LowerDeviceObject, Irp);

} // DispatchPower

NTSTATUS DispatchPnp(IN PDEVICE_OBJECT fido, IN PIRP Irp)

{ // DispatchPnp

static char* pnpname[] =

"IRP_MN_START_DEVICE",

"IRP_MN_QUERY_REMOVE_DEVICE",

"IRP_MN_REMOVE_DEVICE",

"IRP_MN_CANCEL_REMOVE_DEVICE",

"IRP_MN_STOP_DEVICE",

"IRP_MN_QUERY_STOP_DEVICE",

"IRP_MN_CANCEL_STOP_DEVICE",

"IRP_MN_QUERY_DEVICE_RELATIONS",

"IRP_MN_QUERY_INTERFACE",

"IRP_MN_QUERY_CAPABILITIES",

"IRP_MN_QUERY_RESOURCES",

"IRP_MN_QUERY_RESOURCE_REQUIREMENTS",

"IRP_MN_QUERY_DEVICE_TEXT",

"IRP_MN_FILTER_RESOURCE_REQUIREMENTS",

"",

"IRP_MN_READ_CONFIG",

"IRP_MN_WRITE_CONFIG",

"IRP_MN_EJECT",

"IRP_MN_SET_LOCK",

"IRP_MN_QUERY_ID",

"IRP_MN_QUERY_PNP_DEVICE_STATE",

"IRP_MN_QUERY_BUS_INFORMATION",

"IRP_MN_DEVICE_USAGE_NOTIFICATION",

"IRP_MN_SURPRISE_REMOVAL",

"IRP_MN_QUERY_LEGACY_BUS_INFORMATION",

if (fcn < arraysize(pnpname))

KdPrint((DRIVERNAME " - IRP_MJ_PNP (%s)\n", pnpname[fcn]));

KdPrint((DRIVERNAME " - IRP_MJ_PNP (%2.2X)\n", fcn));

// Handle usage notification specially in order to track power pageable

// flag correctly. We need to avoid allowing a non-pageable handler to be

// layered on top of a pageable handler.

if (fcn == IRP_MN_DEVICE_USAGE_NOTIFICATION)

{ // usage notification

if (!fido->AttachedDevice || (fido->AttachedDevice->Flags & DO_POWER_PAGABLE))

fido->Flags |= DO_POWER_PAGABLE;

IoSetCompletionRoutine(Irp, (PIO_COMPLETION_ROUTINE) UsageNotificationCompletionRoutine,

(PVOID) pdx, TRUE, TRUE, TRUE);

return IoCallDriver(pdx->LowerDeviceObject, Irp);

} // usage notification

// Handle start device specially in order to correctly inherit

// FILE_REMOVABLE_MEDIA

if (fcn == IRP_MN_START_DEVICE)

{ // device start

IoSetCompletionRoutine(Irp, (PIO_COMPLETION_ROUTINE) StartDeviceCompletionRoutine,

} // device start

// Handle remove device specially in order to cleanup device stack

if (fcn == IRP_MN_REMOVE_DEVICE)

{ // remove device

IoReleaseRemoveLockAndWait(&pdx->RemoveLock, Irp);

RemoveDevice(fido);

} // remove device

// Simply forward any other type of PnP request

} // DispatchPnp

// GetDeviceTypeToUse returns the device object type of the next lower device

// object. This helps overcome a bug in some Win2K file systems which expect the

// topmost FiDO in a storage stack to have a VPB and, hence, to have been created

// with a type such as FILE_DEVICE_DISK.

ULONG GetDeviceTypeToUse(PDEVICE_OBJECT pdo)

{ // GetDeviceTypeToUse

PDEVICE_OBJECT ldo = IoGetAttachedDeviceReference(pdo);

if (!ldo)

return FILE_DEVICE_UNKNOWN;

ULONG devtype = ldo->DeviceType;

ObDereferenceObject(ldo);

return devtype;

} // GetDeviceTypeToUse

VOID RemoveDevice(IN PDEVICE_OBJECT fido)

{ // RemoveDevice

KdPrint(("Enter RemoveDevice"));

} // RemoveDevice

NTSTATUS StartDeviceCompletionRoutine(PDEVICE_OBJECT fido, PIRP Irp, PDEVICE_EXTENSION pdx)

{ // StartDeviceCompletionRoutine

if (Irp->PendingReturned)

IoMarkIrpPending(Irp);

// Inherit FILE_REMOVABLE_MEDIA flag from lower object. This is necessary

// for a disk filter, but it isn't available until start-device time. Drivers

// above us may examine the flag as part of their own start-device processing, too.

if (pdx->LowerDeviceObject->Characteristics & FILE_REMOVABLE_MEDIA)

fido->Characteristics |= FILE_REMOVABLE_MEDIA;

} // StartDeviceCompletionRoutine

NTSTATUS UsageNotificationCompletionRoutine(PDEVICE_OBJECT fido, PIRP Irp, PDEVICE_EXTENSION pdx)

{ // UsageNotificationCompletionRoutine

// If lower driver cleared pageable flag, we must do the same

if (!(pdx->LowerDeviceObject->Flags & DO_POWER_PAGABLE))

fido->Flags &= ~DO_POWER_PAGABLE;

} // UsageNotificationCompletionRoutine

#pragma LOCKEDCODE // force inline functions into nonpaged code

示例代碼 P507

41、過濾驅動程式

圖示U盤裝置驅動拓撲 P509

    對于過濾驅動程式的AddDevice例程,需要建立一個過濾裝置對象,然後把這個對象附加在裝置棧上,并用裝置擴充記錄僅低于本層的驅動對象位址。對于磁盤過濾的關鍵在于IRP_MJ_SCSI這個IRP的捕獲,DISK.sys與USBSTOR.sys間傳遞的就是标準SCSI指令。如果想讓裝置變成隻讀,隻要将SCSI指令中的SCSIOP_WRITE請求設定為失敗;還有另外一種方法是在SCSIOP_MODE_SENSE請求時,設定 MODE_DSP_WRITE_PROTECT位。

2、NT式過濾驅動

如将鍵盤中的CapsLock改成Ctrl,示例如下。

<a href="http://files.cnblogs.com/mydomain/KeyFilter.rar">示例代碼(Link)</a>