fastpath.c

 
#include <freerdp/config.h>
 
#include "settings.h"
 
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
 
#include <winpr/crt.h>
#include <winpr/assert.h>
#include <winpr/stream.h>
 
#include <freerdp/api.h>
#include <freerdp/log.h>
#include <freerdp/crypto/per.h>
 
#include "orders.h"
#include "update.h"
#include "surface.h"
#include "fastpath.h"
#include "rdp.h"
 
#include "../cache/pointer.h"
#include "../cache/palette.h"
#include "../cache/bitmap.h"
 
#define TAG FREERDP_TAG("core.fastpath")
 
enum FASTPATH_INPUT_ENCRYPTION_FLAGS
{
  FASTPATH_INPUT_SECURE_CHECKSUM = 0x1,
  FASTPATH_INPUT_ENCRYPTED = 0x2
};
 
enum FASTPATH_OUTPUT_ENCRYPTION_FLAGS
{
  FASTPATH_OUTPUT_SECURE_CHECKSUM = 0x1,
  FASTPATH_OUTPUT_ENCRYPTED = 0x2
};
 
struct rdp_fastpath
{
  rdpRdp* rdp;
  wStream* fs;
  BYTE encryptionFlags;
  BYTE numberEvents;
  wStream* updateData;
  int fragmentation;
};
 
static const char* const FASTPATH_UPDATETYPE_STRINGS[] = {
  "Orders",                 /* 0x0 */
  "Bitmap",                 /* 0x1 */
  "Palette",                /* 0x2 */
  "Synchronize",            /* 0x3 */
  "Surface Commands",       /* 0x4 */
  "System Pointer Hidden",  /* 0x5 */
  "System Pointer Default", /* 0x6 */
  "???",                    /* 0x7 */
  "Pointer Position",       /* 0x8 */
  "Color Pointer",          /* 0x9 */
  "Cached Pointer",         /* 0xA */
  "New Pointer",            /* 0xB */
};
 
static const char* fastpath_update_to_string(UINT8 update)
{
  if (update >= ARRAYSIZE(FASTPATH_UPDATETYPE_STRINGS))
    return "UNKNOWN";
 
  return FASTPATH_UPDATETYPE_STRINGS[update];
}
 
static BOOL fastpath_read_update_header(wStream* s, BYTE* updateCode, BYTE* fragmentation,
                                        BYTE* compression)
{
  BYTE updateHeader = 0;
 
  if (!s || !updateCode || !fragmentation || !compression)
    return FALSE;
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, 1))
    return FALSE;
 
  Stream_Read_UINT8(s, updateHeader);
  *updateCode = updateHeader & 0x0F;
  *fragmentation = (updateHeader >> 4) & 0x03;
  *compression = (updateHeader >> 6) & 0x03;
  return TRUE;
}
 
static BOOL fastpath_write_update_header(wStream* s, const FASTPATH_UPDATE_HEADER* fpUpdateHeader)
{
  BYTE updateHeader = 0;
  WINPR_ASSERT(fpUpdateHeader);
 
  updateHeader |= fpUpdateHeader->updateCode & 0x0F;
  updateHeader |= (fpUpdateHeader->fragmentation & 0x03) << 4;
  updateHeader |= (fpUpdateHeader->compression & 0x03) << 6;
 
  if (!Stream_CheckAndLogRequiredCapacity(TAG, s, 1))
    return FALSE;
  Stream_Write_UINT8(s, updateHeader);
 
  if (fpUpdateHeader->compression)
  {
    if (!Stream_CheckAndLogRequiredCapacity(TAG, s, 1))
      return FALSE;
 
    Stream_Write_UINT8(s, fpUpdateHeader->compressionFlags);
  }
 
  if (!Stream_CheckAndLogRequiredCapacity(TAG, s, 2))
    return FALSE;
 
  Stream_Write_UINT16(s, fpUpdateHeader->size);
  return TRUE;
}
 
static UINT32 fastpath_get_update_header_size(FASTPATH_UPDATE_HEADER* fpUpdateHeader)
{
  WINPR_ASSERT(fpUpdateHeader);
  return (fpUpdateHeader->compression) ? 4 : 3;
}
 
static BOOL fastpath_write_update_pdu_header(wStream* s,
                                             const FASTPATH_UPDATE_PDU_HEADER* fpUpdatePduHeader,
                                             rdpRdp* rdp)
{
  BYTE fpOutputHeader = 0;
  WINPR_ASSERT(fpUpdatePduHeader);
  WINPR_ASSERT(rdp);
 
  if (!Stream_CheckAndLogRequiredCapacity(TAG, s, 3))
    return FALSE;
 
  fpOutputHeader |= (fpUpdatePduHeader->action & 0x03);
  fpOutputHeader |= (fpUpdatePduHeader->secFlags & 0x03) << 6;
  Stream_Write_UINT8(s, fpOutputHeader);                          /* fpOutputHeader (1 byte) */
  Stream_Write_UINT8(s, 0x80 | (fpUpdatePduHeader->length >> 8)); /* length1 */
  Stream_Write_UINT8(s, fpUpdatePduHeader->length & 0xFF);        /* length2 */
 
  if (fpUpdatePduHeader->secFlags)
  {
    WINPR_ASSERT(rdp->settings);
    if (freerdp_settings_get_uint32(rdp->settings, FreeRDP_EncryptionMethods) ==
        ENCRYPTION_METHOD_FIPS)
    {
      if (!Stream_CheckAndLogRequiredCapacity(TAG, s, 4))
        return FALSE;
 
      Stream_Write(s, fpUpdatePduHeader->fipsInformation, 4);
    }
 
    if (!Stream_CheckAndLogRequiredCapacity(TAG, s, 8))
      return FALSE;
 
    Stream_Write(s, fpUpdatePduHeader->dataSignature, 8);
  }
 
  return TRUE;
}
 
