Blame libfreerdp/core/tpdu.c

Packit Service fa4841
/**
Packit Service fa4841
 * FreeRDP: A Remote Desktop Protocol Implementation
Packit Service fa4841
 * X.224 Transport Protocol Data Units (TPDUs)
Packit Service fa4841
 *
Packit Service fa4841
 * Copyright 2011 Marc-Andre Moreau <marcandre.moreau@gmail.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 <winpr/print.h>
Packit Service fa4841
Packit Service fa4841
#include <freerdp/log.h>
Packit Service fa4841
Packit Service fa4841
#include "tpdu.h"
Packit Service fa4841
Packit Service fa4841
#define TAG FREERDP_TAG("core")
Packit Service fa4841
Packit Service fa4841
/**
Packit Service fa4841
 * TPDUs are defined in:
Packit Service fa4841
 *
Packit Service fa4841
 * http://www.itu.int/rec/T-REC-X.224-199511-I/
Packit Service fa4841
 * X.224: Information technology - Open Systems Interconnection - Protocol for providing the
Packit Service fa4841
 * connection-mode transport service
Packit Service fa4841
 *
Packit Service fa4841
 * RDP uses only TPDUs of class 0, the "simple class" defined in section 8 of X.224
Packit Service fa4841
 *
Packit Service fa4841
 *       TPDU Header
Packit Service fa4841
 *  ____________________   byte
Packit Service fa4841
 * |                    |
Packit Service fa4841
 * |         LI         |   1
Packit Service fa4841
 * |____________________|
Packit Service fa4841
 * |                    |
Packit Service fa4841
 * |        Code        |   2
Packit Service fa4841
 * |____________________|
Packit Service fa4841
 * |                    |
Packit Service fa4841
 * |                    |   3
Packit Service fa4841
 * |_______DST-REF______|
Packit Service fa4841
 * |                    |
Packit Service fa4841
 * |                    |   4
Packit Service fa4841
 * |____________________|
Packit Service fa4841
 * |                    |
Packit Service fa4841
 * |                    |   5
Packit Service fa4841
 * |_______SRC-REF______|
Packit Service fa4841
 * |                    |
Packit Service fa4841
 * |                    |   6
Packit Service fa4841
 * |____________________|
Packit Service fa4841
 * |                    |
Packit Service fa4841
 * |        Class       |   7
Packit Service fa4841
 * |____________________|
Packit Service fa4841
 * |         ...        |
Packit Service fa4841
 */
Packit Service fa4841
Packit Service fa4841
static void tpdu_write_header(wStream* s, UINT16 length, BYTE code);
Packit Service fa4841
Packit Service fa4841
/**
Packit Service fa4841
 * Read TPDU header.
Packit Service fa4841
 * @param s stream
Packit Service fa4841
 * @param code variable pointer to receive TPDU code
Packit Service fa4841
 * @return TPDU length indicator (LI)
Packit Service fa4841
 */
