xrdp/common/parse.h

461 lines
13 KiB
C
Raw Normal View History

/**
* xrdp: A Remote Desktop Protocol server.
*
2013-06-08 21:51:53 +04:00
* Copyright (C) Jay Sorg 2004-2013
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*
* Parsing structs and macros
*
* based on parse.h from rdesktop
* this is a super fast stream method, you bet
* needed functions g_malloc, g_free, g_memset, g_memcpy
*/
2005-01-07 03:56:38 +03:00
2005-06-28 07:04:36 +04:00
#if !defined(PARSE_H)
#define PARSE_H
2005-06-30 05:01:19 +04:00
#include "arch.h"
#if defined(L_ENDIAN)
#elif defined(B_ENDIAN)
2005-01-07 03:56:38 +03:00
#else
#error Unknown endianness.
#endif
/* parser state */
struct stream
{
char* p;
char* end;
char* data;
int size;
/* offsets of various headers */
char* iso_hdr;
char* mcs_hdr;
char* sec_hdr;
char* rdp_hdr;
char* channel_hdr;
char* next_packet;
};
/******************************************************************************/
2005-03-11 05:23:30 +03:00
#define s_check(s) ((s)->p <= (s)->end)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2005-03-11 05:23:30 +03:00
#define s_check_rem(s, n) ((s)->p + (n) <= (s)->end)
2005-01-07 03:56:38 +03:00
2013-09-11 03:00:30 +04:00
/******************************************************************************/
#define s_check_rem_out(s, n) ((s)->p + (n) <= (s)->data + (s)->size)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2005-03-11 05:23:30 +03:00
#define s_check_end(s) ((s)->p == (s)->end)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
#define make_stream(s) \
2010-08-10 03:02:06 +04:00
(s) = (struct stream*)g_malloc(sizeof(struct stream), 1)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define init_stream(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
if ((v) > (s)->size) \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
g_free((s)->data); \
(s)->data = (char*)g_malloc((v), 0); \
(s)->size = (v); \
2005-01-07 03:56:38 +03:00
} \
2005-03-11 05:23:30 +03:00
(s)->p = (s)->data; \
(s)->end = (s)->data; \
(s)->next_packet = 0; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define free_stream(s) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
if ((s) != 0) \
2005-02-20 09:06:26 +03:00
{ \
2005-03-11 05:23:30 +03:00
g_free((s)->data); \
2005-02-20 09:06:26 +03:00
} \
2005-03-11 05:23:30 +03:00
g_free((s)); \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define s_push_layer(s, h, n) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
(s)->h = (s)->p; \
(s)->p += (n); \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
#define s_pop_layer(s, h) \
2010-08-10 03:02:06 +04:00
(s)->p = (s)->h
2005-01-07 03:56:38 +03:00
/******************************************************************************/
#define s_mark_end(s) \
2010-08-10 03:02:06 +04:00
(s)->end = (s)->p
2005-01-07 03:56:38 +03:00
2010-08-10 03:02:06 +04:00
#define in_sint8(s, v) do \
2006-10-12 07:49:15 +04:00
{ \
(v) = *((signed char*)((s)->p)); \
(s)->p++; \
2010-08-10 03:02:06 +04:00
} while (0)
2006-10-12 07:49:15 +04:00
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define in_uint8(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
(v) = *((unsigned char*)((s)->p)); \
(s)->p++; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
#if defined(B_ENDIAN) || defined(NEED_ALIGN)
2010-08-10 03:02:06 +04:00
#define in_sint16_le(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
(v) = (signed short) \
2005-01-07 03:56:38 +03:00
( \
2005-03-11 05:23:30 +03:00
(*((unsigned char*)((s)->p + 0)) << 0) | \
(*((unsigned char*)((s)->p + 1)) << 8) \
2005-01-07 03:56:38 +03:00
); \
2005-03-11 05:23:30 +03:00
(s)->p += 2; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
#else
2010-08-10 03:02:06 +04:00
#define in_sint16_le(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
(v) = *((signed short*)((s)->p)); \
(s)->p += 2; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
#endif
/******************************************************************************/
#if defined(B_ENDIAN) || defined(NEED_ALIGN)
2010-08-10 03:02:06 +04:00
#define in_uint16_le(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
(v) = (unsigned short) \
2005-01-07 03:56:38 +03:00
( \
2005-03-11 05:23:30 +03:00
(*((unsigned char*)((s)->p + 0)) << 0) | \
(*((unsigned char*)((s)->p + 1)) << 8) \
2005-01-07 03:56:38 +03:00
); \
2005-03-11 05:23:30 +03:00
(s)->p += 2; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
#else
2010-08-10 03:02:06 +04:00
#define in_uint16_le(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
(v) = *((unsigned short*)((s)->p)); \
(s)->p += 2; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
#endif
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define in_uint16_be(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
(v) = *((unsigned char*)((s)->p)); \
(s)->p++; \
(v) <<= 8; \
(v) |= *((unsigned char*)((s)->p)); \
(s)->p++; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
#if defined(B_ENDIAN) || defined(NEED_ALIGN)
2010-08-10 03:02:06 +04:00
#define in_uint32_le(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
(v) = (unsigned int) \
2005-01-07 03:56:38 +03:00
( \
2005-03-11 05:23:30 +03:00
(*((unsigned char*)((s)->p + 0)) << 0) | \
(*((unsigned char*)((s)->p + 1)) << 8) | \
(*((unsigned char*)((s)->p + 2)) << 16) | \
(*((unsigned char*)((s)->p + 3)) << 24) \
2005-01-07 03:56:38 +03:00
); \
2005-03-11 05:23:30 +03:00
(s)->p += 4; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
#else
2010-08-10 03:02:06 +04:00
#define in_uint32_le(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
(v) = *((unsigned int*)((s)->p)); \
(s)->p += 4; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
#endif
2013-08-06 07:14:20 +04:00
/******************************************************************************/
#if defined(B_ENDIAN) || defined(NEED_ALIGN)
#define in_uint64_le(s, v) do \
{ \
(v) = (tui64) \
( \
(((tui64)(*((unsigned char*)((s)->p + 0)))) << 0) | \
(((tui64)(*((unsigned char*)((s)->p + 1)))) << 8) | \
(((tui64)(*((unsigned char*)((s)->p + 2)))) << 16) | \
(((tui64)(*((unsigned char*)((s)->p + 3)))) << 24) | \
(((tui64)(*((unsigned char*)((s)->p + 4)))) << 32) | \
(((tui64)(*((unsigned char*)((s)->p + 5)))) << 40) | \
(((tui64)(*((unsigned char*)((s)->p + 6)))) << 48) | \
(((tui64)(*((unsigned char*)((s)->p + 7)))) << 56) \
); \
(s)->p += 8; \
} while (0)
#else
#define in_uint64_le(s, v) do \
{ \
(v) = *((tui64*)((s)->p)); \
(s)->p += 8; \
} while (0)
#endif
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define in_uint32_be(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
(v) = *((unsigned char*)((s)->p)); \
(s)->p++; \
(v) <<= 8; \
(v) |= *((unsigned char*)((s)->p)); \
(s)->p++; \
(v) <<= 8; \
(v) |= *((unsigned char*)((s)->p)); \
(s)->p++; \
(v) <<= 8; \
(v) |= *((unsigned char*)((s)->p)); \
(s)->p++; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define out_uint8(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
*((s)->p) = (unsigned char)(v); \
(s)->p++; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
#if defined(B_ENDIAN) || defined(NEED_ALIGN)
2010-08-10 03:02:06 +04:00
#define out_uint16_le(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
*((s)->p) = (unsigned char)((v) >> 0); \
(s)->p++; \
*((s)->p) = (unsigned char)((v) >> 8); \
(s)->p++; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
#else
2010-08-10 03:02:06 +04:00
#define out_uint16_le(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
*((unsigned short*)((s)->p)) = (unsigned short)(v); \
(s)->p += 2; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
#endif
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define out_uint16_be(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
*((s)->p) = (unsigned char)((v) >> 8); \
(s)->p++; \
*((s)->p) = (unsigned char)((v) >> 0); \
(s)->p++; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
#if defined(B_ENDIAN) || defined(NEED_ALIGN)
2010-08-10 03:02:06 +04:00
#define out_uint32_le(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
*((s)->p) = (unsigned char)((v) >> 0); \
(s)->p++; \
*((s)->p) = (unsigned char)((v) >> 8); \
(s)->p++; \
*((s)->p) = (unsigned char)((v) >> 16); \
(s)->p++; \
*((s)->p) = (unsigned char)((v) >> 24); \
(s)->p++; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
#else
2010-08-10 03:02:06 +04:00
#define out_uint32_le(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
*((unsigned int*)((s)->p)) = (v); \
(s)->p += 4; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
#endif
2013-08-19 21:47:26 +04:00
/******************************************************************************/
#if defined(B_ENDIAN) || defined(NEED_ALIGN)
#define out_uint64_le(s, v) do \
{ \
*((s)->p) = (unsigned char)((v) >> 0); \
(s)->p++; \
*((s)->p) = (unsigned char)((v) >> 8); \
(s)->p++; \
*((s)->p) = (unsigned char)((v) >> 16); \
(s)->p++; \
*((s)->p) = (unsigned char)((v) >> 24); \
(s)->p++; \
*((s)->p) = (unsigned char)((v) >> 32); \
(s)->p++; \
*((s)->p) = (unsigned char)((v) >> 40); \
(s)->p++; \
*((s)->p) = (unsigned char)((v) >> 48); \
(s)->p++; \
*((s)->p) = (unsigned char)((v) >> 56); \
(s)->p++; \
} while (0)
#else
#define out_uint64_le(s, v) do \
{ \
*((tui64*)((s)->p)) = (v); \
(s)->p += 8; \
} while (0)
#endif
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define out_uint32_be(s, v) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
*((s)->p) = (unsigned char)((v) >> 24); \
2005-01-07 03:56:38 +03:00
s->p++; \
2005-03-11 05:23:30 +03:00
*((s)->p) = (unsigned char)((v) >> 16); \
2005-01-07 03:56:38 +03:00
s->p++; \
2005-03-11 05:23:30 +03:00
*((s)->p) = (unsigned char)((v) >> 8); \
2005-01-07 03:56:38 +03:00
s->p++; \
2005-03-11 05:23:30 +03:00
*((s)->p) = (unsigned char)(v); \
(s)->p++; \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define in_uint8p(s, v, n) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
(v) = (s)->p; \
(s)->p += (n); \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define in_uint8a(s, v, n) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
g_memcpy((v), (s)->p, (n)); \
(s)->p += (n); \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
#define in_uint8s(s, n) \
2010-08-10 03:02:06 +04:00
(s)->p += (n)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define out_uint8p(s, v, n) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
g_memcpy((s)->p, (v), (n)); \
(s)->p += (n); \
2010-08-10 03:02:06 +04:00
} while (0)
2005-01-07 03:56:38 +03:00
/******************************************************************************/
#define out_uint8a(s, v, n) \
2010-08-10 03:02:06 +04:00
out_uint8p((s), (v), (n))
2005-01-07 03:56:38 +03:00
/******************************************************************************/
2010-08-10 03:02:06 +04:00
#define out_uint8s(s, n) do \
2005-01-07 03:56:38 +03:00
{ \
2005-03-11 05:23:30 +03:00
g_memset((s)->p, 0, (n)); \
(s)->p += (n); \
2010-08-10 03:02:06 +04:00
} while (0)
2005-06-28 07:04:36 +04:00
/*
* @brief allocate a new stream
*
* @param _s opaque handle to the new stream
* @param _l length of new stream
******************************************************************************/
2013-05-03 13:07:02 +04:00
#define xstream_new(_s, _l) \
do \
{ \
make_stream((_s)); \
init_stream((_s), (_l)); \
} while (0)
/**
* @brief release a previously allocated stream
*
* @param _s opaque handle returned by stream_new()
*****************************************************************************/
2013-05-03 13:07:02 +04:00
#define xstream_free(_s) free_stream(_s)
2013-05-03 13:07:02 +04:00
#define xstream_rd_u8(_s, _var) in_uint8(_s, _var)
#define xstream_rd_u16_le(_s, _var) in_uint16_le(_s, _var)
#define xstream_rd_u32_le(_s, _var) in_uint32_le(_s, _var)
2013-05-03 13:07:02 +04:00
#define xstream_rd_s8_le(_s, _var) in_sint8(_s, _var)
#define xstream_rd_s16_le(_s, _var) in_sint16_le(_s, _var)
#define xstream_rd_s32_le(_s, _var) TODO
2013-05-03 13:07:02 +04:00
#define xstream_wr_u8(_s, _var) out_uint8(_s, _var)
#define xstream_wr_u16_le(_s, _var) out_uint16_le(_s, _var)
#define xstream_wr_u32_le(_s, _var) out_uint32_le(_s, _var)
2013-05-03 13:07:02 +04:00
#define xstream_wr_s8(_s, _var) TODO
#define xstream_wr_s16_le(_s, _var) TODO
#define xstream_wr_s32_le(_s, _var) TODO
2013-07-19 22:10:55 +04:00
#define xstream_rd_u64_le(_s, _v) \
do \
{ \
_v = \
(tui64)(*((unsigned char *)_s->p)) | \
(((tui64) (*(((unsigned char *)_s->p) + 1))) << 8) | \
(((tui64) (*(((unsigned char *)_s->p) + 2))) << 16) | \
(((tui64) (*(((unsigned char *)_s->p) + 3))) << 24) | \
(((tui64) (*(((unsigned char *)_s->p) + 4))) << 32) | \
(((tui64) (*(((unsigned char *)_s->p) + 5))) << 40) | \
(((tui64) (*(((unsigned char *)_s->p) + 6))) << 48) | \
(((tui64) (*(((unsigned char *)_s->p) + 7))) << 56); \
_s->p += 8; \
} while (0)
2013-07-19 22:10:55 +04:00
#define xstream_wr_u64_le(_s, _v) \
do \
{ \
*(((unsigned char *) _s->p) + 0) = (unsigned char) ((_v >> 0) & 0xff); \
*(((unsigned char *) _s->p) + 1) = (unsigned char) ((_v >> 8) & 0xff); \
*(((unsigned char *) _s->p) + 2) = (unsigned char) ((_v >> 16) & 0xff); \
*(((unsigned char *) _s->p) + 3) = (unsigned char) ((_v >> 24) & 0xff); \
*(((unsigned char *) _s->p) + 4) = (unsigned char) ((_v >> 32) & 0xff); \
*(((unsigned char *) _s->p) + 5) = (unsigned char) ((_v >> 40) & 0xff); \
*(((unsigned char *) _s->p) + 6) = (unsigned char) ((_v >> 48) & 0xff); \
*(((unsigned char *) _s->p) + 7) = (unsigned char) ((_v >> 56) & 0xff); \
_s->p += 8; \
} while (0)
/* copy data into stream */
#define xstream_copyin(_s, _dest, _len) \
do \
{ \
g_memcpy((_s)->p, (_dest), (_len)); \
(_s)->p += (_len); \
} while (0)
/* copy data out of stream */
#define xstream_copyout(_dest, _s, _len) \
do \
{ \
g_memcpy((_dest), (_s)->p, (_len)); \
(_s)->p += (_len); \
} while (0)
2013-05-03 13:07:02 +04:00
#define xstream_rd_string(_dest, _s, _len) \
2013-07-19 22:10:55 +04:00
do \
{ \
g_memcpy((_dest), (_s)->p, (_len)); \
(_s)->p += (_len); \
} while (0)
2013-07-19 22:10:55 +04:00
#define xstream_wr_string(_s, _src, _len) \
do \
{ \
2013-07-19 22:10:55 +04:00
g_memcpy((_s)->p, (_src), (_len)); \
(_s)->p += (_len); \
} while (0)
2013-05-03 13:07:02 +04:00
#define xstream_len(_s) (int) ((_s)->p - (_s)->data)
#define xstream_seek(_s, _len) (_s)->p += (_len)
2005-06-28 07:04:36 +04:00
#endif