static UINT32 fastpath_get_update_pdu_header_size(FASTPATH_UPDATE_PDU_HEADER* fpUpdatePduHeader,
                                                  rdpRdp* rdp)
{
  UINT32 size = 3; /* fpUpdatePduHeader + length1 + length2 */
 
  if (!fpUpdatePduHeader || !rdp)
    return 0;
 
  if (fpUpdatePduHeader->secFlags)
  {
    size += 8; /* dataSignature */
 
    WINPR_ASSERT(rdp->settings);
    if (freerdp_settings_get_uint32(rdp->settings, FreeRDP_EncryptionMethods) ==
        ENCRYPTION_METHOD_FIPS)
      size += 4; /* fipsInformation */
  }
 
  return size;
}
 
BOOL fastpath_read_header_rdp(rdpFastPath* fastpath, wStream* s, UINT16* length)
{
  BYTE header = 0;
 
  if (!s || !length)
    return FALSE;
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, 1))
    return FALSE;
 
  Stream_Read_UINT8(s, header);
 
  if (fastpath)
  {
    fastpath->encryptionFlags = (header & 0xC0) >> 6;
    fastpath->numberEvents = (header & 0x3C) >> 2;
  }
 
  if (!per_read_length(s, length))
    return FALSE;
 
  const size_t pos = Stream_GetPosition(s);
  if (pos > *length)
    return FALSE;
 
  *length = *length - (UINT16)pos;
  return TRUE;
}
 
static BOOL fastpath_recv_orders(rdpUpdate* update, wStream* s)
{
  UINT16 numberOrders = 0;
 
  if (!s)
  {
    WLog_ERR(TAG, "Invalid arguments");
    return FALSE;
  }
 
  if (!update)
  {
    WLog_ERR(TAG, "Invalid configuration");
    return FALSE;
  }
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, 2))
    return FALSE;
 
  Stream_Read_UINT16(s, numberOrders); /* numberOrders (2 bytes) */
 
  while (numberOrders > 0)
  {
    if (!update_recv_order(update, s))
      return FALSE;
 
    numberOrders--;
  }
 
  return TRUE;
}
 
static BOOL fastpath_recv_update_common(rdpUpdate* update, wStream* s)
{
  BOOL rc = FALSE;
  UINT16 updateType = 0;
  BOOL defaultReturn = 0;
 
  if (!s)
    return FALSE;
 
  if (!update || !update->context)
    return FALSE;
 
  rdpContext* context = update->context;
 
  defaultReturn = freerdp_settings_get_bool(context->settings, FreeRDP_DeactivateClientDecoding);
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, 2))
    return FALSE;
 
  Stream_Read_UINT16(s, updateType); /* updateType (2 bytes) */
  switch (updateType)
  {
    case UPDATE_TYPE_BITMAP:
    {
      BITMAP_UPDATE* bitmap_update = update_read_bitmap_update(update, s);
 
      if (!bitmap_update)
        return FALSE;
 
      rc = IFCALLRESULT(defaultReturn, update->BitmapUpdate, context, bitmap_update);
      free_bitmap_update(context, bitmap_update);
    }
    break;
 
    case UPDATE_TYPE_PALETTE:
    {
      PALETTE_UPDATE* palette_update = update_read_palette(update, s);
 
      if (!palette_update)
        return FALSE;
 
      rc = IFCALLRESULT(defaultReturn, update->Palette, context, palette_update);
      free_palette_update(context, palette_update);
    }
    break;
 
    default:
      break;
  }
 
  return rc;
}
 
static BOOL fastpath_recv_update_synchronize(WINPR_ATTR_UNUSED rdpFastPath* fastpath, wStream* s)
{
  /* server 2008 can send invalid synchronize packet with missing padding,
    so don't return FALSE even if the packet is invalid */
  WINPR_ASSERT(fastpath);
  WINPR_ASSERT(s);
 
  const size_t len = Stream_GetRemainingLength(s);
  const size_t skip = MIN(2, len);
  return Stream_SafeSeek(s, skip); /* size (2 bytes), MUST be set to zero */
}
 
static BOOL fastpath_recv_update_paint_block(rdpUpdate* update, wStream* s,
                                             BOOL (*fkt)(rdpUpdate*, wStream*))
{
  WINPR_ASSERT(fkt);
  if (!update_begin_paint(update))
    return FALSE;
 
  BOOL res = fkt(update, s);
  if (!update_end_paint(update))
    return FALSE;
  return res;
}
 
