ZC v1918 : Added support for hardware cursor in DVServerUMD & DVServerKMD

Signed-off-by: Malaya Kumar Parida <malaya.kumar.parida@intel.com>

Author: malayaku

DVServerKMD/DVServerKMD_Version.txt

@@ -8,4 +8,4 @@
 ;   This file will have the DVServerKMD version 
 ;--------------------------------------------------------------------------*/
 
-DVServerKMD_Version = 4.0.0
+DVServerKMD_Version = 5.0.0

DVServerKMD/Public.h

@@ -32,6 +32,7 @@ DEFINE_GUID(GUID_DEVINTERFACE_DVServerKMD,
 #define IOCTL_DVSERVER_TEST_IMAGE			CTL_CODE(FILE_DEVICE_UNKNOWN, 0x812, METHOD_BUFFERED, FILE_ANY_ACCESS)
 #define IOCTL_DVSERVER_GET_TOTAL_SCREENS	CTL_CODE(FILE_DEVICE_UNKNOWN, 0x813, METHOD_BUFFERED, FILE_ANY_ACCESS)
 #define IOCTL_DVSERVER_HP_EVENT				CTL_CODE(FILE_DEVICE_UNKNOWN, 0x814, METHOD_BUFFERED, FILE_ANY_ACCESS)
+#define IOCTL_DVSERVER_CURSOR_POS			CTL_CODE(FILE_DEVICE_UNKNOWN, 0x815, METHOD_BUFFERED, FILE_ANY_ACCESS)
 
 typedef struct FrameMetaData
 {
@@ -49,15 +50,19 @@ typedef struct FrameMetaData
 
 typedef struct CursorData
 {
+	UINT32	screen_num;
 	INT		cursor_x;
 	INT		cursor_y;
-	UINT16	iscursorvisible;
+	bool	iscursorvisible;
 	UINT32	cursor_version;
 	UINT16	cursor_type;
 	UINT32  width;
 	UINT32  height;
 	UINT32  pitch;
-	void* data;
+	UINT32 color_format;
+	void*	data;
+	UINT32	x_hot;
+	UINT32	y_hot;
 }CursorData;
 
 struct mode_info

DVServerKMD/Queue.cpp

@@ -127,7 +127,6 @@ Return Value:
 {
 	NTSTATUS status = STATUS_SUCCESS;
 	size_t bufSize;
-	struct CursorData* cptr = NULL;
 	struct KMDF_IOCTL_Response* resp = NULL;
 	WDFDEVICE Device = WdfIoQueueGetDevice(Queue);
 	PDEVICE_CONTEXT pDeviceContext = DeviceGetContext(Device);
@@ -169,14 +168,32 @@ Return Value:
 
 
 	case IOCTL_DVSERVER_CURSOR_DATA:
-		status = WdfRequestRetrieveInputBuffer(Request, 0, (PVOID*)&cptr, &bufSize);
+
+		status = IoctlSetPointerShape(pDeviceContext, InputBufferLength, Request);
+		if (status != STATUS_SUCCESS) {
+			ERR("IoctlSetPointerShape failed with status = %d\n", status);
+			return;
+		}
+
+		status = WdfRequestRetrieveOutputBuffer(Request, 0, (PVOID*)&resp, &bufSize);
 		if (!NT_SUCCESS(status)) {
-			ERR("Couldn't retrieve Input buffer\n");
+			ERR("Couldn't retrieve Output buffer\n");
 			WdfRequestComplete(Request, STATUS_INSUFFICIENT_RESOURCES);
 			return;
 		}
 
-		PRINT_CURSOR_DATA(("x=%d, y=%d", cptr->cursor_x, cptr->cursor_y));
+		//Return value from the KMDF DVServer
+		resp->retval = DVSERVERKMD_SUCCESS;
+		WdfRequestSetInformation(Request, sizeof(struct KMDF_IOCTL_Response));
+		break;
+
+	case IOCTL_DVSERVER_CURSOR_POS:
+		status = IoctlSetPointerPosition(pDeviceContext, InputBufferLength, Request);
+		if (status != STATUS_SUCCESS) {
+			ERR("IoctlSetPointerPosition failed with status = %d\n", status);
+			WdfRequestComplete(Request, STATUS_INSUFFICIENT_RESOURCES);
+			return;
+		}
 
 		status = WdfRequestRetrieveOutputBuffer(Request, 0, (PVOID*)&resp, &bufSize);
 		if (!NT_SUCCESS(status)) {
@@ -589,4 +606,100 @@ static NTSTATUS IoctlRequestHPEventInfo(
 	WdfRequestSetInformation(Request, sizeof(struct hp_info));
 
 	return STATUS_SUCCESS;
-}
+}
+
+static NTSTATUS IoctlSetPointerShape(
+	const PDEVICE_CONTEXT DeviceContext,
+	const size_t          InputBufferLength,
+	const WDFREQUEST      Request)
+{
+	POINTER_SHAPE pointerShape;
+	struct CursorData* cptr = NULL;
+	size_t bufSize;
+	NTSTATUS status = STATUS_UNSUCCESSFUL;
+
+	TRACING();
+
+	VioGpuAdapterLite* pAdapter =
+		(VioGpuAdapterLite*)(DeviceContext ? DeviceContext->pvDeviceExtension : nullptr);
+
+	if (!pAdapter) {
+		ERR("Couldnt' find adapter\n");
+		return status;
+	}
+
+	status = WdfRequestRetrieveInputBuffer(Request, InputBufferLength, (PVOID*)&cptr, &bufSize);
+	if (!NT_SUCCESS(status)) {
+		ERR("Couldn't retrieve Input buffer\n");
+		WdfRequestComplete(Request, STATUS_INSUFFICIENT_RESOURCES);
+		return STATUS_INVALID_USER_BUFFER;
+	}
+
+	if (cptr == NULL) {
+		return STATUS_UNSUCCESSFUL;
+	}
+
+	RtlZeroMemory(&pointerShape, sizeof(POINTER_SHAPE));
+	pointerShape.pointer.VidPnSourceId = cptr->screen_num;
+	pointerShape.pointer.Height = cptr->height;
+	pointerShape.pointer.Width = cptr->width;
+	pointerShape.pointer.Pitch = cptr->pitch;
+	pointerShape.pointer.pPixels = cptr->data;
+	pointerShape.pointer.XHot = cptr->x_hot;
+	pointerShape.pointer.YHot = cptr->y_hot;
+	pointerShape.X = cptr->cursor_x;
+	pointerShape.Y = cptr->cursor_y;
+
+	status = pAdapter->SetPointerShape(&pointerShape, cptr->color_format, cptr->iscursorvisible);
+
+	if (status != STATUS_SUCCESS) {
+		ERR("SetPointerShape failed with status = %d\n", status);
+		return STATUS_UNSUCCESSFUL;
+	}
+	return STATUS_SUCCESS;
+}
+
+static NTSTATUS IoctlSetPointerPosition(
+	const PDEVICE_CONTEXT DeviceContext,
+	const size_t          InputBufferLength,
+	const WDFREQUEST      Request)
+{
+	DXGKARG_SETPOINTERPOSITION pointerPosition;
+	struct CursorData* cptr = NULL;
+	size_t bufSize;
+	NTSTATUS status = STATUS_UNSUCCESSFUL;
+
+	TRACING();
+
+	VioGpuAdapterLite* pAdapter =
+		(VioGpuAdapterLite*)(DeviceContext ? DeviceContext->pvDeviceExtension : 0);
+
+	if (!pAdapter) {
+		ERR("Couldnt' find adapter\n");
+		return status;
+	}
+
+	status = WdfRequestRetrieveInputBuffer(Request, InputBufferLength, (PVOID*)&cptr, &bufSize);
+	if (!NT_SUCCESS(status)) {
+		ERR("Couldn't retrieve Input buffer\n");
+		WdfRequestComplete(Request, STATUS_INSUFFICIENT_RESOURCES);
+		return STATUS_INVALID_USER_BUFFER;
+	}
+
+	if (cptr == NULL) {
+		return STATUS_UNSUCCESSFUL;
+	}
+
+	RtlZeroMemory(&pointerPosition, sizeof(DXGKARG_SETPOINTERPOSITION));
+	pointerPosition.X = cptr->cursor_x;
+	pointerPosition.Y = cptr->cursor_y;
+	pointerPosition.VidPnSourceId = cptr->screen_num;
+
+	status = pAdapter->SetPointerPosition(&pointerPosition);
+
+	if (status != STATUS_SUCCESS) {
+		ERR("SetPointerPosition failed with status = %d\n", status);
+		return STATUS_UNSUCCESSFUL;
+	}
+	return STATUS_SUCCESS;
+}

DVServerKMD/Queue.h

@@ -68,6 +68,16 @@ static NTSTATUS IoctlRequestHPEventInfo(
 	const WDFREQUEST      Request,
 	size_t* BytesReturned);
 
+static NTSTATUS IoctlSetPointerShape(
+	const PDEVICE_CONTEXT DeviceContext,
+	const size_t          InputBufferLength,
+	const WDFREQUEST      Request);
+
+static NTSTATUS IoctlSetPointerPosition(
+	const PDEVICE_CONTEXT DeviceContext,
+	const size_t          InputBufferLength,
+	const WDFREQUEST      Request);
+
 //
 // Events from the IoQueue object
 //

DVServerKMD/bitops.cpp

@@ -162,6 +162,13 @@ VOID CopyBits32_32(
 
 		for (UINT i = 0; i < NumRows; ++i) {
 			RtlCopyMemory(pStartDst, pStartSrc, BytesToCopy);
+			for (UINT j = 0; j < NumPixels; j++) {
+				RtlCopyMemory(&pStartDst[j * 4], &pStartSrc[j * 4], 4);
+				if (pDst->PixelFmt == D3DDDIFMT_A8B8G8R8 && pSrc->PixelFmt == D3DDDIFMT_A8R8G8B8) {
+					pStartDst[j * 4] = pStartSrc[j * 4 + 2];
+					pStartDst[j * 4 + 2] = pStartSrc[j * 4];
+				}
+			}
 			pStartDst += pDst->Pitch;
 			pStartSrc += pSrc->Pitch;
 		}
@@ -203,6 +210,7 @@ UINT BPPFromPixelFormat(D3DDDIFORMAT Format)
 	case D3DDDIFMT_R5G6B5: return 16;
 	case D3DDDIFMT_R8G8B8: return 24;
 	case D3DDDIFMT_X8R8G8B8:
+	case D3DDDIFMT_A8B8G8R8:
 	case D3DDDIFMT_A8R8G8B8: return 32;
 	default: VIOGPU_LOG_ASSERTION1("Unknown D3DDDIFORMAT 0x%I64x", Format); return 0;
 	}

DVServerKMD/bitops.h

@@ -9,6 +9,7 @@ typedef struct _BLT_INFO {
 	D3DKMDT_VIDPN_PRESENT_PATH_ROTATION Rotation;
 	UINT Width;
 	UINT Height;
+	D3DDDIFORMAT PixelFmt;
 } BLT_INFO;