publish default values on startup

Internet/MQTT/MQTTPacket/src/MQTTFormat.c

@@ -178,7 +178,9 @@ char* MQTTFormat_toClientString(char* strbuf, int32_t strbuflen, uint8_t* buf, i
       strindex = snprintf(strbuf, strbuflen, "%s", MQTTPacket_names[header.bits.type]);
       break;
   }
-	
+
+  (void) strindex;
+
   return strbuf;
 }
 
@@ -260,6 +262,7 @@ char* MQTTFormat_toServerString(char* strbuf, int32_t strbuflen, uint8_t* buf, i
       break;
   }
 
+  (void) strindex;
   strbuf[strbuflen] = '\0';
   return strbuf;
 }

compile_flags.txt

@@ -0,0 +1,18 @@
+-D
+__AVR_ATmega2560__
+-D
+F_CPU=16000000UL
+-D
+_WIZCHIP_=W5100
+-I
+/usr/lib/avr/include
+-I
+Internet
+-I
+Internet/MQTT
+-I
+Internet/MQTT/MQTTPacket/src
+-I
+Ethernet
+-I
+Ethernet/W5500

main.c

@@ -1,331 +1,346 @@
-#include <avr/io.h>
+#include <avr/io.h>
-#include <avr/interrupt.h>
+#include <avr/interrupt.h>
-#include <avr/wdt.h> // WatchDog          
+#include <avr/wdt.h> // WatchDog          
-#include <string.h>
+#include <string.h>
-
+
-#include "Ethernet/socket.h"
+#include "Ethernet/socket.h"
-#include "Ethernet/wizchip_conf.h"
+#include "Ethernet/wizchip_conf.h"
-
+
-#include "Internet/MQTT/mqtt_interface.h"
+#include "Internet/MQTT/mqtt_interface.h"
-#include "Internet/MQTT/MQTTClient.h"
+#include "Internet/MQTT/MQTTClient.h"
-
+
-#include "avrIOhelper/io-helper.h"
+#include "avrIOhelper/io-helper.h"
-#include "millis.h"
+#include "millis.h"
-#include "uart.h"
+#include "uart.h"
-#include "spi.h"
+#include "spi.h"
-#include "mqtt.h"
+#include "mqtt.h"
-
+
-#include "util/delay.h"
+#include "util/delay.h"
-
+
-#define PLC_MQTT_ENABLED 0
+#define PLC_MQTT_ENABLED 1
-
+
-Client mqtt_client;
+Client mqtt_client;
-
+
-//***********Prologue for fast WDT disable & and save reason of reset/power-up: BEGIN
+//***********Prologue for fast WDT disable & and save reason of reset/power-up: BEGIN
-uint8_t mcucsr_mirror __attribute__ ((section (".noinit")));
+uint8_t mcucsr_mirror __attribute__ ((section (".noinit")));
-
+
-// This is for fast WDT disable & and save reason of reset/power-up
+// This is for fast WDT disable & and save reason of reset/power-up
-void get_mcusr(void) \
+void get_mcusr(void) \
-         __attribute__((naked)) \
+         __attribute__((naked)) \
-         __attribute__((section(".init3")));
+         __attribute__((section(".init3")));
-void get_mcusr(void)
+void get_mcusr(void)
-{
+{
-    mcucsr_mirror = MCUSR;
+    mcucsr_mirror = MCUSR;
-    MCUSR = 0;
+    MCUSR = 0;
-    wdt_disable();
+    wdt_disable();
-}
+}
-//***********Prologue for fast WDT disable & and save reason of reset/power-up: END
+//***********Prologue for fast WDT disable & and save reason of reset/power-up: END
-
+
-
+
-//FUNC headers
+//FUNC headers
-static void avr_init(void);
+static void avr_init(void);
-void timer0_init(void);
+void timer0_init(void);
-void print_network_information(void);
+void print_network_information(void);
-
+
-void IO_LIBRARY_Init(void) {
+void IO_LIBRARY_Init(void) {
-    uint8_t bufSize[] = {2, 2, 2, 2, 2, 2, 2, 2};
+    uint8_t bufSize[] = {2, 2, 2, 2, 2, 2, 2, 2};
-
+
-    reg_wizchip_cs_cbfunc(spi_select, spi_deselect);
+    reg_wizchip_cs_cbfunc(spi_select, spi_deselect);
-    reg_wizchip_spi_cbfunc(spi_read, spi_write);
+    reg_wizchip_spi_cbfunc(spi_read, spi_write);
-    //reg_wizchip_spiburst_cbfunc(spi_rb_burst, spi_wb_burst);
+    //reg_wizchip_spiburst_cbfunc(spi_rb_burst, spi_wb_burst);
-
+
-    wizchip_init(bufSize, bufSize);
+    wizchip_init(bufSize, bufSize);
-    wizchip_setnetinfo(&netInfo);
+    wizchip_setnetinfo(&netInfo);
-    //wizchip_setinterruptmask(IK_SOCK_0);
+    //wizchip_setinterruptmask(IK_SOCK_0);
-}
+}
-
+
-#define STEP_SIZE 5
+#define STEP_SIZE 5
-#define TOP_VALUE 40
+#define TOP_VALUE 40
-void do_luefter(){
+void do_luefter(){
-    static uint8_t fan_value = TOP_VALUE*0.8;
+    static uint8_t fan_value = TOP_VALUE*0.5;
-    static uint8_t fan_state = 0;
+    static uint8_t fan_state = 0;
-
+
-    if(!read_Input(IN_ANLAGE_EIN, LEVEL)){
+
-        fan_state = 0;
+    if(!read_Input(IN_ANLAGE_EIN, LEVEL)){
-        ioHelperSetBit(outStates, LED_LUEFTER,  0);
+        fan_state = 0;
-    }
+        ioHelperSetBit(outStates, LED_LUEFTER,  0);
-    else{
+    }
-        if (read_Input(BTN_LUEFTER_EIN, RISING)) {
+    else{
-#if PLC_MQTT_ENABLED
+        if (read_Input(BTN_LUEFTER_EIN, RISING)) {
-            mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/Luefter", "ein", 3);
+#if PLC_MQTT_ENABLED
-#endif
+            mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/Luefter", "ein", 3);
-            OCR3B = TOP_VALUE/2;
+#endif
-            fan_state = 1;
+            OCR3B = TOP_VALUE/2;
-            ioHelperSetBit(outStates, LED_LUEFTER,  1);
+            fan_state = 1;
-        }
+            ioHelperSetBit(outStates, LED_LUEFTER,  1);
-
+        }
-        if (read_Input(BTN_LUEFTER_AUS, RISING)) {
+
-#if PLC_MQTT_ENABLED
+        if (read_Input(BTN_LUEFTER_AUS, RISING)) {
-            mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/Luefter", "aus", 3);
+#if PLC_MQTT_ENABLED
-#endif
+            mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/Luefter", "aus", 3);
-            fan_state = 0;
+#endif
-            ioHelperSetBit(outStates, LED_LUEFTER,  0);
+            fan_state = 0;
-        }
+            ioHelperSetBit(outStates, LED_LUEFTER,  0);
-
+        }
-        if (read_Input(BTN_LUEFTER_PLUS, RISING) && (fan_value+STEP_SIZE <= TOP_VALUE)) {
+
-            fan_value += STEP_SIZE;
+        if (read_Input(BTN_LUEFTER_PLUS, RISING) && (fan_value+STEP_SIZE <= TOP_VALUE)) {
-#if PLC_MQTT_ENABLED
+            fan_value += STEP_SIZE;
-            char _msg[3];
+#if PLC_MQTT_ENABLED
-            sprintf(_msg, "%d", fan_value);
+            char _msg[4];
-            mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/Speed", _msg, 3);
+            sprintf(_msg, "%d", fan_value * 100 / 40);
-#endif
+            mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/LuefterSpeed", _msg, 3);
-            printf("luefter %d\n\r", fan_value);
+#endif
-        }
+            printf("luefter %d\n\r", fan_value);
-
+        }
-        if (read_Input(BTN_LUEFTER_MINUS, RISING) && (fan_value-STEP_SIZE >= STEP_SIZE)) {
+
-            fan_value -= STEP_SIZE;
+        if (read_Input(BTN_LUEFTER_MINUS, RISING) && (fan_value-STEP_SIZE >= STEP_SIZE)) {
-            printf("luefter %d\n\r", fan_value);
+            fan_value -= STEP_SIZE;
-        }
+#if PLC_MQTT_ENABLED
-    }
+            char _msg[4];
-
+            sprintf(_msg, "%d", fan_value * 100 / 40);
-    if(fan_state)
+            mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/LuefterSpeed", _msg, 3);
-        OCR3B = fan_value;
+#endif
-    else
+            printf("luefter %d\n\r", fan_value);
-        OCR3B = 0;
+        }
-}
+    }
-
+
-void do_zumbach(){
+    if(fan_state)
-
+        OCR3B = fan_value;
-    if (read_Input(BTN_ZUMBACH_EIN, RISING) && read_Input(IN_ANLAGE_EIN, LEVEL)) {
+    else
-        ioHelperSetBit(outStates, SCHUETZ_ZUMBACH,  1);
+        OCR3B = 0;
-        ioHelperSetBit(outStates, LED_ZUMBACH,  1);
+}
-#if PLC_MQTT_ENABLED
+
-        mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/Zumbach", "ein", 3);
+void do_zumbach(){
-#endif
+
-    }
+    if (read_Input(BTN_ZUMBACH_EIN, RISING) && read_Input(IN_ANLAGE_EIN, LEVEL)) {
-
+        ioHelperSetBit(outStates, SCHUETZ_ZUMBACH,  1);
-    if (read_Input(BTN_ZUMBACH_AUS, RISING) || read_Input(IN_ANLAGE_EIN, FALLING)) {
+        ioHelperSetBit(outStates, LED_ZUMBACH,  1);
-        ioHelperSetBit(outStates, SCHUETZ_ZUMBACH,  0);
+#if PLC_MQTT_ENABLED
-        ioHelperSetBit(outStates, LED_ZUMBACH,  0);
+        mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/Zumbach", "ein", 3);
-#if PLC_MQTT_ENABLED
+#endif
-        mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/Zumbach", "aus", 3);
+    }
-#endif
+
-    }
+    if (read_Input(BTN_ZUMBACH_AUS, RISING) || read_Input(IN_ANLAGE_EIN, FALLING)) {
-}
+        ioHelperSetBit(outStates, SCHUETZ_ZUMBACH,  0);
-
+        ioHelperSetBit(outStates, LED_ZUMBACH,  0);
-void do_notaus(){
+#if PLC_MQTT_ENABLED
-    if(read_Input(IN_NOTAUS_ANLAGE, LEVEL) || read_Input(IN_NOTAUS_SCHRANK, LEVEL)){   // NOTAUS
+        mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/Zumbach", "aus", 3);
-            set_Output(LED_GRN_NOTAUS_SCHRANK, OFF);                                    // disable green lamps
+#endif
-            set_Output(LED_GRN_NOTAUS_ANLAGE, OFF);
+    }
-    }
+}
-
+
-    if(read_Input(IN_NOTAUS_ANLAGE, LEVEL) && read_Input(IN_NOTAUS_SCHRANK, LEVEL)){   // both activated
+void do_notaus(){
-        set_Output(LED_ROT_NOTAUS_ANLAGE, BLINK);
+    if(read_Input(IN_NOTAUS_ANLAGE, LEVEL) || read_Input(IN_NOTAUS_SCHRANK, LEVEL)){   // NOTAUS
-        set_Output(LED_ROT_NOTAUS_SCHRANK, BLINK);
+            set_Output(LED_GRN_NOTAUS_SCHRANK, OFF);                                    // disable green lamps
-    }
+            set_Output(LED_GRN_NOTAUS_ANLAGE, OFF);
-    else if(read_Input(IN_NOTAUS_ANLAGE, LEVEL)){                                      // top one activated
+    }
-        set_Output(LED_ROT_NOTAUS_ANLAGE, BLINK);
+
-        set_Output(LED_ROT_NOTAUS_SCHRANK, ON);
+    if(read_Input(IN_NOTAUS_ANLAGE, LEVEL) && read_Input(IN_NOTAUS_SCHRANK, LEVEL)){   // both activated
-    }
+        set_Output(LED_ROT_NOTAUS_ANLAGE, BLINK);
-    else if(read_Input(IN_NOTAUS_SCHRANK, LEVEL)){                                     // bottom one activated
+        set_Output(LED_ROT_NOTAUS_SCHRANK, BLINK);
-        set_Output(LED_ROT_NOTAUS_SCHRANK, BLINK);
+    }
-        set_Output(LED_ROT_NOTAUS_ANLAGE, ON);
+    else if(read_Input(IN_NOTAUS_ANLAGE, LEVEL)){                                      // top one activated
-    }
+        set_Output(LED_ROT_NOTAUS_ANLAGE, BLINK);
-    else{                                                                              // none activated
+        set_Output(LED_ROT_NOTAUS_SCHRANK, ON);
-            set_Output(LED_ROT_NOTAUS_SCHRANK, OFF);
+    }
-            set_Output(LED_ROT_NOTAUS_ANLAGE, OFF);
+    else if(read_Input(IN_NOTAUS_SCHRANK, LEVEL)){                                     // bottom one activated
-            if(read_Input(IN_ANLAGE_EIN, LEVEL)){
+        set_Output(LED_ROT_NOTAUS_SCHRANK, BLINK);
-                set_Output(LED_GRN_NOTAUS_ANLAGE, ON);
+        set_Output(LED_ROT_NOTAUS_ANLAGE, ON);
-                set_Output(LED_GRN_NOTAUS_SCHRANK, ON);
+    }
-            }
+    else{                                                                              // none activated
-            else{
+            set_Output(LED_ROT_NOTAUS_SCHRANK, OFF);
-                set_Output(LED_GRN_NOTAUS_ANLAGE, BLINK);
+            set_Output(LED_ROT_NOTAUS_ANLAGE, OFF);
-                set_Output(LED_GRN_NOTAUS_SCHRANK, BLINK);
+            if(read_Input(IN_ANLAGE_EIN, LEVEL)){
-            }
+                set_Output(LED_GRN_NOTAUS_ANLAGE, ON);
-    }
+                set_Output(LED_GRN_NOTAUS_SCHRANK, ON);
-}
+            }
-
+            else{
-int main()
+                set_Output(LED_GRN_NOTAUS_ANLAGE, ON);
-{
+                set_Output(LED_GRN_NOTAUS_SCHRANK, ON);
-    // INIT MCU
+                set_Output(LED_ROT_NOTAUS_ANLAGE, ON);
-    avr_init();
+                set_Output(LED_ROT_NOTAUS_SCHRANK, ON);
-    spi_init(); //SPI Master, MODE0, 4Mhz(DIV4), CS_PB.3=HIGH - suitable for WIZNET 5x00(1/2/5)
+            }
-    //spi_speed_tst(); / Here on SPI pins: MOSI 400Khz freq out, on SCLK 3.2MhzOUT (Witk SPI CLK 4Mhz)
+    }
-
+}
-    ioHelperInitBuffer();
+
-    ioHelperIoConf();
+int main()
-
+{
-    //Wizchip WIZ5500 Ethernet initialize
+    // INIT MCU
-    IO_LIBRARY_Init(); //After that ping must working
+    avr_init();
-    print_network_information();
+    spi_init(); //SPI Master, MODE0, 4Mhz(DIV4), CS_PB.3=HIGH - suitable for WIZNET 5x00(1/2/5)
-
+    //spi_speed_tst(); / Here on SPI pins: MOSI 400Khz freq out, on SCLK 3.2MhzOUT (Witk SPI CLK 4Mhz)
-#if PLC_MQTT_ENABLED
+
-    //****************MQTT client initialize
+    ioHelperInitBuffer();
-    //Find MQTT broker and connect with it
+    ioHelperIoConf();
-    uint8_t mqtt_buf[100];
+
-    int32_t mqtt_rc = 0;
+    //Wizchip WIZ5500 Ethernet initialize
-    Network mqtt_network;
+    IO_LIBRARY_Init(); //After that ping must working
-    mqtt_network.my_socket = SOCK_MQTT;
+    print_network_information();
-
+
-    printf(">>Trying connect to MQTT broker: %d.%d.%d.%d ..\r\n", MQTT_targetIP[0], MQTT_targetIP[1], MQTT_targetIP[2], MQTT_targetIP[3]);
+#if PLC_MQTT_ENABLED
-    NewNetwork(&mqtt_network);
+    //****************MQTT client initialize
-    ConnectNetwork(&mqtt_network, MQTT_targetIP, 1883);
+    //Find MQTT broker and connect with it
-    MQTTClient(&mqtt_client, &mqtt_network, 1000, mqtt_buf, 100, mqtt_readBuffer, MQTT_BUFFER_SIZE);
+    uint8_t mqtt_buf[100];
-
+    int32_t mqtt_rc = 0;
-    //Connection to MQTT broker
+    Network mqtt_network;
-    MQTTPacket_connectData data = MQTTPacket_connectData_initializer;
+    mqtt_network.my_socket = SOCK_MQTT;
-    data.willFlag = 0;
+
-    data.MQTTVersion = 4;//3;
+    printf(">>Trying connect to MQTT broker: %d.%d.%d.%d ..\r\n", MQTT_targetIP[0], MQTT_targetIP[1], MQTT_targetIP[2], MQTT_targetIP[3]);
-    data.clientID.cstring = (char*)"controllino";
+    NewNetwork(&mqtt_network);
-    data.username.cstring = (char*)"Messmodul";
+    ConnectNetwork(&mqtt_network, MQTT_targetIP, 1883);
-    data.password.cstring = (char*)"\0";
+    MQTTClient(&mqtt_client, &mqtt_network, 1000, mqtt_buf, 100, mqtt_readBuffer, MQTT_BUFFER_SIZE);
-    data.keepAliveInterval = 10;
+
-    data.cleansession = 1;
+    //Connection to MQTT broker
-    mqtt_rc = MQTTConnect(&mqtt_client, &data);
+    MQTTPacket_connectData data = MQTTPacket_connectData_initializer;
-    if (mqtt_rc == SUCCESSS)
+    data.willFlag = 0;
-    {
+    data.MQTTVersion = 4;//3;
-        printf("++MQTT Connected SUCCESS: %ld\r\n", mqtt_rc);
+    data.clientID.cstring = (char*)"controllino_messmodul";
-    }
+    data.username.cstring = (char*)"Messmodul";
-    else
+    data.password.cstring = (char*)"\0";
-    {
+    data.keepAliveInterval = 10;
-        printf("--MQTT Connected ERROR: %ld\r\n", mqtt_rc);
+    data.cleansession = 1;
-        //while(1); //Reboot the board
+    mqtt_rc = MQTTConnect(&mqtt_client, &data);
-    }
+    if (mqtt_rc == SUCCESSS)
-
+    {
-    // Subscribe to all topics
+        printf("++MQTT Connected SUCCESS: %ld\r\n", mqtt_rc);
-    char SubString[] = "/Filamentanlage/04_Messmodul/set/#";
+    }
-    mqtt_rc = MQTTSubscribe(&mqtt_client, SubString, QOS0, messageArrived);
+    else
-    printf("Subscribed (%s) %ld\r\n", SubString, mqtt_rc);
+    {
-#endif
+        printf("--MQTT Connected ERROR: %ld\r\n", mqtt_rc);
-
+        while(1); //Reboot the board
-
+    }
-    ioHelperSetBit(outStatesBlinking,  LED_PLC_OK,  1);
+
-
+    // Subscribe to all topics
-    uint32_t timer_blink_outs = millis();
+    char SubString[] = "/Filamentanlage/04_Messmodul/set/#";
-    uint32_t timer_send_uptime = millis();
+    mqtt_rc = MQTTSubscribe(&mqtt_client, SubString, QOS0, messageArrived);
-
+    printf("Subscribed (%s) %ld\r\n", SubString, mqtt_rc);
-    OCR3B = 127;
+#endif
-
+
-    while(1)
+
-    {
+    ioHelperSetBit(outStatesBlinking,  LED_PLC_OK,  1);
-        wdt_reset(); // WDT reset at least every sec
+
-
+    uint32_t timer_blink_outs = millis();
-        //if (flag_refresh_inStates) {
+    uint32_t timer_send_uptime = millis();
-        ioHelperReadPins();
+
-        ioHelperDebounce();
+#if PLC_MQTT_ENABLED
-        ioHelperEdgeDetector();
+    mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/Luefter", "aus", 3);
-        //    flag_refresh_inStates = 0;
+    mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/LuefterSpeed", "50", 2);
-        //}
+    mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/Zumbach", "aus", 3);
-        
+#endif
-        // Toggle all outs which are set to blinking
+
-        if(millis() - timer_blink_outs > 500){
+    while(1)
-            outStates[0] ^= outStatesBlinking[0];
+    {
-            outStates[1] ^= outStatesBlinking[1];
+        wdt_reset(); // WDT reset at least every sec
-            timer_blink_outs = millis();
+
-        }
+
-
+
-#if PLC_MQTT_ENABLED
+        //if (flag_refresh_inStates) {
-        // send misc info
+        ioHelperReadPins();
-        if(millis() - timer_send_uptime > 5000){
+        ioHelperDebounce();
-            timer_send_uptime += 5000;
+        ioHelperEdgeDetector();
-            char msg[64];
+        //    flag_refresh_inStates = 0;
-            sprintf(msg, "%ld", millis()/1000);
+        //}
-            mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/uptime", msg, strlen(msg));
+        
-        }
+        // Toggle all outs which are set to blinking
-#endif
+        if(millis() - timer_blink_outs > 500){
-
+            outStates[0] ^= outStatesBlinking[0];
-
+            outStates[1] ^= outStatesBlinking[1];
-        if(read_Input(BTN_ANLAGE_EIN, RISING)){
+            timer_blink_outs = millis();
-            printf("anlage in: %x\n\r", read_Input(IN_ANLAGE_EIN, LEVEL));
+        }
-        }
+
-        //    ioHelperSetBit(outStates, LED_GRN_NOTAUS_SCHRANK, 1);
+#if PLC_MQTT_ENABLED
-        //}
+        // send misc info
-        //else{
+        if(millis() - timer_send_uptime > 5000){
-        //    ioHelperSetBit(outStates, LED_GRN_NOTAUS_SCHRANK, 0);
+            timer_send_uptime += 5000;
-        //}
+            char msg[64];
-
+            sprintf(msg, "%ld", millis()/1000);
-        do_luefter();
+            mqtt_pub(&mqtt_client, "/Filamentanlage/04_Messmodul/state/uptime", msg, strlen(msg));
-        do_notaus();
+        }
-        do_zumbach();
+#endif
-
+
-#if PLC_MQTT_ENABLED
+
-        ioHelperSetBit(outStates, LED_BUS_OK, 1);
+        if(read_Input(BTN_ANLAGE_EIN, RISING)){
-        ioHelperSetOuts();
+            printf("anlage in: %x\n\r", read_Input(IN_ANLAGE_EIN, LEVEL));
-        MQTTYield(&mqtt_client, 10); //blocking call
+        }
-        ioHelperSetBit(outStates, LED_BUS_OK, 0);
+        //    ioHelperSetBit(outStates, LED_GRN_NOTAUS_SCHRANK, 1);
-#endif
+        //}
-        ioHelperSetOuts();
+        //else{
-    }
+        //    ioHelperSetBit(outStates, LED_GRN_NOTAUS_SCHRANK, 0);
-    return 0;
+        //}
-}
+
-
+        do_luefter();
-// Timer0
+        do_notaus();
-// 1ms IRQ
+        do_zumbach();
-// Used for millis() timing
+
-void timer0_init(void)
+#if PLC_MQTT_ENABLED
-{
+        ioHelperSetBit(outStates, LED_BUS_OK, 1);
-    TCCR0A = (1<<WGM01); //TIMER0 SET-UP: CTC MODE
+        ioHelperSetOuts();
-    TCCR0B = (1<<CS01)|(1<<CS00); // PS 1:64
+        MQTTYield(&mqtt_client, 10); //blocking call
-    OCR0A = 249; // 1ms reach for clear (16mz:64=>250kHz:250-=>1kHz)
+        ioHelperSetBit(outStates, LED_BUS_OK, 0);
-    TIMSK0 |= 1<<OCIE0A;	 //IRQ on TIMER0 output compareA
+#endif
-}
+        ioHelperSetOuts();
-
+    }
-void timer3_init(void)
+    return 0;
-{
+}
-    TCCR3A |= (1<<WGM30); // PWM Mode with ocra top
+
-    TCCR3B |= (1<<WGM33);
+// Timer0
-    OCR3A = TOP_VALUE;
+// 1ms IRQ
-
+// Used for millis() timing
-    TCCR3B |= (0<<CS32)|(1<<CS31)|(0<<CS30);       // PS 1:1
+void timer0_init(void)
-    TCCR3A |= (1<<COM3B1) | (0<<COM3B0);
+{
-    DDRE |= 1 << 4;
+    TCCR0A = (1<<WGM01); //TIMER0 SET-UP: CTC MODE
-}
+    TCCR0B = (1<<CS01)|(1<<CS00); // PS 1:64
-
+    OCR0A = 249; // 1ms reach for clear (16mz:64=>250kHz:250-=>1kHz)
-static void avr_init(void)
+    TIMSK0 |= 1<<OCIE0A;	 //IRQ on TIMER0 output compareA
-{
+}
-    // Initialize device here.
+
-    // WatchDog INIT
+void timer3_init(void)
-    wdt_enable(WDTO_8S);  // set up wdt reset interval 2 second
+{
-    wdt_reset(); // wdt reset ~ every <2000ms
+    TCCR3A |= (1<<WGM30); // PWM Mode with ocra top
-
+    TCCR3B |= (1<<WGM33);
-    timer0_init();// Timer0 millis engine init
+    OCR3A = TOP_VALUE;
-    timer3_init();
+    OCR3B = 0;
-    uart_init();
+
-
+    TCCR3B |= (0<<CS32)|(1<<CS31)|(0<<CS30);       // PS 1:1
-    sei(); //re-enable global interrupts
+    TCCR3A |= (1<<COM3B1) | (0<<COM3B0);
-
+    DDRE |= 1 << 4;
-    return;
+}
-}
+
-
+static void avr_init(void)
-void print_network_information(void)
+{
-{
+    // Initialize device here.
-
+    // WatchDog INIT
-    uint8_t tmpstr[6] = {0,};
+    wdt_enable(WDTO_8S);  // set up wdt reset interval 2 second
-    ctlwizchip(CW_GET_ID,(void*)tmpstr); // Get WIZCHIP name
+    wdt_reset(); // wdt reset ~ every <2000ms
-    printf("\r\n=======================================\r\n");
+
-    printf(" WIZnet chip:  %s \r\n", tmpstr);
+    timer0_init();// Timer0 millis engine init
-    printf("=======================================\r\n");
+    timer3_init();
-
+    uart_init();
-    wiz_NetInfo gWIZNETINFO;
+
-    wizchip_getnetinfo(&gWIZNETINFO);
+    sei(); //re-enable global interrupts
-    if (gWIZNETINFO.dhcp == NETINFO_STATIC)
+
-        printf("STATIC IP\r\n");
+    return;
-    else
+}
-        printf("DHCP IP\r\n");
+
-    printf("Mac address: %02x:%02x:%02x:%02x:%02x:%02x\n\r",gWIZNETINFO.mac[0],gWIZNETINFO.mac[1],gWIZNETINFO.mac[2],gWIZNETINFO.mac[3],gWIZNETINFO.mac[4],gWIZNETINFO.mac[5]);
+void print_network_information(void)
-    printf("IP address : %d.%d.%d.%d\n\r",gWIZNETINFO.ip[0],gWIZNETINFO.ip[1],gWIZNETINFO.ip[2],gWIZNETINFO.ip[3]);
+{
-    printf("SM Mask	   : %d.%d.%d.%d\n\r",gWIZNETINFO.sn[0],gWIZNETINFO.sn[1],gWIZNETINFO.sn[2],gWIZNETINFO.sn[3]);
+
-    printf("Gate way   : %d.%d.%d.%d\n\r",gWIZNETINFO.gw[0],gWIZNETINFO.gw[1],gWIZNETINFO.gw[2],gWIZNETINFO.gw[3]);
+    uint8_t tmpstr[6] = {0,};
-    printf("DNS Server : %d.%d.%d.%d\n\r",gWIZNETINFO.dns[0],gWIZNETINFO.dns[1],gWIZNETINFO.dns[2],gWIZNETINFO.dns[3]);
+    ctlwizchip(CW_GET_ID,(void*)tmpstr); // Get WIZCHIP name
-}
+    printf("\r\n=======================================\r\n");
-
+    printf(" WIZnet chip:  %s \r\n", tmpstr);
+    printf("=======================================\r\n");
+
+    wiz_NetInfo gWIZNETINFO;
+    wizchip_getnetinfo(&gWIZNETINFO);
+    if (gWIZNETINFO.dhcp == NETINFO_STATIC)
+        printf("STATIC IP\r\n");
+    else
+        printf("DHCP IP\r\n");
+    printf("Mac address: %02x:%02x:%02x:%02x:%02x:%02x\n\r",gWIZNETINFO.mac[0],gWIZNETINFO.mac[1],gWIZNETINFO.mac[2],gWIZNETINFO.mac[3],gWIZNETINFO.mac[4],gWIZNETINFO.mac[5]);
+    printf("IP address : %d.%d.%d.%d\n\r",gWIZNETINFO.ip[0],gWIZNETINFO.ip[1],gWIZNETINFO.ip[2],gWIZNETINFO.ip[3]);
+    printf("SM Mask	   : %d.%d.%d.%d\n\r",gWIZNETINFO.sn[0],gWIZNETINFO.sn[1],gWIZNETINFO.sn[2],gWIZNETINFO.sn[3]);
+    printf("Gate way   : %d.%d.%d.%d\n\r",gWIZNETINFO.gw[0],gWIZNETINFO.gw[1],gWIZNETINFO.gw[2],gWIZNETINFO.gw[3]);
+    printf("DNS Server : %d.%d.%d.%d\n\r",gWIZNETINFO.dns[0],gWIZNETINFO.dns[1],gWIZNETINFO.dns[2],gWIZNETINFO.dns[3]);
+}
+

mqtt.c

@@ -56,11 +56,11 @@ void mqtt_pub(Client* mqtt_client, char * mqtt_topic, char * mqtt_msg, int mqtt_
 	{
 		printf(" - ERROR\r\n");
 		//Reboot device after 20 continuous errors (~ 20sec)
-        while(1);
+        //while(1);
-		//if(mqtt_err_cnt++ > 20)
+		if(mqtt_err_cnt++ > 20)
-		//{
+		{
-		//	printf("Connection with MQTT Broker was lost!!\r\nReboot the board..\r\n");
+			printf("Connection with MQTT Broker was lost!!\r\nReboot the board..\r\n");
-		//	while(1);
+			while(1);
-		//}
+		}
 	}
 }