static int fastpath_recv_update(rdpFastPath* fastpath, BYTE updateCode, wStream* s)
{
  BOOL rc = FALSE;
  int status = 0;
 
  if (!fastpath || !fastpath->rdp || !s)
    return -1;
 
  Stream_SealLength(s);
  Stream_ResetPosition(s);
 
  rdpUpdate* update = fastpath->rdp->update;
 
  if (!update || !update->pointer || !update->context)
    return -1;
 
  rdpContext* context = update->context;
  WINPR_ASSERT(context);
 
  rdpPointerUpdate* pointer = update->pointer;
  WINPR_ASSERT(pointer);
 
#ifdef WITH_DEBUG_RDP
  DEBUG_RDP(fastpath->rdp, "recv Fast-Path %s Update (0x%02" PRIX8 "), length:%" PRIuz "",
            fastpath_update_to_string(updateCode), updateCode, Stream_GetRemainingLength(s));
#endif
 
  const BOOL defaultReturn =
      freerdp_settings_get_bool(context->settings, FreeRDP_DeactivateClientDecoding);
  switch (updateCode)
  {
    case FASTPATH_UPDATETYPE_ORDERS:
      rc = fastpath_recv_update_paint_block(update, s, fastpath_recv_orders);
      break;
 
    case FASTPATH_UPDATETYPE_BITMAP:
    case FASTPATH_UPDATETYPE_PALETTE:
      rc = fastpath_recv_update_paint_block(update, s, fastpath_recv_update_common);
      break;
 
    case FASTPATH_UPDATETYPE_SYNCHRONIZE:
      if (!fastpath_recv_update_synchronize(fastpath, s))
        WLog_ERR(TAG, "fastpath_recv_update_synchronize failure but we continue");
      else
        rc = IFCALLRESULT(TRUE, update->Synchronize, context);
 
      break;
 
    case FASTPATH_UPDATETYPE_SURFCMDS:
      status = fastpath_recv_update_paint_block(update, s, update_recv_surfcmds);
      rc = (status >= 0);
      break;
 
    case FASTPATH_UPDATETYPE_PTR_NULL:
    {
      POINTER_SYSTEM_UPDATE pointer_system = WINPR_C_ARRAY_INIT;
      pointer_system.type = SYSPTR_NULL;
      rc = IFCALLRESULT(defaultReturn, pointer->PointerSystem, context, &pointer_system);
    }
    break;
 
    case FASTPATH_UPDATETYPE_PTR_DEFAULT:
    {
      POINTER_SYSTEM_UPDATE pointer_system = WINPR_C_ARRAY_INIT;
      pointer_system.type = SYSPTR_DEFAULT;
      rc = IFCALLRESULT(defaultReturn, pointer->PointerSystem, context, &pointer_system);
    }
    break;
 
    case FASTPATH_UPDATETYPE_PTR_POSITION:
    {
      POINTER_POSITION_UPDATE* pointer_position = update_read_pointer_position(update, s);
 
      if (pointer_position)
      {
        rc = IFCALLRESULT(defaultReturn, pointer->PointerPosition, context,
                          pointer_position);
        free_pointer_position_update(context, pointer_position);
      }
    }
    break;
 
    case FASTPATH_UPDATETYPE_COLOR:
    {
      POINTER_COLOR_UPDATE* pointer_color = update_read_pointer_color(update, s, 24);
 
      if (pointer_color)
      {
        rc = IFCALLRESULT(defaultReturn, pointer->PointerColor, context, pointer_color);
        free_pointer_color_update(context, pointer_color);
      }
    }
    break;
 
    case FASTPATH_UPDATETYPE_CACHED:
    {
      POINTER_CACHED_UPDATE* pointer_cached = update_read_pointer_cached(update, s);
 
      if (pointer_cached)
      {
        rc = IFCALLRESULT(defaultReturn, pointer->PointerCached, context, pointer_cached);
        free_pointer_cached_update(context, pointer_cached);
      }
    }
    break;
 
    case FASTPATH_UPDATETYPE_POINTER:
    {
      POINTER_NEW_UPDATE* pointer_new = update_read_pointer_new(update, s);
 
      if (pointer_new)
      {
        rc = IFCALLRESULT(defaultReturn, pointer->PointerNew, context, pointer_new);
        free_pointer_new_update(context, pointer_new);
      }
    }
    break;
 
    case FASTPATH_UPDATETYPE_LARGE_POINTER:
    {
      POINTER_LARGE_UPDATE* pointer_large = update_read_pointer_large(update, s);
 
      if (pointer_large)
      {
        rc = IFCALLRESULT(defaultReturn, pointer->PointerLarge, context, pointer_large);
        free_pointer_large_update(context, pointer_large);
      }
    }
    break;
    default:
      break;
  }
 
  Stream_ResetPosition(s);
  if (!rc)
  {
    WLog_ERR(TAG, "Fastpath update %s [%" PRIx8 "] failed, status %d",
             fastpath_update_to_string(updateCode), updateCode, status);
    return -1;
  }
 
  return status;
}
 
static int fastpath_recv_update_data(rdpFastPath* fastpath, wStream* s)
{
  int status = 0;
  UINT16 size = 0;
  BYTE updateCode = 0;
  BYTE fragmentation = 0;
  BYTE compression = 0;
  BYTE compressionFlags = 0;
  UINT32 DstSize = 0;
  const BYTE* pDstData = nullptr;
 
  if (!fastpath || !s)
    return -1;
 
  rdpRdp* rdp = fastpath->rdp;
 
  if (!rdp)
    return -1;
 
  rdpTransport* transport = rdp->transport;
 
  if (!transport)
    return -1;
 
  if (!fastpath_read_update_header(s, &updateCode, &fragmentation, &compression))
    return -1;
 
  if (compression == FASTPATH_OUTPUT_COMPRESSION_USED)
  {
    if (!Stream_CheckAndLogRequiredLength(TAG, s, 1))
      return -1;
 
    Stream_Read_UINT8(s, compressionFlags);
  }
  else
    compressionFlags = 0;
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, 2))
    return -1;
 
  Stream_Read_UINT16(s, size);
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, size))
    return -1;
 
  const int bulkStatus =
      bulk_decompress(rdp->bulk, Stream_Pointer(s), size, &pDstData, &DstSize, compressionFlags);
  Stream_Seek(s, size);
 
  if (bulkStatus < 0)
  {
    WLog_ERR(TAG, "bulk_decompress() failed");
    return -1;
  }
 
  if (!Stream_EnsureRemainingCapacity(fastpath->updateData, DstSize))
    return -1;
 
  Stream_Write(fastpath->updateData, pDstData, DstSize);
 
  if (fragmentation == FASTPATH_FRAGMENT_SINGLE)
  {
    if (fastpath->fragmentation != -1)
    {
      WLog_ERR(TAG, "Unexpected FASTPATH_FRAGMENT_SINGLE");
      goto out_fail;
    }
 
    status = fastpath_recv_update(fastpath, updateCode, fastpath->updateData);
 
    if (status < 0)
    {
      WLog_ERR(TAG, "fastpath_recv_update() - %i", status);
      goto out_fail;
    }
  }
  else
  {
    rdpContext* context = nullptr;
    const size_t totalSize = Stream_GetPosition(fastpath->updateData);
 
    context = transport_get_context(transport);
    WINPR_ASSERT(context);
    WINPR_ASSERT(context->settings);
 
    if (totalSize >
        freerdp_settings_get_uint32(context->settings, FreeRDP_MultifragMaxRequestSize))
    {
      WLog_ERR(
          TAG, "Total size (%" PRIuz ") exceeds MultifragMaxRequestSize (%" PRIu32 ")",
          totalSize,
          freerdp_settings_get_uint32(context->settings, FreeRDP_MultifragMaxRequestSize));
      goto out_fail;
    }
 
    if (fragmentation == FASTPATH_FRAGMENT_FIRST)
    {
      if (fastpath->fragmentation != -1)
      {
        WLog_ERR(TAG, "Unexpected FASTPATH_FRAGMENT_FIRST");
        goto out_fail;
      }
 
      fastpath->fragmentation = FASTPATH_FRAGMENT_FIRST;
    }
    else if (fragmentation == FASTPATH_FRAGMENT_NEXT)
    {
      if ((fastpath->fragmentation != FASTPATH_FRAGMENT_FIRST) &&
          (fastpath->fragmentation != FASTPATH_FRAGMENT_NEXT))
      {
        WLog_ERR(TAG, "Unexpected FASTPATH_FRAGMENT_NEXT");
        goto out_fail;
      }
 
      fastpath->fragmentation = FASTPATH_FRAGMENT_NEXT;
    }
    else if (fragmentation == FASTPATH_FRAGMENT_LAST)
    {
      if ((fastpath->fragmentation != FASTPATH_FRAGMENT_FIRST) &&
          (fastpath->fragmentation != FASTPATH_FRAGMENT_NEXT))
      {
        WLog_ERR(TAG, "Unexpected FASTPATH_FRAGMENT_LAST");
        goto out_fail;
      }
 
      fastpath->fragmentation = -1;
      status = fastpath_recv_update(fastpath, updateCode, fastpath->updateData);
 
      if (status < 0)
      {
        WLog_ERR(TAG, "fastpath_recv_update() - %i", status);
        goto out_fail;
      }
    }
  }
 
  return status;
