Chiarificazione inserimento nuovi metodi in libreria

International Italiano Software
7

Questo è il codice della classe che utilizza le classi della gsmShied per arduino

/*
PubSubClientGSMGSM.cpp - Client per MQTT con modulo GSM.

*/

#include "PubSubClientGSM.h"

#include <string.h>

PubSubClientGSM::PubSubClientGSM() : _client() {
}

PubSubClientGSM::PubSubClientGSM(uint8_t ip, uint16_t port, void (callback)(char,uint8_t,unsigned int)) : _client() {
this->callback = callback;
this->ip = ip;
this->port = port;
}

PubSubClientGSM::PubSubClientGSM(char* domain, uint16_t port, void (callback)(char,uint8_t*,unsigned int)) : _client() {
this->callback = callback;
this->domain = domain;
this->port = port;
}

boolean PubSubClientGSM::connect(char *id) {
return connect(id,0,0,0,0);
}

boolean PubSubClientGSM::connect(char id, char willTopic, uint8_t willQos, uint8_t willRetain, char* willMessage) {
if (!connected()) {
int result = 0;

if (domain != NULL) {
result = _client.connectTCP(this->domain, this->port);
} else {
result = _client.connectTCP(this->domain, this->port);
}

if (result) {
nextMsgId = 1;
uint8_t d[9] = {0x00,0x06,'M','Q','I','s','d','p',MQTTPROTOCOLVERSION};
uint8_t length = 0;
unsigned int j;
for (j = 0;j<9;j++) {
buffer[length++] = d[j];
}
if (willTopic) {
buffer[length++] = 0x06|(willQos<<3)|(willRetain<<5);
} else {
buffer[length++] = 0x02;
}
buffer[length++] = ((MQTT_KEEPALIVE) >> 8);
buffer[length++] = ((MQTT_KEEPALIVE) & 0xff);
length = writeString(id,buffer,length);
if (willTopic) {
length = writeString(willTopic,buffer,length);
length = writeString(willMessage,buffer,length);
}
gsm.SimpleWrite(MQTTCONNECT,buffer,length);
lastOutActivity = millis();
lastInActivity = millis();

unsigned long t= millis();
if (t-lastInActivity > MQTT_KEEPALIVE*1000) {
_client.disconnectTCP();
return false;
}

uint16_t len = readPacket();

if (len == 4 && buffer[3] == 0) {
lastInActivity = millis();
pingOutstanding = false;
return true;
}
}
_client.disconnectTCP();

}
return false;
}

uint8_t PubSubClientGSM::readByte() {

return gsm.read();
}

uint16_t PubSubClientGSM::readPacket() {
uint16_t len = 0;
buffer[len++] = readByte();
uint8_t multiplier = 1;
uint16_t length = 0;
uint8_t digit = 0;
do {
digit = readByte();
buffer[len++] = digit;
length += (digit & 127) * multiplier;
multiplier *= 128;
} while ((digit & 128) != 0);

for (uint16_t i = 0;i<length;i++)
{
if (len < MQTT_MAX_PACKET_SIZE) {
buffer[len++] = readByte();
} else {
readByte();
len = 0; // This will cause the packet to be ignored.
}
}

return len;
}

