/* * The ManaPlus Client * Copyright (C) 2004-2009 The Mana World Development Team * Copyright (C) 2009-2010 The Mana Developers * Copyright (C) 2011-2013 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 <http://www.gnu.org/licenses/>. */ #include "net/messagein.h" #include "net/packetcounters.h" #include "logger.h" #include "net.h" #include "debug.h" #define MAKEWORD(low, high) \ (static_cast<uint16_t>((static_cast<unsigned char>(low)) | \ (static_cast<uint16_t>(static_cast<unsigned char>(high))) << 8)) namespace Net { MessageIn::MessageIn(const char *data, unsigned int length): mData(data), mLength(length), mId(0), mPos(0) { PacketCounters::incInPackets(); DEBUGLOG("MessageIn"); } unsigned char MessageIn::readInt8() { unsigned char value = static_cast<unsigned char>(-1); if (mPos < mLength) value = static_cast<unsigned char>(mData[mPos]); mPos += 1; PacketCounters::incInBytes(1); DEBUGLOG("readInt8: " + toStringPrint(static_cast<int>(value))); return value; } void MessageIn::readCoordinates(uint16_t &x, uint16_t &y) { if (mPos + 3 <= mLength) { const unsigned char *const p = reinterpret_cast<unsigned char const *const>(mData + mPos); x = static_cast<uint16_t>(p[0] | ((p[1] & 0x07) << 8)); y = static_cast<uint16_t>((p[1] >> 3) | ((p[2] & 0x3F) << 5)); } mPos += 3; PacketCounters::incInBytes(3); DEBUGLOG(std::string("readCoordinates: ").append(toString( static_cast<int>(x))).append(",").append(toString( static_cast<int>(y)))); } 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: #ifdef MANASERV_SUPPORT if (Net::getNetworkType() != ServerInfo::MANASERV) #endif return 8; default: logger->log("incorrect direction: %d", static_cast<int>(serverDir)); return 0; } } void MessageIn::readCoordinates(uint16_t &x, uint16_t &y, uint8_t &direction) { uint8_t serverDir = 0; if (mPos + 3 <= mLength) { const char *const data = mData + mPos; int16_t temp = MAKEWORD(data[1] & 0x00c0, data[0] & 0x00ff); x = static_cast<uint16_t>(temp >> 6); temp = MAKEWORD(data[2] & 0x00f0, data[1] & 0x003f); y = static_cast<uint16_t>(temp >> 4); serverDir = static_cast<uint8_t>(data[2] & 0x000f); direction = fromServerDirection(serverDir); } mPos += 3; PacketCounters::incInBytes(3); DEBUGLOG(std::string("readCoordinates: ").append(toString( static_cast<int>(x))).append(",").append(toString( static_cast<int>(y))).append(",").append(toString( static_cast<int>(serverDir)))); } void MessageIn::readCoordinatePair(uint16_t &srcX, uint16_t &srcY, uint16_t &dstX, uint16_t &dstY) { if (mPos + 5 <= mLength) { const char *const data = mData + mPos; int16_t temp = MAKEWORD(data[3], data[2] & 0x000f); dstX = static_cast<uint16_t>(temp >> 2); dstY = MAKEWORD(data[4], data[3] & 0x0003); temp = MAKEWORD(data[1], data[0]); srcX = static_cast<uint16_t>(temp >> 6); temp = MAKEWORD(data[2], data[1] & 0x003f); srcY = static_cast<uint16_t>(temp >> 4); } mPos += 5; DEBUGLOG(std::string("readCoordinatePair: ").append(toString( static_cast<int>(srcX))).append(",").append(toString( static_cast<int>(srcY))).append(" ").append(toString( static_cast<int>(dstX))).append(",").append(toString( static_cast<int>(dstY)))); PacketCounters::incInBytes(5); } void MessageIn::skip(const unsigned int length) { mPos += length; PacketCounters::incInBytes(length); DEBUGLOG("skip: " + toString(static_cast<int>(length))); } std::string MessageIn::readString(int length) { // Get string length if (length < 0) length = readInt16(); // Make sure the string isn't erroneous if (length < 0 || mPos + length > mLength) { mPos = mLength + 1; DEBUGLOG("readString error"); return ""; } // Read the string const char *const stringBeg = mData + mPos; const char *const stringEnd = static_cast<const char *const>(memchr(stringBeg, '\0', length)); const std::string str(stringBeg, stringEnd ? stringEnd - stringBeg : length); mPos += length; PacketCounters::incInBytes(length); DEBUGLOG("readString: " + str); return str; } std::string MessageIn::readRawString(int length) { // Get string length if (length < 0) length = readInt16(); // 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 + mPos; const char *const stringEnd = static_cast<const char *const>(memchr(stringBeg, '\0', length)); std::string str(stringBeg, stringEnd ? stringEnd - stringBeg : length); mPos += length; PacketCounters::incInBytes(length); DEBUGLOG("readString: " + str); if (stringEnd) { const size_t len2 = length - (stringEnd - stringBeg) - 1; const char *const stringBeg2 = stringEnd + 1; const char *const stringEnd2 = static_cast<const char *const>(memchr(stringBeg2, '\0', len2)); const std::string hiddenPart = std::string(stringBeg2, stringEnd2 ? stringEnd2 - stringBeg2 : len2); if (hiddenPart.length() > 0) { DEBUGLOG("readString2: " + hiddenPart); return str.append("|").append(hiddenPart); } } return str; } unsigned char *MessageIn::readBytes(int length) { // Get string length if (length < 0) length = readInt16(); // Make sure the string isn't erroneous if (length < 0 || mPos + length > mLength) { mPos = mLength + 1; DEBUGLOG("readBytesString error"); return nullptr; } unsigned char *const buf = new unsigned char[length + 2]; memcpy(buf, mData + 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", static_cast<unsigned>(buf[f]))); str += " "; for (int f = 0; f < length; f ++) { if (buf[f]) str.append(strprintf("%c", buf[f])); else str.append("_"); } logger->dlog("ReadBytes: " + str); #endif PacketCounters::incInBytes(length); return buf; } } // namespace Net