out_fail:
  return -1;
}
 
state_run_t fastpath_recv_updates(rdpFastPath* fastpath, wStream* s)
{
  state_run_t rc = STATE_RUN_FAILED;
 
  WINPR_ASSERT(s);
  WINPR_ASSERT(fastpath);
  WINPR_ASSERT(fastpath->rdp);
 
  while (Stream_GetRemainingLength(s) >= 3)
  {
    if (fastpath_recv_update_data(fastpath, s) < 0)
    {
      WLog_ERR(TAG, "fastpath_recv_update_data() fail");
      rc = STATE_RUN_FAILED;
      goto fail;
    }
  }
 
  rc = STATE_RUN_SUCCESS;
fail:
 
  return rc;
}
 
static BOOL fastpath_read_input_event_header(wStream* s, BYTE* eventFlags, BYTE* eventCode)
{
  BYTE eventHeader = 0;
 
  WINPR_ASSERT(s);
  WINPR_ASSERT(eventFlags);
  WINPR_ASSERT(eventCode);
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, 1))
    return FALSE;
 
  Stream_Read_UINT8(s, eventHeader); /* eventHeader (1 byte) */
  *eventFlags = (eventHeader & 0x1F);
  *eventCode = (eventHeader >> 5);
  return TRUE;
}
 
static BOOL fastpath_recv_input_event_scancode(rdpFastPath* fastpath, wStream* s, BYTE eventFlags)
{
  WINPR_ASSERT(fastpath);
  WINPR_ASSERT(fastpath->rdp);
  WINPR_ASSERT(fastpath->rdp->input);
  WINPR_ASSERT(s);
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, 1))
    return FALSE;
 
  rdpInput* input = fastpath->rdp->input;
 
  const UINT8 code = Stream_Get_UINT8(s); /* keyCode (1 byte) */
 
  UINT16 flags = 0;
  if ((eventFlags & FASTPATH_INPUT_KBDFLAGS_RELEASE))
    flags |= KBD_FLAGS_RELEASE;
 
  if ((eventFlags & FASTPATH_INPUT_KBDFLAGS_EXTENDED))
    flags |= KBD_FLAGS_EXTENDED;
 
  if ((eventFlags & FASTPATH_INPUT_KBDFLAGS_PREFIX_E1))
    flags |= KBD_FLAGS_EXTENDED1;
 
  return IFCALLRESULT(TRUE, input->KeyboardEvent, input, flags, code);
}
 
static BOOL fastpath_recv_input_event_mouse(rdpFastPath* fastpath, wStream* s,
                                            WINPR_ATTR_UNUSED BYTE eventFlags)
{
  rdpInput* input = nullptr;
  UINT16 pointerFlags = 0;
  UINT16 xPos = 0;
  UINT16 yPos = 0;
  WINPR_ASSERT(fastpath);
  WINPR_ASSERT(fastpath->rdp);
  WINPR_ASSERT(fastpath->rdp->input);
  WINPR_ASSERT(s);
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, 6))
    return FALSE;
 
  input = fastpath->rdp->input;
 
  Stream_Read_UINT16(s, pointerFlags); /* pointerFlags (2 bytes) */
  Stream_Read_UINT16(s, xPos);         /* xPos (2 bytes) */
  Stream_Read_UINT16(s, yPos);         /* yPos (2 bytes) */
  return IFCALLRESULT(TRUE, input->MouseEvent, input, pointerFlags, xPos, yPos);
}
 
static BOOL fastpath_recv_input_event_relmouse(rdpFastPath* fastpath, wStream* s,
                                               WINPR_ATTR_UNUSED BYTE eventFlags)
{
  rdpInput* input = nullptr;
  UINT16 pointerFlags = 0;
  INT16 xDelta = 0;
  INT16 yDelta = 0;
  WINPR_ASSERT(fastpath);
  WINPR_ASSERT(fastpath->rdp);
  WINPR_ASSERT(fastpath->rdp->context);
  WINPR_ASSERT(fastpath->rdp->input);
  WINPR_ASSERT(s);
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, 6))
    return FALSE;
 
  input = fastpath->rdp->input;
 
  Stream_Read_UINT16(s, pointerFlags); /* pointerFlags (2 bytes) */
  Stream_Read_INT16(s, xDelta);        /* xDelta (2 bytes) */
  Stream_Read_INT16(s, yDelta);        /* yDelta (2 bytes) */
 
  if (!freerdp_settings_get_bool(input->context->settings, FreeRDP_HasRelativeMouseEvent))
  {
    WLog_ERR(TAG,
             "Received relative mouse event(flags=0x%04" PRIx16 ", xPos=%" PRId16
             ", yPos=%" PRId16 "), but we did not announce support for that",
             pointerFlags, xDelta, yDelta);
    return FALSE;
  }
 
  return IFCALLRESULT(TRUE, input->RelMouseEvent, input, pointerFlags, xDelta, yDelta);
}
 
