mirror of
https://github.com/adafruit/Adafruit_MQTT_Library.git
synced 2025-04-21 14:45:59 +03:00
143 lines
3.2 KiB
C++
143 lines
3.2 KiB
C++
#include "Adafruit_MQTT.h"
|
|
|
|
|
|
Adafruit_MQTT::Adafruit_MQTT(const char *server, uint16_t port, const PROGMEM char *cid, const PROGMEM char *user, const PROGMEM char *pass) {
|
|
servername = server;
|
|
portnum = port;
|
|
serverip = 0;
|
|
clientid = cid;
|
|
username = user;
|
|
password = pass;
|
|
}
|
|
|
|
/*
|
|
Adafruit_MQTT::Adafruit_MQTT(char *server, uint16_t port, char *cid, char *user, char *pass) {
|
|
strncpy(servername, server, SERVERNAME_SIZE);
|
|
servername[SERVERNAME_SIZE-1] = 0;
|
|
portnum = port;
|
|
serverip = 0;
|
|
|
|
strncpy(clientid, cid, CLIENTID_SIZE);
|
|
clientid[CLIENTID_SIZE-1] = 0;
|
|
|
|
strncpy(username, user, USERNAME_SIZE);
|
|
username[USERNAME_SIZE-1] = 0;
|
|
|
|
strncpy(password, pass, PASSWORD_SIZE);
|
|
password[PASSWORD_SIZE-1] = 0;
|
|
}
|
|
*/
|
|
|
|
uint8_t Adafruit_MQTT::pingPacket(uint8_t *packet) {
|
|
packet[0] = MQTT_CTRL_PINGREQ << 4;
|
|
packet[1] = 0;
|
|
return 2;
|
|
}
|
|
|
|
static uint8_t *stringprint(uint8_t *p, char *s) {
|
|
uint16_t len = strlen(s);
|
|
p[0] = len >> 8; p++;
|
|
p[0] = len & 0xFF; p++;
|
|
memcpy(p, s, len);
|
|
return p+len;
|
|
}
|
|
|
|
static uint8_t *stringprint_P(uint8_t *p, const char *s) {
|
|
uint16_t len = strlen_P(s);
|
|
/*
|
|
for (uint8_t i=0; i<len; i++) {
|
|
Serial.write(pgm_read_byte(s+i));
|
|
}
|
|
*/
|
|
p[0] = len >> 8; p++;
|
|
p[0] = len & 0xFF; p++;
|
|
strncpy_P((char *)p, s, len);
|
|
return p+len;
|
|
}
|
|
|
|
// http://docs.oasis-open.org/mqtt/mqtt/v3.1.1/os/mqtt-v3.1.1-os.html#_Toc398718028
|
|
uint8_t Adafruit_MQTT::connectPacket(uint8_t *packet) {
|
|
uint8_t *p = packet;
|
|
uint16_t len;
|
|
|
|
// fixed header, connection messsage no flags
|
|
p[0] = (MQTT_CTRL_CONNECT << 4) | 0x0;
|
|
p+=2;
|
|
// fill in packet[1] last
|
|
|
|
p = stringprint(p, "MQIsdp");
|
|
|
|
p[0] = MQTT_PROTOCOL_LEVEL;
|
|
p++;
|
|
|
|
p[0] = MQTT_CONN_CLEANSESSION;
|
|
if (pgm_read_byte(username) != 0)
|
|
p[0] |= MQTT_CONN_USERNAMEFLAG;
|
|
if (pgm_read_byte(password) != 0)
|
|
p[0] |= MQTT_CONN_PASSWORDFLAG;
|
|
p++;
|
|
// TODO: add WILL support?
|
|
|
|
p[0] = MQTT_CONN_KEEPALIVE >> 8;
|
|
p++;
|
|
p[0] = MQTT_CONN_KEEPALIVE & 0xFF;
|
|
p++;
|
|
|
|
p = stringprint_P(p, clientid);
|
|
|
|
if (pgm_read_byte(username) != 0) {
|
|
p = stringprint_P(p, username);
|
|
}
|
|
if (pgm_read_byte(password) != 0) {
|
|
p = stringprint_P(p, password);
|
|
}
|
|
|
|
len = p - packet;
|
|
|
|
packet[1] = len-2; // don't include the 2 bytes of fixed header data
|
|
|
|
return len;
|
|
}
|
|
|
|
uint8_t Adafruit_MQTT::publishPacket(uint8_t *packet, const char *topic, char *data, uint8_t qos) {
|
|
uint8_t *p = packet;
|
|
uint16_t len;
|
|
|
|
p[0] = MQTT_CTRL_PUBLISH << 4 | qos << 1;
|
|
// fill in packet[1] last
|
|
p+=2;
|
|
|
|
p = stringprint_P(p, topic);
|
|
|
|
memcpy(p, data, strlen(data));
|
|
p+=strlen(data);
|
|
len = p - packet;
|
|
packet[1] = len-2; // don't include the 2 bytes of fixed header data
|
|
return len;
|
|
}
|
|
|
|
|
|
Adafruit_MQTT_Publish::Adafruit_MQTT_Publish(Adafruit_MQTT *mqttserver, const char *feed, uint8_t q) {
|
|
mqtt = mqttserver;
|
|
topic = feed;
|
|
qos = q;
|
|
}
|
|
|
|
|
|
|
|
bool Adafruit_MQTT_Publish::publish(int32_t i) {
|
|
char payload[18];
|
|
itoa(i, payload, 10);
|
|
return mqtt->publish(topic, payload, qos);
|
|
}
|
|
|
|
bool Adafruit_MQTT_Publish::publish(uint32_t i) {
|
|
char payload[18];
|
|
itoa(i, payload, 10);
|
|
return mqtt->publish(topic, payload, qos);
|
|
}
|
|
bool Adafruit_MQTT_Publish::publish(char *payload) {
|
|
return mqtt->publish(topic, payload, qos);
|
|
}
|
|
|