Blame channels/rdpdr/client/irp.c

Packit Service fa4841
/**
Packit Service fa4841
 * FreeRDP: A Remote Desktop Protocol Implementation
Packit Service fa4841
 * Device Redirection Virtual Channel
Packit Service fa4841
 *
Packit Service fa4841
 * Copyright 2010-2011 Vic Lee
Packit Service fa4841
 * Copyright 2010-2012 Marc-Andre Moreau <marcandre.moreau@gmail.com>
Packit Service fa4841
 * Copyright 2015 Thincast Technologies GmbH
Packit Service fa4841
 * Copyright 2015 DI (FH) Martin Haimberger <martin.haimberger@thincast.com>
Packit Service fa4841
 *
Packit Service fa4841
 * Licensed under the Apache License, Version 2.0 (the "License");
Packit Service fa4841
 * you may not use this file except in compliance with the License.
Packit Service fa4841
 * You may obtain a copy of the License at
Packit Service fa4841
 *
Packit Service fa4841
 *     http://www.apache.org/licenses/LICENSE-2.0
Packit Service fa4841
 *
Packit Service fa4841
 * Unless required by applicable law or agreed to in writing, software
Packit Service fa4841
 * distributed under the License is distributed on an "AS IS" BASIS,
Packit Service fa4841
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
Packit Service fa4841
 * See the License for the specific language governing permissions and
Packit Service fa4841
 * limitations under the License.
Packit Service fa4841
 */
Packit Service fa4841
Packit Service fa4841
#ifdef HAVE_CONFIG_H
Packit Service fa4841
#include "config.h"
Packit Service fa4841
#endif
Packit Service fa4841
Packit Service fa4841
#include <stdio.h>
Packit Service fa4841
#include <stdlib.h>
Packit Service fa4841
#include <string.h>
Packit Service fa4841
Packit Service fa4841
#include <winpr/crt.h>
Packit Service fa4841
#include <winpr/stream.h>
Packit Service fa4841
Packit Service fa4841
#include "rdpdr_main.h"
Packit Service fa4841
#include "devman.h"
Packit Service fa4841
#include "irp.h"
Packit Service fa4841
Packit Service fa4841
/**
Packit Service fa4841
 * Function description
Packit Service fa4841
 *
Packit Service fa4841
 * @return 0 on success, otherwise a Win32 error code
Packit Service fa4841
 */