static BOOL fastpath_recv_input_event_qoe(rdpFastPath* fastpath, wStream* s,
                                          WINPR_ATTR_UNUSED BYTE eventFlags)
{
  WINPR_ASSERT(fastpath);
  WINPR_ASSERT(fastpath->rdp);
  WINPR_ASSERT(fastpath->rdp->context);
  WINPR_ASSERT(fastpath->rdp->input);
  WINPR_ASSERT(s);
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, 4))
    return FALSE;
 
  rdpInput* input = fastpath->rdp->input;
 
  UINT32 timestampMS = 0;
  Stream_Read_UINT32(s, timestampMS); /* timestamp (4 bytes) */
 
  if (!freerdp_settings_get_bool(input->context->settings, FreeRDP_HasQoeEvent))
  {
    WLog_ERR(TAG,
             "Received qoe event(timestamp=%" PRIu32
             "ms), but we did not announce support for that",
             timestampMS);
    return FALSE;
  }
 
  return IFCALLRESULT(TRUE, input->QoEEvent, input, timestampMS);
}
 
static BOOL fastpath_recv_input_event_mousex(rdpFastPath* fastpath, wStream* s,
                                             WINPR_ATTR_UNUSED BYTE eventFlags)
{
  rdpInput* input = nullptr;
  UINT16 pointerFlags = 0;
  UINT16 xPos = 0;
  UINT16 yPos = 0;
 
  WINPR_ASSERT(fastpath);
  WINPR_ASSERT(fastpath->rdp);
  WINPR_ASSERT(fastpath->rdp->context);
  WINPR_ASSERT(fastpath->rdp->input);
  WINPR_ASSERT(s);
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, 6))
    return FALSE;
 
  input = fastpath->rdp->input;
 
  Stream_Read_UINT16(s, pointerFlags); /* pointerFlags (2 bytes) */
  Stream_Read_UINT16(s, xPos);         /* xPos (2 bytes) */
  Stream_Read_UINT16(s, yPos);         /* yPos (2 bytes) */
 
  if (!freerdp_settings_get_bool(input->context->settings, FreeRDP_HasExtendedMouseEvent))
  {
    WLog_ERR(TAG,
             "Received extended mouse event(flags=0x%04" PRIx16 ", xPos=%" PRIu16
             ", yPos=%" PRIu16 "), but we did not announce support for that",
             pointerFlags, xPos, yPos);
    return FALSE;
  }
 
  return IFCALLRESULT(TRUE, input->ExtendedMouseEvent, input, pointerFlags, xPos, yPos);
}
 
static BOOL fastpath_recv_input_event_sync(rdpFastPath* fastpath, WINPR_ATTR_UNUSED wStream* s,
                                           BYTE eventFlags)
{
  rdpInput* input = nullptr;
 
  WINPR_ASSERT(fastpath);
  WINPR_ASSERT(fastpath->rdp);
  WINPR_ASSERT(fastpath->rdp->input);
  WINPR_ASSERT(s);
 
  input = fastpath->rdp->input;
  return IFCALLRESULT(TRUE, input->SynchronizeEvent, input, eventFlags);
}
 
static BOOL fastpath_recv_input_event_unicode(rdpFastPath* fastpath, wStream* s, BYTE eventFlags)
{
  UINT16 unicodeCode = 0;
  UINT16 flags = 0;
 
  WINPR_ASSERT(fastpath);
  WINPR_ASSERT(s);
 
  if (!Stream_CheckAndLogRequiredLength(TAG, s, 2))
    return FALSE;
 
  Stream_Read_UINT16(s, unicodeCode); /* unicodeCode (2 bytes) */
  flags = 0;
 
  if ((eventFlags & FASTPATH_INPUT_KBDFLAGS_RELEASE))
    flags |= KBD_FLAGS_RELEASE;
 
  WINPR_ASSERT(fastpath->rdp);
  WINPR_ASSERT(fastpath->rdp);
  WINPR_ASSERT(fastpath->rdp->input);
  return IFCALLRESULT(FALSE, fastpath->rdp->input->UnicodeKeyboardEvent, fastpath->rdp->input,
                      flags, unicodeCode);
}
 
static BOOL fastpath_recv_input_event(rdpFastPath* fastpath, wStream* s)
{
  BYTE eventFlags = 0;
  BYTE eventCode = 0;
 
  WINPR_ASSERT(fastpath);
  WINPR_ASSERT(s);
 
  if (!fastpath_read_input_event_header(s, &eventFlags, &eventCode))
    return FALSE;
 
  switch (eventCode)
  {
    case FASTPATH_INPUT_EVENT_SCANCODE:
      if (!fastpath_recv_input_event_scancode(fastpath, s, eventFlags))
        return FALSE;
 
      break;
 
    case FASTPATH_INPUT_EVENT_MOUSE:
      if (!fastpath_recv_input_event_mouse(fastpath, s, eventFlags))
        return FALSE;
 
      break;
 
    case FASTPATH_INPUT_EVENT_MOUSEX:
      if (!fastpath_recv_input_event_mousex(fastpath, s, eventFlags))
        return FALSE;
 
      break;
 
    case FASTPATH_INPUT_EVENT_SYNC:
      if (!fastpath_recv_input_event_sync(fastpath, s, eventFlags))
        return FALSE;
 
      break;
 
    case FASTPATH_INPUT_EVENT_UNICODE:
      if (!fastpath_recv_input_event_unicode(fastpath, s, eventFlags))
        return FALSE;
 
      break;
 
    case TS_FP_RELPOINTER_EVENT:
      if (!fastpath_recv_input_event_relmouse(fastpath, s, eventFlags))
        return FALSE;
 
      break;
 
    case TS_FP_QOETIMESTAMP_EVENT:
      if (!fastpath_recv_input_event_qoe(fastpath, s, eventFlags))
        return FALSE;
      break;
 
    default:
      WLog_ERR(TAG, "Unknown eventCode %" PRIu8 "", eventCode);
      break;
  }
 
  return TRUE;
}
 
