xrdp/common/parse.h

/**
 * xrdp: A Remote Desktop Protocol server.
 *
 * Copyright (C) Jay Sorg 2004-2014
 *
 * 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
 */

#if !defined(PARSE_H)
#define PARSE_H

#include "arch.h"

#if defined(L_ENDIAN)
#elif defined(B_ENDIAN)
#else
#error Unknown endianness.
#endif

/* parser state */
struct stream
{
    char *p;
    char *end;
    char *data;
    int size;
    int pad0;
    /* offsets of various headers */
    char *iso_hdr;
    char *mcs_hdr;
    char *sec_hdr;
    char *rdp_hdr;
    char *channel_hdr;
    /* other */
    char *next_packet;
    struct stream *next;
    int *source;
};

/******************************************************************************/
#define s_check(s) ((s)->p <= (s)->end)

/******************************************************************************/
#define s_check_rem(s, n) ((s)->p + (n) <= (s)->end)

/******************************************************************************/
#define s_check_rem_out(s, n) ((s)->p + (n) <= (s)->data + (s)->size)

/******************************************************************************/
#define s_check_end(s) ((s)->p == (s)->end)

/******************************************************************************/
#define make_stream(s) \
    (s) = (struct stream*)g_malloc(sizeof(struct stream), 1)

/******************************************************************************/
#define init_stream(s, v) do \
{ \
    if ((v) > (s)->size) \
    { \
        g_free((s)->data); \
        (s)->data = (char*)g_malloc((v), 0); \
        (s)->size = (v); \
    } \
    (s)->p = (s)->data; \
    (s)->end = (s)->data; \
    (s)->next_packet = 0; \
} while (0)

/******************************************************************************/
#define free_stream(s) do \
{ \
    if ((s) != 0) \
    { \
        g_free((s)->data); \
    } \
    g_free((s)); \
} while (0)

/******************************************************************************/
#define s_push_layer(s, h, n) do \
{ \
    (s)->h = (s)->p; \
    (s)->p += (n); \
} while (0)

/******************************************************************************/
#define s_pop_layer(s, h) \
    (s)->p = (s)->h

/******************************************************************************/
#define s_mark_end(s) \
    (s)->end = (s)->p

#define in_sint8(s, v) do \
{ \
    (v) = *((signed char*)((s)->p)); \
    (s)->p++; \
} while (0)

/******************************************************************************/
#define in_uint8(s, v) do \
{ \
    (v) = *((unsigned char*)((s)->p)); \
    (s)->p++; \
} while (0)
/******************************************************************************/
#define in_uint8_peek(s, v) do { v = *s->p; } while (0)
/******************************************************************************/
#if defined(B_ENDIAN) || defined(NEED_ALIGN)
#define in_sint16_le(s, v) do \
{ \
    (v) = (signed short) \
        ( \
            (*((unsigned char*)((s)->p + 0)) << 0) | \
            (*((unsigned char*)((s)->p + 1)) << 8) \
        ); \
    (s)->p += 2; \
} while (0)
#else
#define in_sint16_le(s, v) do \
{ \
    (v) = *((signed short*)((s)->p)); \
    (s)->p += 2; \
} while (0)
#endif

/******************************************************************************/
#if defined(B_ENDIAN) || defined(NEED_ALIGN)
#define in_uint16_le(s, v) do \
{ \
    (v) = (unsigned short) \
        ( \
            (*((unsigned char*)((s)->p + 0)) << 0) | \
            (*((unsigned char*)((s)->p + 1)) << 8) \
        ); \
    (s)->p += 2; \
} while (0)
#else
#define in_uint16_le(s, v) do \
{ \
    (v) = *((unsigned short*)((s)->p)); \
    (s)->p += 2; \
} while (0)
#endif

/******************************************************************************/
#define in_uint16_be(s, v) do \
{ \
    (v) = *((unsigned char*)((s)->p)); \
    (s)->p++; \
    (v) <<= 8; \
    (v) |= *((unsigned char*)((s)->p)); \
    (s)->p++; \
} while (0)