boolean PubSubClientGSM::loop() {
if (!connected()) {
unsigned long t = millis();
if ((t - lastInActivity > MQTT_KEEPALIVE1000) || (t - lastOutActivity > MQTT_KEEPALIVE1000)) {
if (pingOutstanding) {
_client.disconnectTCP();
return false;
} else {
gsm.SimpleWrite(MQTTPINGREQ);
gsm.SimpleWrite((uint8_t)0);
lastOutActivity = t;
lastInActivity = t;
pingOutstanding = true;
}
}
if (connected()) {
uint16_t len = readPacket();
if (len > 0) {
lastInActivity = t;
uint8_t type = buffer[0]&0xF0;
if (type == MQTTPUBLISH) {
if (callback) {
uint16_t tl = (buffer[2]<<8)+buffer[3];
char topic[tl+1];
for (uint16_t i=0;i<tl;i++) {
topic = buffer[4+i];

  • }*
  • topic[tl] = 0;*
  • // ignore msgID - only support QoS 0 subs*
    uint8_t *payload = buffer+4+tl;
  • callback(topic,payload,len-4-tl);*
  • }*
  • } else if (type == MQTTPINGREQ) {*
  • gsm.SimpleWrite(MQTTPINGRESP);*
  • gsm.SimpleWrite((uint8_t)0);*
  • } else if (type == MQTTPINGRESP) {*
  • pingOutstanding = false;*
  • }*
  • }*
  • }*
  • return true;*
  • }*
  • return false;*
    }
    boolean PubSubClientGSM::publish(char* topic, char* payload) {
    return publish(topic,(uint8_t*)payload,strlen(payload),false);
    }
    boolean PubSubClientGSM::publish(char* topic, uint8_t* payload, unsigned int plength) {
  • return publish(topic, payload, plength, false);*
    }
    boolean PubSubClientGSM::publish(char* topic, uint8_t* payload, unsigned int plength, boolean retained) {
  • if (connected()) {*
  • uint16_t length = writeString(topic,buffer,false);*
  • uint16_t i;*
  • for (i=0;i<plength;i++) {*
    _ buffer[length++] = payload*;_
    _     }_
    uint8_t header = MQTTPUBLISH;
    _     if (retained) {_
    _     header |= 1;_
    _     }_
    _     return write(header,buffer,length);_
    _     }_
    _     return false;_
    _    }_
    boolean PubSubClientGSM::write(uint8_t header, uint8_t buf, uint16_t length) {
    * uint8_t lenBuf[4];
    uint8_t llen = 0;
    uint8_t digit;
    uint8_t pos = 0;
    uint8_t rc;
    uint8_t len = length;
    _     do {_
    _     digit = len % 128;_
    _     len = len / 128;_
    _     if (len > 0) {_
    _     digit |= 0x80;_
    _     }_
    _     lenBuf[pos++] = digit;_
    _     llen++;_
    _     } while(len>0);_
    rc = client->write(header);
    rc += client->write(lenBuf,llen);
    rc += client->write(buf,length);
    _     lastOutActivity = millis();*
    * return (rc == 1+llen+length);*
    }
    boolean PubSubClientGSM::subscribe(char* topic) {
    * if (connected()) {*
    * uint16_t length = 2;
    _     nextMsgId++;*
    * if (nextMsgId == 0) {*
    * nextMsgId = 1;*
    * }*
    * buffer[0] = nextMsgId >> 8;*
    * buffer[1] = nextMsgId - (buffer[0]<<8);*
    * length = writeString(topic, buffer,length);*
    * buffer[length++] = 0; // Only do QoS 0 subs*
    * return write(MQTTSUBSCRIBE|MQTTQOS1,buffer,length);*
    * }*
    * return false;*
    }
    void PubSubClientGSM::disconnect() {
    * gsm.SimpleWrite(MQTTDISCONNECT);*
    * gsm.SimpleWrite((uint8_t)0);
    client.disconnectTCP();
    _     lastInActivity = millis();*
    * lastOutActivity = millis();*
    }
    uint16_t PubSubClientGSM::writeString(char* string, uint8_t* buf, uint16_t pos) {
    char* idp = string;
    * uint16_t i = 0;
    _     pos += 2;*
    _ while (idp) {
    buf[pos++] = idp++;_
    _     i++;    _
    * }*
    * buf[pos-i-2] = 0;*
    * buf[pos-i-1] = i;*
    * return pos;*
    }
    boolean PubSubClientGSM::connected() {
    * int rc = (int)_client.connectedClient();
    if (!rc) client.disconnectTCP();
    _     return rc;*
    }