File content as of revision 1:70b751b7a189:

#include <stdio.h>
#include <Serial.h>

#include "mbed.h"
#include "sara_n2.h"
#include "MQTTmbed.h"
#include "MQTTSNUDP.h"
#include "MQTTSNClient.h"
#include "mbed_config.h"

Serial pc(SERIAL_TX, SERIAL_RX, 115200);
DigitalOut myled(LED1);
InterruptIn button(USER_BUTTON);
UARTSerial sara(PA_9, PA_10, 9600);
DigitalOut sara_reset(D7);

//#define INFO_TRACE(_class, _string, ...)    printf( "%8s: " _string, _class, ##__VA_ARGS__)
#undef TRACE
#define TRACE(_string, ...)    INFO_TRACE( "MQTT", _string,  ##__VA_ARGS__ )

float led_flash_rate = 0.5;

void messageArrived(MQTTSN::MessageData& md)
{
    MQTTSN::Message &message = md.message;
    TRACE("Message arrived: qos %d, retained %d, dup %d, packetid %d\n",
    		message.qos,
			message.retained,
			message.dup,
			message.id);

    TRACE("Payload %s\n", message.payload);
    char *ptr;
    float new_rate = strtof((const char*)message.payload, &ptr);
    if(new_rate > 0)
    {
    	TRACE("New rate %f\n", new_rate);
    	led_flash_rate = new_rate;
    }
}

enum eMQTTstates
{
	MQTT_SOCKET_DISCONNECTED,
	MQTT_SOCKET_CONNECTED,
	MQTT_CLIENT_CONNECTED,
	MQTT_CLIENT_PUBLISH,
	MQTT_CLIENT_SUBSCRIBED
}mMQTTstate;


SARA_N2 sara_mdm(&sara, &sara_reset);
MQTTSNUDP ipsocket = MQTTSNUDP(&sara_mdm);
MQTTSNPacket_connectData data = MQTTSNPacket_connectData_initializer;
MQTTSN_topicid topicid;
MQTTSN::QoS grantedQoS;
char topicString[64];
char publishMessage[100];

bool buttonPressed = false;

void mqtt_fsm(MQTTSN::Client<MQTTSNUDP, Countdown> *client)
{
	static int pub_count = 0;
	switch(mMQTTstate)
	{
	case MQTT_SOCKET_DISCONNECTED:
	{
		const char* hostname = MBED_CONF_APP_MQTT_SN_HOST;
		int port = MBED_CONF_APP_MQTT_SN_PORT;
		TRACE("Connecting to %s:%d\n", hostname, port);
		int socket  = ipsocket.connect((char*)hostname, port);
		if(socket >= 0)
		{
			TRACE("Socket connected - %d\n", socket);
			mMQTTstate = MQTT_SOCKET_CONNECTED;
		}
	}
	break;

	case MQTT_SOCKET_CONNECTED:
	{
		data.clientID.cstring = (char*)"NUCLEO_NB-IoT";
		data.duration = 100;
		int rc = client->connect(data);
		TRACE("Connect - %d\n", rc);
		if(rc == MQTTSN::SUCCESS)
		{
			printf("Client Connected\n");
			mMQTTstate = MQTT_CLIENT_CONNECTED;
		}
	}
	break;
	case MQTT_CLIENT_CONNECTED:
	{
		topicid.type = MQTTSN_TOPIC_TYPE_NORMAL;
		topicid.data.long_.name = topicString;
		topicid.data.long_.len = strlen(topicString);
		int rc = client->subscribe(topicid, MQTTSN::QOS1, grantedQoS, messageArrived);
		TRACE("Subscribe - %d\n", rc);
		if(rc == MQTTSN::SUCCESS)
		{
			printf("Client Subscribed\n");
			mMQTTstate = MQTT_CLIENT_PUBLISH;
		}
	}
	break;
	case MQTT_CLIENT_PUBLISH:
		{
			pub_count = 0;

			MQTTSN::Message message;
			message.qos = MQTTSN::QOS0;
			message.retained = false;
			message.dup = false;
			message.payload = (void*)publishMessage;
			message.payloadlen = strlen(publishMessage)+1;
			int rc = client->publish(topicid, message);
			if(rc == MQTTSN::SUCCESS)
			{
				TRACE("Publishes %s\n", publishMessage);
			}

			mMQTTstate = MQTT_CLIENT_SUBSCRIBED;
		}
		break;
	case MQTT_CLIENT_SUBSCRIBED:
	{
		client->yield(100);

		if(buttonPressed)
		{
			buttonPressed = false;
			mMQTTstate = MQTT_CLIENT_PUBLISH;
			sprintf(publishMessage, "Button pressed");
		}

		if(pub_count++ > 50)
		{
			mMQTTstate = MQTT_CLIENT_PUBLISH;

			static int aliveCount = 0;
			sprintf(publishMessage, "I am alive %d", aliveCount++);
		}

	}
	break;
	}
}

void pressedEvent()
{
	buttonPressed = true;
}

int main(void)
{
	printf("\n\nNUCLEO_X_SARA-N200 HelloMQTT-SN\n");
	printf("Version: 0x%08X\n", MBED_CONF_APP_VERSION);
	printf("mbed-os: %d.%d.%d\n", MBED_MAJOR_VERSION, MBED_MINOR_VERSION, MBED_PATCH_VERSION);

	strcpy(topicString, MBED_CONF_APP_TOPIC);
	sprintf(publishMessage, "NUCLEO NB-IoT online");
	MQTTSN::Client<MQTTSNUDP, Countdown> client = MQTTSN::Client<MQTTSNUDP, Countdown>(ipsocket);

	button.fall(&pressedEvent);

	while(1)
	{
		wait(led_flash_rate);
		myled = 1;
		wait(led_flash_rate);
		myled = 0;

		sara_mdm.fsm();
		mqtt_fsm(&client);
	}


	return 0;
}