irp.c

 
#include <freerdp/config.h>
 
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
 
#include <winpr/crt.h>
#include <winpr/stream.h>
 
#include <freerdp/utils/rdpdr_utils.h>
 
#include "rdpdr_main.h"
#include "devman.h"
#include "irp.h"
 
static UINT irp_free(IRP* irp)
{
  if (!irp)
    return CHANNEL_RC_OK;
 
  if (irp->input)
    Stream_Release(irp->input);
  if (irp->output)
    Stream_Release(irp->output);
 
  winpr_aligned_free(irp);
  return CHANNEL_RC_OK;
}
 
static UINT irp_complete(IRP* irp)
{
  size_t pos = 0;
  rdpdrPlugin* rdpdr = NULL;
  UINT error = 0;
 
  WINPR_ASSERT(irp);
  WINPR_ASSERT(irp->output);
  WINPR_ASSERT(irp->devman);
 
  rdpdr = (rdpdrPlugin*)irp->devman->plugin;
  WINPR_ASSERT(rdpdr);
 
  pos = Stream_GetPosition(irp->output);
  Stream_SetPosition(irp->output, RDPDR_DEVICE_IO_RESPONSE_LENGTH - 4);
  Stream_Write_INT32(irp->output, irp->IoStatus); /* IoStatus (4 bytes) */
  Stream_SetPosition(irp->output, pos);
 
  error = rdpdr_send(rdpdr, irp->output);
  irp->output = NULL;
 
  irp_free(irp);
  return error;
}
 
IRP* irp_new(DEVMAN* devman, wStreamPool* pool, wStream* s, wLog* log, UINT* error)
{
  IRP* irp = NULL;
  DEVICE* device = NULL;
  UINT32 DeviceId = 0;
 
  WINPR_ASSERT(devman);
  WINPR_ASSERT(pool);
  WINPR_ASSERT(s);
 
  if (!Stream_CheckAndLogRequiredLengthWLog(log, s, 20))
  {
    if (error)
      *error = ERROR_INVALID_DATA;
    return NULL;
  }
 
  Stream_Read_UINT32(s, DeviceId); /* DeviceId (4 bytes) */
  device = devman_get_device_by_id(devman, DeviceId);
 
  if (!device)
  {
    if (error)
      *error = ERROR_DEV_NOT_EXIST;
 
    return NULL;
  }
 
  irp = (IRP*)winpr_aligned_malloc(sizeof(IRP), MEMORY_ALLOCATION_ALIGNMENT);
 
  if (!irp)
  {
    WLog_Print(log, WLOG_ERROR, "_aligned_malloc failed!");
    if (error)
      *error = CHANNEL_RC_NO_MEMORY;
    return NULL;
  }
 
  ZeroMemory(irp, sizeof(IRP));
 
  Stream_Read_UINT32(s, irp->FileId);        /* FileId (4 bytes) */
  Stream_Read_UINT32(s, irp->CompletionId);  /* CompletionId (4 bytes) */
  Stream_Read_UINT32(s, irp->MajorFunction); /* MajorFunction (4 bytes) */
  Stream_Read_UINT32(s, irp->MinorFunction); /* MinorFunction (4 bytes) */
 
  Stream_AddRef(s);
  irp->input = s;
  irp->device = device;
  irp->devman = devman;
 
  irp->output = StreamPool_Take(pool, 256);
  if (!irp->output)
  {
    WLog_Print(log, WLOG_ERROR, "Stream_New failed!");
    irp_free(irp);
    if (error)
      *error = CHANNEL_RC_NO_MEMORY;
    return NULL;
  }
 
  if (!rdpdr_write_iocompletion_header(irp->output, DeviceId, irp->CompletionId, 0))
  {
    irp_free(irp);
    if (error)
      *error = CHANNEL_RC_NO_MEMORY;
    return NULL;
  }
 
  irp->Complete = irp_complete;
  irp->Discard = irp_free;
 
  irp->thread = NULL;
  irp->cancelled = FALSE;
 
  if (error)
    *error = CHANNEL_RC_OK;
 
  return irp;
}