Packit Service fa4841
Packit Service fa4841
BOOL tpdu_read_header(wStream* s, BYTE* code, BYTE* li, UINT16 tpktlength)
Packit Service fa4841
{
Packit Service fa4841
	if (Stream_GetRemainingLength(s) < 3)
Packit Service fa4841
		return FALSE;
Packit Service fa4841
Packit Service fa4841
	Stream_Read_UINT8(s, *li);   /* LI */
Packit Service fa4841
	Stream_Read_UINT8(s, *code); /* Code */
Packit Service fa4841
Packit Service fa4841
	if (*li + 4 > tpktlength)
Packit Service fa4841
	{
Packit Service fa4841
		WLog_ERR(TAG, "tpdu length %" PRIu8 " > tpkt header length %" PRIu16, *li, tpktlength);
Packit Service fa4841
		return FALSE;
Packit Service fa4841
	}
Packit Service fa4841
Packit Service fa4841
	if (*code == X224_TPDU_DATA)
Packit Service fa4841
	{
Packit Service fa4841
		/* EOT (1 byte) */
Packit Service fa4841
		Stream_Seek(s, 1);
Packit Service fa4841
	}
Packit Service fa4841
	else
Packit Service fa4841
	{
Packit Service fa4841
		/* DST-REF (2 bytes) */
Packit Service fa4841
		/* SRC-REF (2 bytes) */
Packit Service fa4841
		/* Class 0 (1 byte) */
Packit Service fa4841
		return Stream_SafeSeek(s, 5);
Packit Service fa4841
	}
Packit Service fa4841
Packit Service fa4841
	return TRUE;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
/**
Packit Service fa4841
 * Write TDPU header.
Packit Service fa4841
 * @param s stream
Packit Service fa4841
 * @param length length
Packit Service fa4841
 * @param code TPDU code
Packit Service fa4841
 */
Packit Service fa4841
Packit Service fa4841
void tpdu_write_header(wStream* s, UINT16 length, BYTE code)
Packit Service fa4841
{
Packit Service fa4841
	Stream_Write_UINT8(s, length); /* LI */
Packit Service fa4841
	Stream_Write_UINT8(s, code);   /* code */
Packit Service fa4841
Packit Service fa4841
	if (code == X224_TPDU_DATA)
Packit Service fa4841
	{
Packit Service fa4841
		Stream_Write_UINT8(s, 0x80); /* EOT */
Packit Service fa4841
	}
Packit Service fa4841
	else
Packit Service fa4841
	{
Packit Service fa4841
		Stream_Write_UINT16(s, 0); /* DST-REF */
Packit Service fa4841
		Stream_Write_UINT16(s, 0); /* SRC-REF */
Packit Service fa4841
		Stream_Write_UINT8(s, 0);  /* Class 0 */
Packit Service fa4841
	}
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
/**
Packit Service fa4841
 * Read Connection Request TPDU
Packit Service fa4841
 * @param s stream
Packit Service fa4841
 * @return length indicator (LI)
Packit Service fa4841
 */
Packit Service fa4841
Packit Service fa4841
BOOL tpdu_read_connection_request(wStream* s, BYTE* li, UINT16 tpktlength)
Packit Service fa4841
{
Packit Service fa4841
	BYTE code;
Packit Service fa4841
Packit Service fa4841
	if (!tpdu_read_header(s, &code, li, tpktlength))
Packit Service fa4841
		return FALSE;
Packit Service fa4841
Packit Service fa4841
	if (code != X224_TPDU_CONNECTION_REQUEST)
Packit Service fa4841
	{
Packit Service fa4841
		WLog_ERR(TAG, "Error: expected X224_TPDU_CONNECTION_REQUEST");
Packit Service fa4841
		return FALSE;
Packit Service fa4841
	}
Packit Service fa4841
Packit Service fa4841
	return TRUE;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
/**
Packit Service fa4841
 * Write Connection Request TPDU.
Packit Service fa4841
 * @param s stream
Packit Service fa4841
 * @param length TPDU length
Packit Service fa4841
 */
Packit Service fa4841
Packit Service fa4841
void tpdu_write_connection_request(wStream* s, UINT16 length)
Packit Service fa4841
{
Packit Service fa4841
	tpdu_write_header(s, length, X224_TPDU_CONNECTION_REQUEST);
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
/**
Packit Service fa4841
 * Read Connection Confirm TPDU.
Packit Service fa4841
 * @param s stream
Packit Service fa4841
 * @return length indicator (LI)
Packit Service fa4841
 */
Packit Service fa4841
Packit Service fa4841
BOOL tpdu_read_connection_confirm(wStream* s, BYTE* li, UINT16 tpktlength)
Packit Service fa4841
{
Packit Service fa4841
	BYTE code;
Packit Service fa4841
	size_t position;
Packit Service fa4841
	size_t bytes_read = 0;
Packit Service fa4841
Packit Service fa4841
	/* save the position to determine the number of bytes read */
Packit Service fa4841
	position = Stream_GetPosition(s);
Packit Service fa4841
Packit Service fa4841
	if (!tpdu_read_header(s, &code, li, tpktlength))
Packit Service fa4841
		return FALSE;
Packit Service fa4841
Packit Service fa4841
	if (code != X224_TPDU_CONNECTION_CONFIRM)
Packit Service fa4841
	{
Packit Service fa4841
		WLog_ERR(TAG, "Error: expected X224_TPDU_CONNECTION_CONFIRM");
Packit Service fa4841
		return FALSE;
Packit Service fa4841
	}
Packit Service fa4841
	/*
Packit Service fa4841
	 * To ensure that there are enough bytes remaining for processing
Packit Service fa4841
	 * check against the length indicator (li). Already read bytes need
Packit Service fa4841
	 * to be taken into account.
Packit Service fa4841
	 * The -1 is because li was read but isn't included in the TPDU size.
Packit Service fa4841
	 * For reference see ITU-T Rec. X.224 - 13.2.1
Packit Service fa4841
	 */
Packit Service fa4841
	bytes_read = (Stream_GetPosition(s) - position) - 1;
Packit Service fa4841
Packit Service fa4841
	return (Stream_GetRemainingLength(s) >= (size_t)(*li - bytes_read));
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
/**
Packit Service fa4841
 * Write Connection Confirm TPDU.
Packit Service fa4841
 * @param s stream
Packit Service fa4841
 * @param length TPDU length
Packit Service fa4841
 */
Packit Service fa4841
Packit Service fa4841
void tpdu_write_connection_confirm(wStream* s, UINT16 length)
Packit Service fa4841
{
Packit Service fa4841
	tpdu_write_header(s, length, X224_TPDU_CONNECTION_CONFIRM);
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
/**
Packit Service fa4841
 * Write Disconnect Request TPDU.
Packit Service fa4841
 * @param s stream
Packit Service fa4841
 * @param length TPDU length
Packit Service fa4841
 */
Packit Service fa4841
Packit Service fa4841
void tpdu_write_disconnect_request(wStream* s, UINT16 length)
Packit Service fa4841
{
Packit Service fa4841
	tpdu_write_header(s, length, X224_TPDU_DISCONNECT_REQUEST);
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
/**
Packit Service fa4841
 * Write Data TPDU.
Packit Service fa4841
 * @param s stream
Packit Service fa4841
 */
Packit Service fa4841
Packit Service fa4841
void tpdu_write_data(wStream* s)
Packit Service fa4841
{
Packit Service fa4841
	tpdu_write_header(s, 2, X224_TPDU_DATA);
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
/**
Packit Service fa4841
 * Read Data TPDU.
Packit Service fa4841
 * @param s stream
Packit Service fa4841
 */
Packit Service fa4841
Packit Service fa4841
BOOL tpdu_read_data(wStream* s, UINT16* LI, UINT16 tpktlength)
Packit Service fa4841
{
Packit Service fa4841
	BYTE code;
Packit Service fa4841
	BYTE li;
Packit Service fa4841
Packit Service fa4841
	if (!tpdu_read_header(s, &code, &li, tpktlength))
Packit Service fa4841
		return FALSE;
Packit Service fa4841
Packit Service fa4841
	if (code != X224_TPDU_DATA)
Packit Service fa4841
		return FALSE;
Packit Service fa4841
Packit Service fa4841
	*LI = li;
Packit Service fa4841
Packit Service fa4841
	return TRUE;
Packit Service fa4841
}