mirror of https://github.com/nymea/nymea.git
77 lines
2.9 KiB
C++
77 lines
2.9 KiB
C++
/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *
|
|
* *
|
|
* Copyright (C) 2015 Simon Stuerz <simon.stuerz@guh.guru> *
|
|
* *
|
|
* This file is part of QtCoap. *
|
|
* *
|
|
* QtCoap 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, version 3 of the License. *
|
|
* *
|
|
* QtCoap 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 QtCoap. If not, see <http://www.gnu.org/licenses/>. *
|
|
* *
|
|
* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
|
|
|
|
#include "coappdublock.h"
|
|
|
|
CoapPduBlock::CoapPduBlock()
|
|
{
|
|
}
|
|
|
|
CoapPduBlock::CoapPduBlock(const QByteArray &blockData)
|
|
{
|
|
if (blockData.size() == 1) {
|
|
quint8 block = (quint8)blockData.at(0);
|
|
m_blockNumber = (block & 0xf0) >> 4;
|
|
m_blockSize = (quint8) pow(2, (block & 0x07) + 4);
|
|
m_moreFlag = (bool)((block & 0x8) >> 3);
|
|
} else if (blockData.size() == 2) {
|
|
quint16 block = (quint16)blockData.toHex().toUInt(0, 16);
|
|
m_blockNumber = (int)(block & 0xff0) >> 4;
|
|
m_blockSize = (int) pow(2, (block & 0x07) + 4);
|
|
m_moreFlag = (bool)((block & 0x08) >> 3);
|
|
}
|
|
}
|
|
|
|
QByteArray CoapPduBlock::createBlock(const int &blockNumber, const int &blockSize, const bool &moreFlag)
|
|
{
|
|
QByteArray blockData;
|
|
if (blockNumber < 16) {
|
|
quint8 block = (quint8)blockSize;
|
|
block |= (quint8)moreFlag << 3;
|
|
block |= (quint8)blockNumber << 4;
|
|
blockData = QByteArray(1, (char)block);
|
|
} else {
|
|
quint16 block = (quint16)blockSize;
|
|
block |= (quint16)moreFlag << 3;
|
|
block |= (quint8)blockNumber << 4;
|
|
blockData.resize(2);
|
|
blockData.fill(0);
|
|
blockData[0] = (quint8)(block >> 8);
|
|
blockData[1] = (quint8)(block & 0xff);
|
|
}
|
|
return blockData;
|
|
}
|
|
|
|
int CoapPduBlock::blockNumber() const
|
|
{
|
|
return m_blockNumber;
|
|
}
|
|
|
|
int CoapPduBlock::blockSize() const
|
|
{
|
|
return m_blockSize;
|
|
}
|
|
|
|
bool CoapPduBlock::moreFlag() const
|
|
{
|
|
return m_moreFlag;
|
|
}
|
|
|