state_run_t fastpath_recv_inputs(rdpFastPath* fastpath, wStream* s)
{
  WINPR_ASSERT(fastpath);
  WINPR_ASSERT(s);
 
  if (fastpath->numberEvents == 0)
  {
    if (!Stream_CheckAndLogRequiredLength(TAG, s, 1))
      return STATE_RUN_FAILED;
 
    Stream_Read_UINT8(s, fastpath->numberEvents); /* eventHeader (1 byte) */
  }
 
  for (BYTE i = 0; i < fastpath->numberEvents; i++)
  {
    if (!fastpath_recv_input_event(fastpath, s))
      return STATE_RUN_FAILED;
  }
 
  return STATE_RUN_SUCCESS;
}
 
static UINT32 fastpath_get_sec_bytes(rdpRdp* rdp)
{
  UINT32 sec_bytes = 0;
 
  if (!rdp)
    return 0;
 
  if (rdp->do_crypt)
  {
    sec_bytes = 8;
 
    if (freerdp_settings_get_uint32(rdp->settings, FreeRDP_EncryptionMethods) ==
        ENCRYPTION_METHOD_FIPS)
      sec_bytes += 4;
  }
 
  return sec_bytes;
}
 
wStream* fastpath_input_pdu_init_header(rdpFastPath* fastpath, UINT16* sec_flags)
{
  if (!fastpath || !fastpath->rdp)
    return nullptr;
 
  rdpRdp* rdp = fastpath->rdp;
  wStream* s = transport_send_stream_init(rdp->transport, 256);
 
  if (!s)
    return nullptr;
 
  Stream_Seek(s, 3); /* fpInputHeader, length1 and length2 */
 
  if (rdp->do_crypt)
  {
    *sec_flags |= SEC_ENCRYPT;
 
    if (rdp->do_secure_checksum)
      *sec_flags |= SEC_SECURE_CHECKSUM;
  }
 
  Stream_Seek(s, fastpath_get_sec_bytes(rdp));
  return s;
}
 
wStream* fastpath_input_pdu_init(rdpFastPath* fastpath, BYTE eventFlags, BYTE eventCode,
                                 UINT16* sec_flags)
{
  wStream* s = nullptr;
  s = fastpath_input_pdu_init_header(fastpath, sec_flags);
 
  if (!s)
    return nullptr;
 
  WINPR_ASSERT(eventCode < 8);
  WINPR_ASSERT(eventFlags < 0x20);
  Stream_Write_UINT8(s, (UINT8)(eventFlags | (eventCode << 5))); /* eventHeader (1 byte) */
  return s;
}
 
BOOL fastpath_send_multiple_input_pdu(rdpFastPath* fastpath, wStream* s, size_t iNumEvents,
                                      UINT16 sec_flags)
{
  BOOL rc = FALSE;
  BYTE eventHeader = 0;
  BOOL should_unlock = FALSE;
  rdpRdp* rdp = nullptr;
 
  WINPR_ASSERT(iNumEvents > 0);
  if (!s)
    return FALSE;
 
  if (!fastpath)
    goto fail;
 
  rdp = fastpath->rdp;
  WINPR_ASSERT(rdp);
 
  {
    const CONNECTION_STATE state = rdp_get_state(rdp);
    if (!rdp_is_active_state(rdp))
    {
      WLog_WARN(TAG, "called before activation [%s]", rdp_state_string(state));
      goto fail;
    }
  }
 
  /*
   *  A maximum of 15 events are allowed per request
   *  if the optional numEvents field isn't used
   *  see MS-RDPBCGR 2.2.8.1.2 for details
   */
  if (iNumEvents > 15)
    goto fail;
 
  {
    size_t length = Stream_GetPosition(s);
 
    if (length >= (2u << 14))
    {
      WLog_ERR(TAG, "Maximum FastPath PDU length is 32767");
      goto fail;
    }
 
    eventHeader = FASTPATH_INPUT_ACTION_FASTPATH;
    eventHeader |= (iNumEvents << 2); /* numberEvents */
 
    if (sec_flags & SEC_ENCRYPT)
      eventHeader |= (FASTPATH_INPUT_ENCRYPTED << 6);
 
    if (sec_flags & SEC_SECURE_CHECKSUM)
      eventHeader |= (FASTPATH_INPUT_SECURE_CHECKSUM << 6);
 
    Stream_ResetPosition(s);
    Stream_Write_UINT8(s, eventHeader);
    /* Write length later, RDP encryption might add a padding */
    Stream_Seek(s, 2);
 
    if (sec_flags & SEC_ENCRYPT)
    {
      security_lock(rdp);
      should_unlock = TRUE;
 
      const size_t sec_bytes = fastpath_get_sec_bytes(fastpath->rdp);
      if (sec_bytes + 3ULL > length)
        goto fail;
 
      BYTE* fpInputEvents = Stream_PointerAs(s, BYTE) + sec_bytes;
      const UINT16 fpInputEvents_length = (UINT16)(length - 3 - sec_bytes);
 
      WINPR_ASSERT(rdp->settings);
      if (freerdp_settings_get_uint32(rdp->settings, FreeRDP_EncryptionMethods) ==
          ENCRYPTION_METHOD_FIPS)
      {
        BYTE pad = 0;
 
        if ((pad = 8 - (fpInputEvents_length % 8)) == 8)
          pad = 0;
 
        Stream_Write_UINT16(s, 0x10); /* length */
        Stream_Write_UINT8(s, 0x1);   /* TSFIPS_VERSION 1*/
        Stream_Write_UINT8(s, pad);   /* padding */
 
        if (!Stream_CheckAndLogRequiredCapacity(TAG, s, 8))
          goto fail;
 
        if (!security_hmac_signature(fpInputEvents, fpInputEvents_length, Stream_Pointer(s),
                                     8, rdp))
          goto fail;
 
        if (pad)
          memset(fpInputEvents + fpInputEvents_length, 0, pad);
 
        if (!security_fips_encrypt(fpInputEvents, fpInputEvents_length + pad, rdp))
          goto fail;
 
        length += pad;
      }
      else
      {
        BOOL res = 0;
        if (!Stream_CheckAndLogRequiredCapacity(TAG, s, 8))
          goto fail;
        if (sec_flags & SEC_SECURE_CHECKSUM)
          res = security_salted_mac_signature(rdp, fpInputEvents, fpInputEvents_length,
                                              TRUE, Stream_Pointer(s), 8);
        else
          res = security_mac_signature(rdp, fpInputEvents, fpInputEvents_length,
                                       Stream_Pointer(s), 8);
 
        if (!res || !security_encrypt(fpInputEvents, fpInputEvents_length, rdp))
          goto fail;
      }
    }
 
    /*
     * We always encode length in two bytes, even though we could use
     * only one byte if length <= 0x7F. It is just easier that way,
     * because we can leave room for fixed-length header, store all
     * the data first and then store the header.
     */
    WINPR_ASSERT(length < UINT16_MAX);
    if (!Stream_SetPosition(s, 1))
      goto fail;
    Stream_Write_UINT16_BE(s, 0x8000 | (UINT16)length);
    if (!Stream_SetPosition(s, length))
      goto fail;
    Stream_SealLength(s);
  }
 
  if (transport_write(rdp->transport, s) < 0)
    goto fail;
 
  rc = TRUE;
fail:
  if (should_unlock)
    security_unlock(rdp);
  Stream_Release(s);
  return rc;
}
 