/******************************************************************************/
#if defined(B_ENDIAN) || defined(NEED_ALIGN)
#define in_uint32_le(s, v) do \
{ \
    (v) = (unsigned int) \
        ( \
            (*((unsigned char*)((s)->p + 0)) << 0) | \
            (*((unsigned char*)((s)->p + 1)) << 8) | \
            (*((unsigned char*)((s)->p + 2)) << 16) | \
            (*((unsigned char*)((s)->p + 3)) << 24) \
        ); \
    (s)->p += 4; \
} while (0)
#else
#define in_uint32_le(s, v) do \
{ \
    (v) = *((unsigned int*)((s)->p)); \
    (s)->p += 4; \
} while (0)
#endif

/******************************************************************************/
#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

/******************************************************************************/
#define in_uint32_be(s, v) do \
{ \
    (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++; \
} while (0)

/******************************************************************************/
#define out_uint8(s, v) do \
{ \
  *((s)->p) = (unsigned char)(v); \
  (s)->p++; \
} while (0)

/******************************************************************************/
#if defined(B_ENDIAN) || defined(NEED_ALIGN)
#define out_uint16_le(s, v) do \
{ \
    *((s)->p) = (unsigned char)((v) >> 0); \
    (s)->p++; \
    *((s)->p) = (unsigned char)((v) >> 8); \
    (s)->p++; \
} while (0)
#else
#define out_uint16_le(s, v) do \
{ \
    *((unsigned short*)((s)->p)) = (unsigned short)(v); \
    (s)->p += 2; \
} while (0)
#endif

/******************************************************************************/
#define out_uint16_be(s, v) do \
{ \
    *((s)->p) = (unsigned char)((v) >> 8); \
    (s)->p++; \
    *((s)->p) = (unsigned char)((v) >> 0); \
    (s)->p++; \
} while (0)

/******************************************************************************/
#if defined(B_ENDIAN) || defined(NEED_ALIGN)
#define out_uint32_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++; \
} while (0)
#else
#define out_uint32_le(s, v) do \
{ \
    *((unsigned int*)((s)->p)) = (v); \
    (s)->p += 4; \
} while (0)
#endif

/******************************************************************************/
#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

/******************************************************************************/
#define out_uint32_be(s, v) do \
{ \
    *((s)->p) = (unsigned char)((v) >> 24); \
    s->p++; \
    *((s)->p) = (unsigned char)((v) >> 16); \
    s->p++; \
    *((s)->p) = (unsigned char)((v) >> 8); \
    s->p++; \
    *((s)->p) = (unsigned char)(v); \
    (s)->p++; \
} while (0)

/******************************************************************************/
#define in_uint8p(s, v, n) do \
{ \
    (v) = (s)->p; \
    (s)->p += (n); \
} while (0)

/******************************************************************************/
#define in_uint8a(s, v, n) do \
{ \
    g_memcpy((v), (s)->p, (n)); \
    (s)->p += (n); \
} while (0)

/******************************************************************************/
#define in_uint8s(s, n) \
    (s)->p += (n)

/******************************************************************************/
#define out_uint8p(s, v, n) do \
{ \
    g_memcpy((s)->p, (v), (n)); \
    (s)->p += (n); \
} while (0)

/******************************************************************************/
#define out_uint8a(s, v, n) \
    out_uint8p((s), (v), (n))

/******************************************************************************/
#define out_uint8s(s, n) do \
{ \
    g_memset((s)->p, 0, (n)); \
    (s)->p += (n); \
} while (0)

/*
 * @brief allocate a new stream
 *
 * @param _s opaque handle to the new stream
 * @param _l length of new stream
 ******************************************************************************/
#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()
 *****************************************************************************/
#define xstream_free(_s) free_stream(_s)

#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)

#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

#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)

#define xstream_wr_s8(_s, _var)       TODO
#define xstream_wr_s16_le(_s, _var)   TODO
#define xstream_wr_s32_le(_s, _var)   TODO

#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)

#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)

#define xstream_rd_string(_dest, _s, _len) \
do                                         \
{                                          \
    g_memcpy((_dest), (_s)->p, (_len));    \
    (_s)->p += (_len);                     \
} while (0)

#define xstream_wr_string(_s, _src, _len) \
do                                        \
{                                         \
    g_memcpy((_s)->p, (_src), (_len));    \
    (_s)->p += (_len);                    \
} while (0)

#define xstream_len(_s)               (int) ((_s)->p - (_s)->data)
#define xstream_seek(_s, _len)        (_s)->p += (_len)

#endif