Packit Service fa4841
static UINT irp_free(IRP* irp)
Packit Service fa4841
{
Packit Service fa4841
	if (!irp)
Packit Service fa4841
		return CHANNEL_RC_OK;
Packit Service fa4841
Packit Service fa4841
	Stream_Free(irp->input, TRUE);
Packit Service fa4841
	Stream_Free(irp->output, TRUE);
Packit Service fa4841
Packit Service fa4841
	_aligned_free(irp);
Packit Service fa4841
	return CHANNEL_RC_OK;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
/**
Packit Service fa4841
 * Function description
Packit Service fa4841
 *
Packit Service fa4841
 * @return 0 on success, otherwise a Win32 error code
Packit Service fa4841
 */
Packit Service fa4841
static UINT irp_complete(IRP* irp)
Packit Service fa4841
{
Packit Service fa4841
	size_t pos;
Packit Service fa4841
	rdpdrPlugin* rdpdr;
Packit Service fa4841
	UINT error;
Packit Service fa4841
Packit Service fa4841
	rdpdr = (rdpdrPlugin*)irp->devman->plugin;
Packit Service fa4841
Packit Service fa4841
	pos = Stream_GetPosition(irp->output);
Packit Service fa4841
	Stream_SetPosition(irp->output, RDPDR_DEVICE_IO_RESPONSE_LENGTH - 4);
Packit Service fa4841
	Stream_Write_UINT32(irp->output, irp->IoStatus); /* IoStatus (4 bytes) */
Packit Service fa4841
	Stream_SetPosition(irp->output, pos);
Packit Service fa4841
Packit Service fa4841
	error = rdpdr_send(rdpdr, irp->output);
Packit Service fa4841
	irp->output = NULL;
Packit Service fa4841
Packit Service fa4841
	return irp_free(irp);
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
IRP* irp_new(DEVMAN* devman, wStream* s, UINT* error)
Packit Service fa4841
{
Packit Service fa4841
	IRP* irp;
Packit Service fa4841
	DEVICE* device;
Packit Service fa4841
	UINT32 DeviceId;
Packit Service fa4841
Packit Service fa4841
	if (Stream_GetRemainingLength(s) < 20)
Packit Service fa4841
	{
Packit Service fa4841
		if (error)
Packit Service fa4841
			*error = ERROR_INVALID_DATA;
Packit Service fa4841
		return NULL;
Packit Service fa4841
	}
Packit Service fa4841
Packit Service fa4841
	Stream_Read_UINT32(s, DeviceId); /* DeviceId (4 bytes) */
Packit Service fa4841
	device = devman_get_device_by_id(devman, DeviceId);
Packit Service fa4841
Packit Service fa4841
	if (!device)
Packit Service fa4841
	{
Packit Service fa4841
		WLog_WARN(TAG, "devman_get_device_by_id failed!");
Packit Service fa4841
		if (error)
Packit Service fa4841
			*error = CHANNEL_RC_OK;
Packit Service fa4841
Packit Service fa4841
		return NULL;
Packit Service fa4841
	};
Packit Service fa4841
Packit Service fa4841
	irp = (IRP*)_aligned_malloc(sizeof(IRP), MEMORY_ALLOCATION_ALIGNMENT);
Packit Service fa4841
Packit Service fa4841
	if (!irp)
Packit Service fa4841
	{
Packit Service fa4841
		WLog_ERR(TAG, "_aligned_malloc failed!");
Packit Service fa4841
		if (error)
Packit Service fa4841
			*error = CHANNEL_RC_NO_MEMORY;
Packit Service fa4841
		return NULL;
Packit Service fa4841
	}
Packit Service fa4841
Packit Service fa4841
	ZeroMemory(irp, sizeof(IRP));
Packit Service fa4841
Packit Service fa4841
	irp->input = s;
Packit Service fa4841
	irp->device = device;
Packit Service fa4841
	irp->devman = devman;
Packit Service fa4841
Packit Service fa4841
	Stream_Read_UINT32(s, irp->FileId);        /* FileId (4 bytes) */
Packit Service fa4841
	Stream_Read_UINT32(s, irp->CompletionId);  /* CompletionId (4 bytes) */
Packit Service fa4841
	Stream_Read_UINT32(s, irp->MajorFunction); /* MajorFunction (4 bytes) */
Packit Service fa4841
	Stream_Read_UINT32(s, irp->MinorFunction); /* MinorFunction (4 bytes) */
Packit Service fa4841
Packit Service fa4841
	irp->output = Stream_New(NULL, 256);
Packit Service fa4841
	if (!irp->output)
Packit Service fa4841
	{
Packit Service fa4841
		WLog_ERR(TAG, "Stream_New failed!");
Packit Service fa4841
		_aligned_free(irp);
Packit Service fa4841
		if (error)
Packit Service fa4841
			*error = CHANNEL_RC_NO_MEMORY;
Packit Service fa4841
		return NULL;
Packit Service fa4841
	}
Packit Service fa4841
	Stream_Write_UINT16(irp->output, RDPDR_CTYP_CORE);                /* Component (2 bytes) */
Packit Service fa4841
	Stream_Write_UINT16(irp->output, PAKID_CORE_DEVICE_IOCOMPLETION); /* PacketId (2 bytes) */
Packit Service fa4841
	Stream_Write_UINT32(irp->output, DeviceId);                       /* DeviceId (4 bytes) */
Packit Service fa4841
	Stream_Write_UINT32(irp->output, irp->CompletionId);              /* CompletionId (4 bytes) */
Packit Service fa4841
	Stream_Write_UINT32(irp->output, 0);                              /* IoStatus (4 bytes) */
Packit Service fa4841
Packit Service fa4841
	irp->Complete = irp_complete;
Packit Service fa4841
	irp->Discard = irp_free;
Packit Service fa4841
Packit Service fa4841
	irp->thread = NULL;
Packit Service fa4841
	irp->cancelled = FALSE;
Packit Service fa4841
Packit Service fa4841
	if (error)
Packit Service fa4841
		*error = CHANNEL_RC_OK;
Packit Service fa4841
Packit Service fa4841
	return irp;
Packit Service fa4841
}