BOOL fastpath_send_input_pdu(rdpFastPath* fastpath, wStream* s, UINT16 sec_flags)
{
  return fastpath_send_multiple_input_pdu(fastpath, s, 1, sec_flags);
}
 
wStream* fastpath_update_pdu_init(rdpFastPath* fastpath)
{
  return transport_send_stream_init(fastpath->rdp->transport, FASTPATH_MAX_PACKET_SIZE);
}
 
wStream* fastpath_update_pdu_init_new(WINPR_ATTR_UNUSED rdpFastPath* fastpath)
{
  wStream* s = nullptr;
  s = Stream_New(nullptr, FASTPATH_MAX_PACKET_SIZE);
  return s;
}
 
BOOL fastpath_send_update_pdu(rdpFastPath* fastpath, BYTE updateCode, wStream* s,
                              BOOL skipCompression)
{
  BOOL status = TRUE;
  wStream* fs = nullptr;
  rdpSettings* settings = nullptr;
  rdpRdp* rdp = nullptr;
  UINT32 fpHeaderSize = 6;
  UINT32 fpUpdatePduHeaderSize = 0;
  UINT32 fpUpdateHeaderSize = 0;
  FASTPATH_UPDATE_PDU_HEADER fpUpdatePduHeader = WINPR_C_ARRAY_INIT;
  FASTPATH_UPDATE_HEADER fpUpdateHeader = WINPR_C_ARRAY_INIT;
  UINT16 sec_flags = 0;
 
  if (!fastpath || !fastpath->rdp || !fastpath->fs || !s)
    return FALSE;
 
  rdp = fastpath->rdp;
  fs = fastpath->fs;
  settings = rdp->settings;
 
  if (!settings)
    return FALSE;
 
  UINT16 maxLength = FASTPATH_MAX_PACKET_SIZE - 20;
 
  if (freerdp_settings_get_bool(rdp->settings, FreeRDP_CompressionEnabled) && !skipCompression)
  {
    const UINT16 CompressionMaxSize = bulk_compression_max_size(rdp->bulk);
    maxLength = (maxLength < CompressionMaxSize) ? maxLength : CompressionMaxSize;
    maxLength -= 20;
  }
 
  size_t totalLength = Stream_GetPosition(s);
  Stream_ResetPosition(s);
 
  /* check if fast path output is possible */
  if (!freerdp_settings_get_bool(rdp->settings, FreeRDP_FastPathOutput))
  {
    WLog_ERR(TAG, "client does not support fast path output");
    return FALSE;
  }
 
  /* check if the client's fast path pdu buffer is large enough */
  if (totalLength > freerdp_settings_get_uint32(settings, FreeRDP_MultifragMaxRequestSize))
  {
    WLog_ERR(TAG,
             "fast path update size (%" PRIuz
             ") exceeds the client's maximum request size (%" PRIu32 ")",
             totalLength,
             freerdp_settings_get_uint32(settings, FreeRDP_MultifragMaxRequestSize));
    return FALSE;
  }
 
  if (rdp->do_crypt)
  {
    sec_flags |= SEC_ENCRYPT;
 
    if (rdp->do_secure_checksum)
      sec_flags |= SEC_SECURE_CHECKSUM;
  }
 
  for (int fragment = 0; (totalLength > 0) || (fragment == 0); fragment++)
  {
    UINT32 DstSize = 0;
    const BYTE* pDstData = nullptr;
    UINT32 compressionFlags = 0;
    BYTE pad = 0;
    BYTE* pSignature = nullptr;
    fpUpdatePduHeader.action = 0;
    fpUpdatePduHeader.secFlags = 0;
    fpUpdateHeader.compression = 0;
    fpUpdateHeader.compressionFlags = 0;
    fpUpdateHeader.updateCode = updateCode;
    fpUpdateHeader.size = (UINT16)(totalLength > maxLength) ? maxLength : (UINT16)totalLength;
    const BYTE* pSrcData = Stream_Pointer(s);
    UINT32 SrcSize = DstSize = fpUpdateHeader.size;
    BOOL should_unlock = FALSE;
 
    if (sec_flags & SEC_ENCRYPT)
      fpUpdatePduHeader.secFlags |= FASTPATH_OUTPUT_ENCRYPTED;
 
    if (sec_flags & SEC_SECURE_CHECKSUM)
      fpUpdatePduHeader.secFlags |= FASTPATH_OUTPUT_SECURE_CHECKSUM;
 
    if (freerdp_settings_get_bool(settings, FreeRDP_CompressionEnabled) && !skipCompression)
    {
      if (bulk_compress(rdp->bulk, pSrcData, SrcSize, &pDstData, &DstSize,
                        &compressionFlags) >= 0)
      {
        if (compressionFlags)
        {
          WINPR_ASSERT(compressionFlags <= UINT8_MAX);
          fpUpdateHeader.compressionFlags = (UINT8)compressionFlags;
          fpUpdateHeader.compression = FASTPATH_OUTPUT_COMPRESSION_USED;
        }
      }
    }
 
    if (!fpUpdateHeader.compression)
    {
      pDstData = Stream_Pointer(s);
      DstSize = fpUpdateHeader.size;
    }
 
    if (DstSize > UINT16_MAX)
      return FALSE;
    fpUpdateHeader.size = (UINT16)DstSize;
    totalLength -= SrcSize;
 
    if (totalLength == 0)
      fpUpdateHeader.fragmentation =
          (fragment == 0) ? FASTPATH_FRAGMENT_SINGLE : FASTPATH_FRAGMENT_LAST;
    else
      fpUpdateHeader.fragmentation =
          (fragment == 0) ? FASTPATH_FRAGMENT_FIRST : FASTPATH_FRAGMENT_NEXT;
 
    fpUpdateHeaderSize = fastpath_get_update_header_size(&fpUpdateHeader);
    fpUpdatePduHeaderSize = fastpath_get_update_pdu_header_size(&fpUpdatePduHeader, rdp);
    fpHeaderSize = fpUpdateHeaderSize + fpUpdatePduHeaderSize;
 
    if (sec_flags & SEC_ENCRYPT)
    {
      pSignature = Stream_Buffer(fs) + 3;
 
      if (freerdp_settings_get_uint32(rdp->settings, FreeRDP_EncryptionMethods) ==
          ENCRYPTION_METHOD_FIPS)
      {
        pSignature += 4;
 
        if ((pad = 8 - ((DstSize + fpUpdateHeaderSize) % 8)) == 8)
          pad = 0;
 
        fpUpdatePduHeader.fipsInformation[0] = 0x10;
        fpUpdatePduHeader.fipsInformation[1] = 0x00;
        fpUpdatePduHeader.fipsInformation[2] = 0x01;
        fpUpdatePduHeader.fipsInformation[3] = pad;
      }
    }
 
    const size_t len = fpUpdateHeader.size + fpHeaderSize + pad;
    if (len > UINT16_MAX)
      return FALSE;
 
    fpUpdatePduHeader.length = (UINT16)len;
    Stream_ResetPosition(fs);
    if (!fastpath_write_update_pdu_header(fs, &fpUpdatePduHeader, rdp))
      return FALSE;
    if (!fastpath_write_update_header(fs, &fpUpdateHeader))
      return FALSE;
 
    if (!Stream_CheckAndLogRequiredCapacity(TAG, (fs), (size_t)DstSize + pad))
      return FALSE;
    Stream_Write(fs, pDstData, DstSize);
 
    if (pad)
      Stream_Zero(fs, pad);
 
    BOOL res = FALSE;
    if (sec_flags & SEC_ENCRYPT)
    {
      security_lock(rdp);
 
      should_unlock = TRUE;
      UINT32 dataSize = fpUpdateHeaderSize + DstSize + pad;
      BYTE* data = Stream_PointerAs(fs, BYTE) - dataSize;
 
      if (freerdp_settings_get_uint32(rdp->settings, FreeRDP_EncryptionMethods) ==
          ENCRYPTION_METHOD_FIPS)
      {
        // TODO: Ensure stream capacity
        if (!security_hmac_signature(data, dataSize - pad, pSignature, 8, rdp))
          goto unlock;
 
        if (!security_fips_encrypt(data, dataSize, rdp))
          goto unlock;
      }
      else
      {
        // TODO: Ensure stream capacity
        if (sec_flags & SEC_SECURE_CHECKSUM)
          status =
              security_salted_mac_signature(rdp, data, dataSize, TRUE, pSignature, 8);
        else
          status = security_mac_signature(rdp, data, dataSize, pSignature, 8);
 
        if (!status || !security_encrypt(data, dataSize, rdp))
          goto unlock;
      }
    }
    res = TRUE;
 
    Stream_SealLength(fs);
 
    if (transport_write(rdp->transport, fs) < 0)
    {
      status = FALSE;
    }
 
  unlock:
    if (should_unlock)
      security_unlock(rdp);
 
    if (!res || !status)
      return FALSE;
 
    Stream_Seek(s, SrcSize);
  }
 
  return status;
}
 
