From mboxrd@z Thu Jan 1 00:00:00 1970 Received: from eggs.gnu.org ([2001:4830:134:3::10]:33662) by lists.gnu.org with esmtp (Exim 4.71) (envelope-from ) id 1eOO2Z-000151-IY for qemu-devel@nongnu.org; Mon, 11 Dec 2017 08:22:40 -0500 Received: from Debian-exim by eggs.gnu.org with spam-scanned (Exim 4.71) (envelope-from ) id 1eOO2W-0002Ab-DL for qemu-devel@nongnu.org; Mon, 11 Dec 2017 08:22:39 -0500 Received: from mail.ispras.ru ([83.149.199.45]:43468) by eggs.gnu.org with esmtp (Exim 4.71) (envelope-from ) id 1eOO2W-0002A4-1u for qemu-devel@nongnu.org; Mon, 11 Dec 2017 08:22:36 -0500 From: Mihail Abakumov Date: Mon, 11 Dec 2017 16:22:20 +0300 Message-ID: <151299854064.4808.17560500311260498075.stgit@Misha-PC.lan02.inno> In-Reply-To: <151299847127.4808.14646046517426494416.stgit@Misha-PC.lan02.inno> References: <151299847127.4808.14646046517426494416.stgit@Misha-PC.lan02.inno> MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: 7bit Subject: [Qemu-devel] [PATCH v4 11/46] windbg: parsing data stream List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , To: qemu-devel@nongnu.org Cc: sw@weilnetz.de, lprosek@redhat.com, dovgaluk@ispras.ru, rkagan@virtuozzo.com, pbonzini@redhat.com, den@openvz.org Added function of parsing data stream from windbg to packet. Signed-off-by: Mihail Abakumov Signed-off-by: Pavel Dovgalyuk Signed-off-by: Dmitriy Koltunov --- windbgstub.c | 111 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++- 1 file changed, 110 insertions(+), 1 deletion(-) diff --git a/windbgstub.c b/windbgstub.c index 395f244d4f..ace992e2cb 100755 --- a/windbgstub.c +++ b/windbgstub.c @@ -60,6 +60,105 @@ typedef struct WindbgState { static WindbgState *windbg_state; +static void windbg_ctx_handler(ParsingContext *ctx) +{} + +static void windbg_read_byte(ParsingContext *ctx, uint8_t byte) +{ + switch (ctx->state) { + case STATE_LEADER: + ctx->result = RESULT_NONE; + if (byte == PACKET_LEADER_BYTE || byte == CONTROL_PACKET_LEADER_BYTE) { + if (ctx->index > 0 && byte != PTR(ctx->packet.PacketLeader)[0]) { + ctx->index = 0; + } + PTR(ctx->packet.PacketLeader)[ctx->index] = byte; + ++ctx->index; + if (ctx->index == sizeof(ctx->packet.PacketLeader)) { + ctx->state = STATE_PACKET_TYPE; + ctx->index = 0; + } + } else if (byte == BREAKIN_PACKET_BYTE) { + ctx->result = RESULT_BREAKIN_BYTE; + ctx->index = 0; + } else { + ctx->index = 0; + } + break; + + case STATE_PACKET_TYPE: + PTR(ctx->packet.PacketType)[ctx->index] = byte; + ++ctx->index; + if (ctx->index == sizeof(ctx->packet.PacketType)) { + ctx->packet.PacketType = lduw_p(&ctx->packet.PacketType); + if (ctx->packet.PacketType >= PACKET_TYPE_MAX) { + ctx->state = STATE_LEADER; + ctx->result = RESULT_UNKNOWN_PACKET; + } else { + ctx->state = STATE_PACKET_BYTE_COUNT; + } + ctx->index = 0; + } + break; + + case STATE_PACKET_BYTE_COUNT: + PTR(ctx->packet.ByteCount)[ctx->index] = byte; + ++ctx->index; + if (ctx->index == sizeof(ctx->packet.ByteCount)) { + ctx->packet.ByteCount = lduw_p(&ctx->packet.ByteCount); + ctx->state = STATE_PACKET_ID; + ctx->index = 0; + } + break; + + case STATE_PACKET_ID: + PTR(ctx->packet.PacketId)[ctx->index] = byte; + ++ctx->index; + if (ctx->index == sizeof(ctx->packet.PacketId)) { + ctx->packet.PacketId = ldl_p(&ctx->packet.PacketId); + ctx->state = STATE_PACKET_CHECKSUM; + ctx->index = 0; + } + break; + + case STATE_PACKET_CHECKSUM: + PTR(ctx->packet.Checksum)[ctx->index] = byte; + ++ctx->index; + if (ctx->index == sizeof(ctx->packet.Checksum)) { + ctx->packet.Checksum = ldl_p(&ctx->packet.Checksum); + if (ctx->packet.PacketLeader == CONTROL_PACKET_LEADER) { + ctx->state = STATE_LEADER; + ctx->result = RESULT_CONTROL_PACKET; + } else if (ctx->packet.ByteCount > PACKET_MAX_SIZE) { + ctx->state = STATE_LEADER; + ctx->result = RESULT_ERROR; + } else { + ctx->state = STATE_PACKET_DATA; + } + ctx->index = 0; + } + break; + + case STATE_PACKET_DATA: + ctx->data.buf[ctx->index] = byte; + ++ctx->index; + if (ctx->index == ctx->packet.ByteCount) { + ctx->state = STATE_TRAILING_BYTE; + ctx->index = 0; + } + break; + + case STATE_TRAILING_BYTE: + if (byte == PACKET_TRAILING_BYTE) { + ctx->result = RESULT_DATA_PACKET; + } else { + ctx->result = RESULT_ERROR; + } + ctx->state = STATE_LEADER; + break; + } +} + static int windbg_chr_can_receive(void *opaque) { return PACKET_MAX_SIZE; @@ -67,8 +166,18 @@ static int windbg_chr_can_receive(void *opaque) static void windbg_chr_receive(void *opaque, const uint8_t *buf, int size) { + static ParsingContext ctx = { + .state = STATE_LEADER, + .result = RESULT_NONE, + .name = "" + }; + if (windbg_state->is_loaded) { - /* T0D0: parse data */ + int i; + for (i = 0; i < size; i++) { + windbg_read_byte(&ctx, buf[i]); + windbg_ctx_handler(&ctx); + } } }