/*
* The ManaPlus Client
* Copyright (C) 2004-2009 The Mana World Development Team
* Copyright (C) 2009-2010 The Mana Developers
* Copyright (C) 2011-2018 The ManaPlus Developers
*
* This file is part of The ManaPlus Client.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see .
*/
#include "net/messagein.h"
#include "net/packetcounters.h"
#include "utils/cast.h"
#include "utils/stringutils.h"
#include "logger.h"
#include "debug.h"
PRAGMA48(GCC diagnostic push)
PRAGMA48(GCC diagnostic ignored "-Wshadow")
#ifndef SDL_BIG_ENDIAN
#include
#endif // SDL_BYTEORDER
PRAGMA48(GCC diagnostic pop)
#define MAKEWORD(low, high) \
(CAST_U16((CAST_U8(low)) | \
(CAST_U16(CAST_U8(high))) << 8))
namespace Net
{
MessageIn::MessageIn(const char *const data,
const unsigned int length) :
mData(data),
mLength(length),
mPos(0),
mVersion(0),
mId(0),
mIgnore(false)
{
PacketCounters::incInPackets();
}
MessageIn::~MessageIn()
{
if (mLength != 0u)
{
if (mPos != mLength && mPos != 2)
{
logger->log("Wrong actual or planned inbound packet size!");
logger->log(" packet id: %u 0x%x",
CAST_U32(mId),
CAST_U32(mId));
logger->log(" planned size: %u", mLength);
logger->log(" read size: %u", mPos);
WRONGPACKETSIZE;
}
}
else
{
logger->log("Zero packet size: %d", CAST_S32(mId));
}
}
uint16_t MessageIn::readId() const
{
int16_t value = -1;
if (mPos + 2 <= mLength)
{
#if SDL_BYTEORDER == SDL_BIG_ENDIAN
int16_t swap;
memcpy(&swap, mData + CAST_SIZE(mPos), sizeof(int16_t));
value = SDL_Swap16(swap);
#else // SDL_BYTEORDER == SDL_BIG_ENDIAN
memcpy(&value, mData + CAST_SIZE(mPos), sizeof(int16_t));
#endif // SDL_BYTEORDER == SDL_BIG_ENDIAN
}
return value;
}
unsigned char MessageIn::readUInt8(const char *const str)
{
unsigned char value = CAST_U8(-1);
if (mPos < mLength)
value = CAST_U8(mData[mPos]);
DEBUGLOG2("readUInt8: " + toStringPrint(CAST_U32(value)),
mPos, str);
mPos += 1;
PacketCounters::incInBytes(1);
return value;
}
signed char MessageIn::readInt8(const char *const str)
{
signed char value = CAST_S8(-1);
if (mPos < mLength)
value = CAST_S8(mData[mPos]);
DEBUGLOG2("readInt8: " + toStringPrint(CAST_U32(
CAST_U8(value))),
mPos, str);
mPos += 1;
PacketCounters::incInBytes(1);
return value;
}
int16_t MessageIn::readInt16(const char *const str)
{
int16_t value = -1;
if (mPos + 2 <= mLength)
{
#if SDL_BYTEORDER == SDL_BIG_ENDIAN
int16_t swap;
memcpy(&swap, mData + CAST_SIZE(mPos), sizeof(int16_t));
value = SDL_Swap16(swap);
#else // SDL_BYTEORDER == SDL_BIG_ENDIAN
memcpy(&value, mData + CAST_SIZE(mPos), sizeof(int16_t));
#endif // SDL_BYTEORDER == SDL_BIG_ENDIAN
}
DEBUGLOG2("readInt16: " + toStringPrint(CAST_U32(
CAST_U16(value))),
mPos, str);
mPos += 2;
PacketCounters::incInBytes(2);
return value;
}
uint16_t MessageIn::readUInt16(const char *const str)
{
uint16_t value = 0xffU;
if (mPos + 2 <= mLength)
{
#if SDL_BYTEORDER == SDL_BIG_ENDIAN
uint16_t swap;
memcpy(&swap, mData + CAST_SIZE(mPos), sizeof(uint16_t));
value = SDL_Swap16(swap);
#else // SDL_BYTEORDER == SDL_BIG_ENDIAN
memcpy(&value, mData + CAST_SIZE(mPos), sizeof(uint16_t));
#endif // SDL_BYTEORDER == SDL_BIG_ENDIAN
}
DEBUGLOG2("readUInt16: " + toStringPrint(CAST_U32(
CAST_U16(value))),
mPos, str);
mPos += 2;
PacketCounters::incInBytes(2);
return value;
}
int32_t MessageIn::readInt32(const char *const str)
{
int32_t value = -1;
if (mPos + 4 <= mLength)
{
#if SDL_BYTEORDER == SDL_BIG_ENDIAN
int32_t swap;
memcpy(&swap, mData + CAST_SIZE(mPos), sizeof(int32_t));
value = SDL_Swap32(swap);
#else // SDL_BYTEORDER == SDL_BIG_ENDIAN
memcpy(&value, mData + CAST_SIZE(mPos), sizeof(int32_t));
#endif // SDL_BYTEORDER == SDL_BIG_ENDIAN
}
DEBUGLOG2("readInt32: " + toStringPrint(CAST_S32(value)),
mPos, str);
mPos += 4;
PacketCounters::incInBytes(4);
return value;
}
uint32_t MessageIn::readUInt32(const char *const str)
{
uint32_t value = -1;
if (mPos + 4 <= mLength)
{
#if SDL_BYTEORDER == SDL_BIG_ENDIAN
uint32_t swap;
memcpy(&swap, mData + CAST_SIZE(mPos), sizeof(int32_t));
value = SDL_Swap32(swap);
#else // SDL_BYTEORDER == SDL_BIG_ENDIAN
memcpy(&value, mData + CAST_SIZE(mPos), sizeof(int32_t));
#endif // SDL_BYTEORDER == SDL_BIG_ENDIAN
}
DEBUGLOG2("readInt32: " + toStringPrint(CAST_U32(value)),
mPos, str);
mPos += 4;
PacketCounters::incInBytes(4);
return value;
}
BeingId MessageIn::readBeingId(const char *const str)
{
return fromInt(readUInt32(str), BeingId);
}
int64_t MessageIn::readInt64(const char *const str)
{
int64_t value = -1;
if (mPos + 8 <= mLength)
{
#if SDL_BYTEORDER == SDL_BIG_ENDIAN
int64_t swap;
memcpy(&swap, mData + CAST_SIZE(mPos), sizeof(int64_t));
value = SDL_Swap64(swap);
#else // SDL_BYTEORDER == SDL_BIG_ENDIAN
memcpy(&value, mData + CAST_SIZE(mPos), sizeof(int64_t));
#endif // SDL_BYTEORDER == SDL_BIG_ENDIAN
}
DEBUGLOG2("readInt64: " + toStringPrint(CAST_U32(value)),
mPos, str);
mPos += 8;
PacketCounters::incInBytes(8);
return value;
}
uint8_t MessageIn::fromServerDirection(const uint8_t serverDir)
{
// Translate from eAthena format
switch (serverDir)
{
case 0:
return 1;
case 1:
return 3;
case 2:
return 2;
case 3:
return 6;
case 4:
return 4;
case 5:
return 12;
case 6:
return 8;
case 7:
return 9;
case 8:
return 8;
default:
logger->log("incorrect direction: %d",
CAST_S32(serverDir));
return 0;
}
}
void MessageIn::readCoordinates(uint16_t &restrict x,
uint16_t &restrict y,
uint8_t &restrict direction,
const char *const str)
{
if (mPos + 3 <= mLength)
{
const char *const data = mData + CAST_SIZE(mPos);
uint16_t temp = MAKEWORD(data[1] & 0x00c0, data[0] & 0x00ff);
x = CAST_U16(temp >> 6);
temp = MAKEWORD(data[2] & 0x00f0, data[1] & 0x003f);
y = CAST_U16(temp >> 4);
const uint8_t serverDir = CAST_U8(data[2] & 0x000f);
direction = fromServerDirection(serverDir);
DEBUGLOG2(std::string("readCoordinates: ").append(toString(
CAST_S32(x))).append(",").append(toString(
CAST_S32(y))).append(",").append(toString(
CAST_S32(serverDir))), mPos, str);
}
else
{
x = 0;
y = 0;
direction = 0;
logger->log("error: wrong readCoordinates packet");
}
mPos += 3;
PacketCounters::incInBytes(3);
}
void MessageIn::readCoordinatePair(uint16_t &restrict srcX,
uint16_t &restrict srcY,
uint16_t &restrict dstX,
uint16_t &restrict dstY,
const char *const str)
{
if (mPos + 5 <= mLength)
{
const char *const data = mData + CAST_SIZE(mPos);
uint16_t temp = MAKEWORD(data[3], data[2] & 0x000f);
dstX = CAST_U16(temp >> 2);
dstY = MAKEWORD(data[4], data[3] & 0x0003);
temp = MAKEWORD(data[1], data[0]);
srcX = CAST_U16(temp >> 6);
temp = MAKEWORD(data[2], data[1] & 0x003f);
srcY = CAST_U16(temp >> 4);
DEBUGLOG2(std::string("readCoordinatePair: ").append(toString(
CAST_S32(srcX))).append(",").append(toString(
CAST_S32(srcY))).append(" ").append(toString(
CAST_S32(dstX))).append(",").append(toString(
CAST_S32(dstY))), mPos, str);
}
else
{
srcX = 0;
srcY = 0;
dstX = 0;
dstY = 0;
logger->log("error: wrong readCoordinatePair packet");
}
mPos += 5;
PacketCounters::incInBytes(5);
}
void MessageIn::skip(const unsigned int length, const char *const str)
{
DEBUGLOG2("skip: " + toString(CAST_S32(length)), mPos, str);
mPos += length;
PacketCounters::incInBytes(length);
}
void MessageIn::skipToEnd(const char *const str)
{
const int diff = CAST_S32(mLength - mPos);
if (diff != 0)
{
DEBUGLOG2("skip: " + toString(diff), mPos, str);
mPos = mLength;
PacketCounters::incInBytes(diff);
}
}
std::string MessageIn::readString(int length, const char *const dstr)
{
// Get string length
if (length < 0)
length = readInt16("len");
// Make sure the string isn't erroneous
if (length < 0 || mPos + length > mLength)
{
DEBUGLOG2("readString error", mPos, dstr);
mPos = mLength + 1;
return "";
}
// Read the string
const char *const stringBeg = mData + CAST_SIZE(mPos);
const char *const stringEnd
= static_cast(memchr(stringBeg, '\0', length));
const std::string str(stringBeg, stringEnd != nullptr
? stringEnd - stringBeg : CAST_SIZE(length));
DEBUGLOG2("readString: " + str, mPos, dstr);
mPos += length;
PacketCounters::incInBytes(length);
return str;
}
std::string MessageIn::readRawString(int length, const char *const dstr)
{
// Get string length
if (length < 0)
length = readInt16("len");
// Make sure the string isn't erroneous
if (length < 0 || mPos + length > mLength)
{
mPos = mLength + 1;
return "";
}
// Read the string
const char *const stringBeg = mData + CAST_SIZE(mPos);
const char *const stringEnd
= static_cast(memchr(stringBeg, '\0', length));
std::string str(stringBeg, stringEnd != nullptr
? stringEnd - stringBeg : CAST_SIZE(length));
DEBUGLOG2("readString: " + str, mPos, dstr);
if (stringEnd != nullptr)
{
const size_t len2 = CAST_SIZE(length)
- (stringEnd - stringBeg) - 1;
const char *const stringBeg2 = stringEnd + 1;
const char *const stringEnd2
= static_cast(memchr(stringBeg2, '\0', len2));
const std::string hiddenPart = std::string(stringBeg2,
stringEnd2 != nullptr ? stringEnd2 - stringBeg2 : len2);
if (hiddenPart.length() > 0)
{
DEBUGLOG2("readString2: " + hiddenPart, mPos, dstr);
return str.append("|").append(hiddenPart);
}
}
mPos += length;
PacketCounters::incInBytes(length);
return str;
}
unsigned char *MessageIn::readBytes(int length, const char *const dstr)
{
// Get string length
if (length < 0)
length = readInt16("len");
// Make sure the string isn't erroneous
if (length < 0 || mPos + length > mLength)
{
DEBUGLOG2("readBytesString error", mPos, dstr);
mPos = mLength + 1;
return nullptr;
}
unsigned char *const buf
= new unsigned char[CAST_SIZE(length + 2)];
memcpy(buf, mData + CAST_SIZE(mPos), length);
buf[length] = 0;
buf[length + 1] = 0;
mPos += length;
#ifdef ENABLEDEBUGLOG
std::string str;
for (int f = 0; f < length; f ++)
str.append(strprintf("%02x", CAST_U32(buf[f])));
str += " ";
for (int f = 0; f < length; f ++)
{
if (buf[f] != 0u)
str.append(strprintf("%c", buf[f]));
else
str.append("_");
}
if (dstr != nullptr)
logger->dlog(dstr);
logger->dlog("ReadBytes: " + str);
#endif // ENABLEDEBUGLOG
PacketCounters::incInBytes(length);
return buf;
}
} // namespace Net