rdpFastPath* fastpath_new(rdpRdp* rdp)
{
  rdpFastPath* fastpath = nullptr;
 
  WINPR_ASSERT(rdp);
 
  fastpath = (rdpFastPath*)calloc(1, sizeof(rdpFastPath));
 
  if (!fastpath)
    return nullptr;
 
  fastpath->rdp = rdp;
  fastpath->fragmentation = -1;
  fastpath->fs = Stream_New(nullptr, FASTPATH_MAX_PACKET_SIZE);
  fastpath->updateData = Stream_New(nullptr, FASTPATH_MAX_PACKET_SIZE);
 
  if (!fastpath->fs || !fastpath->updateData)
    goto out_free;
 
  return fastpath;
out_free:
  fastpath_free(fastpath);
  return nullptr;
}
 
void fastpath_free(rdpFastPath* fastpath)
{
  if (fastpath)
  {
    Stream_Free(fastpath->updateData, TRUE);
    Stream_Free(fastpath->fs, TRUE);
    free(fastpath);
  }
}
 
BYTE fastpath_get_encryption_flags(rdpFastPath* fastpath)
{
  WINPR_ASSERT(fastpath);
  return fastpath->encryptionFlags;
}
 
BOOL fastpath_decrypt(rdpFastPath* fastpath, wStream* s, UINT16* length)
{
  WINPR_ASSERT(fastpath);
  if (fastpath_get_encryption_flags(fastpath) & FASTPATH_OUTPUT_ENCRYPTED)
  {
    const UINT16 flags =
        (fastpath_get_encryption_flags(fastpath) & FASTPATH_OUTPUT_SECURE_CHECKSUM)
            ? SEC_SECURE_CHECKSUM
            : 0;
 
    if (!rdp_decrypt(fastpath->rdp, s, length, flags))
      return FALSE;
  }
 
  return TRUE;
}