/*
File Kmd.cpp
By WzrterFX
*/
#
include "Kmd.h"
namespace Kmd {
NTSTATUS Kmd::Create(PDRIVER_
OBJECT driver
Object) {
NTSTATUS status = STATUS_UNSUCCESSFUL;
UNICODE_
STRING deviceName { };
RtlInitUnicode
String(&deviceName, L"\\Device\\Kmd");
status = IoCreateDevice(
driver
Object, NULL, &deviceName,
FILE_DEVICE_UNKNOWN, FILE_DEVICE_SECURE_OPEN, FALSE, &_device
Object
);
if (!NT_SUCCESS(status)) {
DbgPrintEx(0, 0,
"Fatal, failed to create driver device.\n"
);
return status;
}
UNICODE_
STRING symbolicLink { };
RtlInitUnicode
String(&symbolicLink, L"\\DosDevices\\Kmd");
status =
IoCreateSymbolicLink(&symbolicLink, &deviceName);
if (!NT_SUCCESS(status)) {
DbgPrintEx(0, 0,
"Fatal, failed to establish driver link.\n"
);
IoDeleteDevice(_device
Object);
return status;
}
SetFlag(_device
Object->Flags, DO_BUFFERED_IO);
driver
Object->MajorFunction[IRP_MJ_CREATE] = [](PDEVICE_
OBJECT, PIRP io) -> NTSTATUS {
IoCompleteRequest(io, IO_NO_INCREMENT);
return io->IoStatus.Status;
};
driver
Object->MajorFunction[IRP_MJ_CLOSE] = [](PDEVICE_
OBJECT, PIRP io) -> NTSTATUS {
IoCompleteRequest(io, IO_NO_INCREMENT);
return io->IoStatus.Status;
};
driver
Object->MajorFunction[IRP_MJ_DEVICE_CONTROL] = &this->KmdControl;
ClearFlag(_device
Object->Flags, DO_DEVICE_INITIALIZING);
return STATUS_SUCCESS;
}
NTSTATUS Kmd::KmdControl(PDEVICE_
OBJECT, PIRP io) {
NTSTATUS status = STATUS_UNSUCCESSFUL;
PIO_STACK_LOCATION stack = IoGetCurrentIrpStackLocation(io);
if (!stack) {
IoCompleteRequest(io, IO_NO_INCREMENT);
DbgPrintEx(0, 0,
"Fatal, missing driver stack location.\n"
);
return status;
}
PKmdRequest request = reinterpret_cast<PKmdRequest>(io->AssociatedIrp.SystemBuffer);
if (!request) {
IoCompleteRequest(io, IO_NO_INCREMENT);
DbgPrintEx(0, 0,
"Fatal, missing driver associated request.\n"
);
return status;
}
static PEPROCESS process { };
static SIZE_T reserved { };
switch (stack->Parameters.DeviceIoControl.IoControlCode) {
case ::Kmd::_IoCtls::attach: {
status = ::Kmd::_NtifsApi::PsLook
upProcessByProcessId(
request->attachRequest.process, &process
);
break;
}
case ::Kmd::_IoCtls::read: {
if (process) {
status = ::Kmd::_NtifsApi::MmCopyVirtualMemory(
process, request->copyMemoryRequest.from, PsGetCurrentProcess(), request->copyMemoryRequest.to,
request->copyMemoryRequest.requested,
MODE::KernelMode, &reserved
);
}
break;
}
case ::Kmd::_IoCtls::write: {
if (process) {
status = ::Kmd::_NtifsApi::MmCopyVirtualMemory(
PsGetCurrentProcess(), request->copyMemoryRequest.to, process, request->copyMemoryRequest.from,
request->copyMemoryRequest.requested,
MODE::KernelMode, &reserved
);
}
break;
}
default: {
status = STATUS_INVALID_DEVICE_REQUEST;
break;
}
}
io->IoStatus.Status = status;
io->IoStatus.Information = sizeof(KmdRequest);
IoCompleteRequest(io, IO_NO_INCREMENT);
return status;
}
}帮我全部加上注释
扫一扫
647
被折叠的 条评论
为什么被折叠?
到【灌水乐园】发言
