mirror of
https://github.com/emsesp/EMS-ESP32.git
synced 2025-12-06 15:59:52 +03:00
70 lines
2.3 KiB
C++
70 lines
2.3 KiB
C++
#include "Publish.hpp"
|
|
|
|
using AsyncMqttClientInternals::PublishOutPacket;
|
|
|
|
PublishOutPacket::PublishOutPacket(const char* topic, uint8_t qos, bool retain, const char* payload, size_t length) {
|
|
char fixedHeader[5];
|
|
fixedHeader[0] = AsyncMqttClientInternals::PacketType.PUBLISH;
|
|
fixedHeader[0] = fixedHeader[0] << 4;
|
|
// if (dup) fixedHeader[0] |= AsyncMqttClientInternals::HeaderFlag.PUBLISH_DUP;
|
|
if (retain) fixedHeader[0] |= AsyncMqttClientInternals::HeaderFlag.PUBLISH_RETAIN;
|
|
switch (qos) {
|
|
case 0:
|
|
fixedHeader[0] |= AsyncMqttClientInternals::HeaderFlag.PUBLISH_QOS0;
|
|
break;
|
|
case 1:
|
|
fixedHeader[0] |= AsyncMqttClientInternals::HeaderFlag.PUBLISH_QOS1;
|
|
break;
|
|
case 2:
|
|
fixedHeader[0] |= AsyncMqttClientInternals::HeaderFlag.PUBLISH_QOS2;
|
|
break;
|
|
}
|
|
|
|
uint16_t topicLength = strlen(topic);
|
|
char topicLengthBytes[2];
|
|
topicLengthBytes[0] = topicLength >> 8;
|
|
topicLengthBytes[1] = topicLength & 0xFF;
|
|
|
|
uint32_t payloadLength = length;
|
|
if (payload != nullptr && payloadLength == 0) payloadLength = strlen(payload);
|
|
|
|
uint32_t remainingLength = 2 + topicLength + payloadLength;
|
|
if (qos != 0) remainingLength += 2;
|
|
uint8_t remainingLengthLength = AsyncMqttClientInternals::Helpers::encodeRemainingLength(remainingLength, fixedHeader + 1);
|
|
|
|
size_t neededSpace = 0;
|
|
neededSpace += 1 + remainingLengthLength;
|
|
neededSpace += 2;
|
|
neededSpace += topicLength;
|
|
if (qos != 0) neededSpace += 2;
|
|
if (payload != nullptr) neededSpace += payloadLength;
|
|
|
|
_data.reserve(neededSpace);
|
|
|
|
_packetId = (qos !=0) ? _getNextPacketId() : 1;
|
|
char packetIdBytes[2];
|
|
packetIdBytes[0] = _packetId >> 8;
|
|
packetIdBytes[1] = _packetId & 0xFF;
|
|
|
|
_data.insert(_data.end(), fixedHeader, fixedHeader + 1 + remainingLengthLength);
|
|
_data.insert(_data.end(), topicLengthBytes, topicLengthBytes + 2);
|
|
_data.insert(_data.end(), topic, topic + topicLength);
|
|
if (qos != 0) {
|
|
_data.insert(_data.end(), packetIdBytes, packetIdBytes + 2);
|
|
_released = false;
|
|
}
|
|
if (payload != nullptr) _data.insert(_data.end(), payload, payload + payloadLength);
|
|
}
|
|
|
|
const uint8_t* PublishOutPacket::data(size_t index) const {
|
|
return &_data.data()[index];
|
|
}
|
|
|
|
size_t PublishOutPacket::size() const {
|
|
return _data.size();
|
|
}
|
|
|
|
void PublishOutPacket::setDup() {
|
|
_data[0] |= AsyncMqttClientInternals::HeaderFlag.PUBLISH_DUP;
|
|
}
|