mira/ch32v203-eth-node
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

fix: yet more wiznet bugs, reconnects, led status indicators

Browse Source
This commit is contained in:
Mira
2024-11-11 15:40:05 +06:00
parent 8fe50deeed
commit 5f9c966602
11 changed files with 208 additions and 63 deletions
Download Patch File Download Diff File Expand all files Collapse all files

3
.vscode/settings.json vendored
View File

@@ -26,6 +26,7 @@
"mqtt_handler.h": "c", "mqtt_handler.h": "c",
"cstdlib": "c", "cstdlib": "c",
"modbus_master.h": "c", "modbus_master.h": "c",
"ch32v003_gpio_branchless.h": "c" "ch32v003_gpio_branchless.h": "c",
"mqttpacket.h": "c"
} }
} }

15
include/gpio.h
View File

@@ -3,7 +3,20 @@
#include <stdint.h> #include <stdint.h>
// Function prototype for initializing GPIO // Status states
typedef enum {
LED_STATE_OFF,
LED_STATE_ON, // ok
LED_STATE_WARNING, // slow blink
LED_STATE_ERROR, // fast blink
LED_STATE_BUSY // "breathing"
} led_state_t;
// Initialize GPIO
void init_gpio(void); void init_gpio(void);
// LED status handling
void led_status_set(led_state_t state);
void led_status_process(void);
#endif // GPIO_H #endif // GPIO_H

1
include/mqtt_handler.h
View File

@@ -25,6 +25,7 @@ typedef struct {
uint32_t last_yield; uint32_t last_yield;
bool is_connected; bool is_connected;
char base_topic[64]; char base_topic[64];
bool discovery_published;
} mqtt_state_t; } mqtt_state_t;
extern char nodes_list[MAX_PAYLOAD_LENGTH]; extern char nodes_list[MAX_PAYLOAD_LENGTH];

52
lib/ioLibrary_Driver/MQTT/MQTTClient.c
View File

@@ -42,7 +42,7 @@ static int sendPacket(MQTTClient* c, int length, Timer* timer)
if (sent == length) if (sent == length)
{ {
TimerCountdown(&c->ping_timer, c->keepAliveInterval); // record the fact that we have successfully sent the packet TimerCountdown(&c->ping_timer, c->keepAliveInterval); // record the fact that we have successfully sent the packet
rc = SUCCESSS; rc = SUCCESS;
} }
else else
rc = FAILURE; rc = FAILURE;
@@ -111,8 +111,13 @@ static int readPacket(MQTTClient* c, Timer* timer)
int rem_len = 0; int rem_len = 0;
/* 1. read the header byte. This has the packet type in it */ /* 1. read the header byte. This has the packet type in it */
if (c->ipstack->mqttread(c->ipstack, c->readbuf, 1, TimerLeftMS(timer)) != 1) int read_len = c->ipstack->mqttread(c->ipstack, c->readbuf, 1, TimerLeftMS(timer));
goto exit; if (read_len == 0) { // Timeout/no data
return SUCCESS;
}
if (read_len < 0) {
return FAILURE;
}
len = 1; len = 1;
/* 2. read the remaining length. This is variable in itself */ /* 2. read the remaining length. This is variable in itself */
@@ -177,7 +182,7 @@ int deliverMessage(MQTTClient* c, MQTTString* topicName, MQTTMessage* message)
MessageData md; MessageData md;
NewMessageData(&md, topicName, message); NewMessageData(&md, topicName, message);
c->messageHandlers[i].fp(&md); c->messageHandlers[i].fp(&md);
rc = SUCCESSS; rc = SUCCESS;
} }
} }
} }
@@ -187,7 +192,7 @@ int deliverMessage(MQTTClient* c, MQTTString* topicName, MQTTMessage* message)
MessageData md; MessageData md;
NewMessageData(&md, topicName, message); NewMessageData(&md, topicName, message);
c->defaultMessageHandler(&md); c->defaultMessageHandler(&md);
rc = SUCCESSS; rc = SUCCESS;
} }
return rc; return rc;
@@ -196,14 +201,16 @@ int deliverMessage(MQTTClient* c, MQTTString* topicName, MQTTMessage* message)
int keepalive(MQTTClient* c) int keepalive(MQTTClient* c)
{ {
int rc = SUCCESSS; int rc = SUCCESS;
if (c->keepAliveInterval == 0) if (c->keepAliveInterval == 0)
{
goto exit; goto exit;
}
if (!c->isconnected) if (!c->isconnected)
{ {
rc = FAILURE; // rc = FAILURE;
goto exit; goto exit;
} }
@@ -223,7 +230,7 @@ int keepalive(MQTTClient* c)
} }
rc = sendPacket(c, len, &timer); rc = sendPacket(c, len, &timer);
if (rc == SUCCESSS) if (rc == SUCCESS)
{ {
c->ping_outstanding = 1; c->ping_outstanding = 1;
TimerCountdown(&c->ping_timer, c->keepAliveInterval); TimerCountdown(&c->ping_timer, c->keepAliveInterval);
@@ -239,14 +246,16 @@ exit:
return rc; return rc;
} }
int cycle(MQTTClient* c, Timer* timer) int cycle(MQTTClient* c, Timer* timer)
{ {
// read the socket, see what work is due // read the socket, see what work is due
unsigned short packet_type = readPacket(c, timer); int packet_type = readPacket(c, timer);
if (packet_type == FAILURE) {
return FAILURE;
}
int len = 0, int len = 0,
rc = SUCCESSS; rc = SUCCESS;
switch (packet_type) switch (packet_type)
{ {
@@ -287,7 +296,7 @@ int cycle(MQTTClient* c, Timer* timer)
rc = FAILURE; rc = FAILURE;
else if ((len = MQTTSerialize_ack(c->buf, c->buf_size, PUBREL, 0, mypacketid)) <= 0) else if ((len = MQTTSerialize_ack(c->buf, c->buf_size, PUBREL, 0, mypacketid)) <= 0)
rc = FAILURE; rc = FAILURE;
else if ((rc = sendPacket(c, len, timer)) != SUCCESSS) // send the PUBREL packet else if ((rc = sendPacket(c, len, timer)) != SUCCESS) // send the PUBREL packet
rc = FAILURE; // there was a problem rc = FAILURE; // there was a problem
if (rc == FAILURE) if (rc == FAILURE)
goto exit; // there was a problem goto exit; // there was a problem
@@ -299,9 +308,12 @@ int cycle(MQTTClient* c, Timer* timer)
c->ping_outstanding = 0; c->ping_outstanding = 0;
break; break;
} }
keepalive(c); rc = keepalive(c); // Check keepalive return value
if (rc != SUCCESS) {
return rc;
}
exit: exit:
if (rc == SUCCESSS) if (rc == SUCCESS)
rc = packet_type; rc = packet_type;
return rc; return rc;
} }
@@ -309,7 +321,7 @@ exit:
int MQTTYield(MQTTClient* c, int timeout_ms) int MQTTYield(MQTTClient* c, int timeout_ms)
{ {
int rc = SUCCESSS; int rc = SUCCESS;
Timer timer; Timer timer;
TimerInit(&timer); TimerInit(&timer);
@@ -391,7 +403,7 @@ int MQTTConnect(MQTTClient* c, MQTTPacket_connectData* options)
TimerCountdown(&c->ping_timer, c->keepAliveInterval); TimerCountdown(&c->ping_timer, c->keepAliveInterval);
if ((len = MQTTSerialize_connect(c->buf, c->buf_size, options)) <= 0) if ((len = MQTTSerialize_connect(c->buf, c->buf_size, options)) <= 0)
goto exit; goto exit;
if ((rc = sendPacket(c, len, &connect_timer)) != SUCCESSS) // send the connect packet if ((rc = sendPacket(c, len, &connect_timer)) != SUCCESS) // send the connect packet
goto exit; // there was a problem goto exit; // there was a problem
// this will be a blocking call, wait for the connack // this will be a blocking call, wait for the connack
@@ -408,7 +420,7 @@ int MQTTConnect(MQTTClient* c, MQTTPacket_connectData* options)
rc = FAILURE; rc = FAILURE;
exit: exit:
if (rc == SUCCESSS) if (rc == SUCCESS)
c->isconnected = 1; c->isconnected = 1;
#if defined(MQTT_TASK) #if defined(MQTT_TASK)
@@ -442,7 +454,7 @@ int MQTTSubscribe(MQTTClient* c, const char* topicFilter, enum QoS qos, messageH
len = MQTTSerialize_subscribe(c->buf, c->buf_size, 0, getNextPacketId(c), 1, &topic, &charQos); len = MQTTSerialize_subscribe(c->buf, c->buf_size, 0, getNextPacketId(c), 1, &topic, &charQos);
if (len <= 0) if (len <= 0)
goto exit; goto exit;
if ((rc = sendPacket(c, len, &timer)) != SUCCESSS) // send the subscribe packet if ((rc = sendPacket(c, len, &timer)) != SUCCESS) // send the subscribe packet
goto exit; // there was a problem goto exit; // there was a problem
if (waitfor(c, SUBACK, &timer) == SUBACK) // wait for suback if (waitfor(c, SUBACK, &timer) == SUBACK) // wait for suback
@@ -497,7 +509,7 @@ int MQTTUnsubscribe(MQTTClient* c, const char* topicFilter)
if ((len = MQTTSerialize_unsubscribe(c->buf, c->buf_size, 0, getNextPacketId(c), 1, &topic)) <= 0) if ((len = MQTTSerialize_unsubscribe(c->buf, c->buf_size, 0, getNextPacketId(c), 1, &topic)) <= 0)
goto exit; goto exit;
if ((rc = sendPacket(c, len, &timer)) != SUCCESSS) // send the subscribe packet if ((rc = sendPacket(c, len, &timer)) != SUCCESS) // send the subscribe packet
goto exit; // there was a problem goto exit; // there was a problem
if (waitfor(c, UNSUBACK, &timer) == UNSUBACK) if (waitfor(c, UNSUBACK, &timer) == UNSUBACK)
@@ -541,7 +553,7 @@ int MQTTPublish(MQTTClient* c, const char* topicName, MQTTMessage* message)
topic, (unsigned char*)message->payload, message->payloadlen); topic, (unsigned char*)message->payload, message->payloadlen);
if (len <= 0) if (len <= 0)
goto exit; goto exit;
if ((rc = sendPacket(c, len, &timer)) != SUCCESSS) // send the subscribe packet if ((rc = sendPacket(c, len, &timer)) != SUCCESS) // send the subscribe packet
goto exit; // there was a problem goto exit; // there was a problem
if (message->qos == QOS1) if (message->qos == QOS1)

9
lib/ioLibrary_Driver/MQTT/MQTTClient.h
View File

@@ -48,7 +48,14 @@
enum QoS { QOS0, QOS1, QOS2 }; enum QoS { QOS0, QOS1, QOS2 };
/* all failure return codes must be negative */ /* all failure return codes must be negative */
enum returnCode { BUFFER_OVERFLOW = -2, FAILURE = -1, SUCCESSS = 0 }; enum returnCode {
NO_DATA = -100, /* No data available (timeout) */
PROTOCOL_ERROR = -4, /* Invalid packet type or format */
DECODE_ERROR = -3, /* Failed to decode packet length */
BUFFER_OVERFLOW = -2, /* Buffer too small */
FAILURE = -1, /* Generic failure */
SUCCESS = 0
};
/* The Platform specific header must define the Network and Timer structures and functions /* The Platform specific header must define the Network and Timer structures and functions
* which operate on them. * which operate on them.

29
lib/onewire/onewire.c
View File

@@ -289,19 +289,19 @@ uint8_t OneWireReset(void) {
// wait until the wire is high... just in case // wait until the wire is high... just in case
do { do {
if (--retries == 0) return 0; if (--retries == 0) return 0;
Delay_Us(2); Delay_Us(ONEWIRE_RESET_RETRY_TIME);
} while (!DIRECT_READ()); } while (!DIRECT_READ());
DIRECT_WRITE_LOW(); DIRECT_WRITE_LOW();
DIRECT_MODE_OUTPUT(); // drive output low DIRECT_MODE_OUTPUT(); // drive output low
Delay_Us(480); Delay_Us(ONEWIRE_RESET_LOW_TIME);
DIRECT_MODE_INPUT(); // allow it to float DIRECT_MODE_INPUT(); // allow it to float
Delay_Us(70); Delay_Us(ONEWIRE_RESET_SAMPLE_TIME);
r = !DIRECT_READ(); r = !DIRECT_READ();
Delay_Us(410); Delay_Us(ONEWIRE_RESET_POST_TIME);
return r; return r;
} }
@@ -313,17 +313,17 @@ void OneWireWriteBit(uint8_t v) {
if (v & 1) { if (v & 1) {
DIRECT_WRITE_LOW(); DIRECT_WRITE_LOW();
DIRECT_MODE_OUTPUT(); // drive output low DIRECT_MODE_OUTPUT(); // drive output low
Delay_Us(10); Delay_Us(ONEWIRE_WRITE_1_LOW_TIME);
DIRECT_WRITE_HIGH(); // drive output high DIRECT_WRITE_HIGH(); // drive output high
Delay_Us(55); Delay_Us(ONEWIRE_WRITE_1_TOTAL_TIME - ONEWIRE_WRITE_1_LOW_TIME);
} else { } else {
DIRECT_WRITE_LOW(); DIRECT_WRITE_LOW();
DIRECT_MODE_OUTPUT(); // drive output low DIRECT_MODE_OUTPUT(); // drive output low
Delay_Us(65); Delay_Us(ONEWIRE_WRITE_0_LOW_TIME);
DIRECT_WRITE_HIGH(); // drive output high DIRECT_WRITE_HIGH(); // drive output high
Delay_Us(5); Delay_Us(ONEWIRE_WRITE_0_TOTAL_TIME - ONEWIRE_WRITE_0_LOW_TIME);
} }
} }
@@ -336,12 +336,17 @@ uint8_t OneWireReadBit(void) {
DIRECT_MODE_OUTPUT(); DIRECT_MODE_OUTPUT();
DIRECT_WRITE_LOW(); DIRECT_WRITE_LOW();
Delay_Us(3); Delay_Us(ONEWIRE_READ_INIT_LOW_TIME); // 6us initial low pulse
DIRECT_MODE_INPUT(); // let pin float, pull up will raise
Delay_Us(10); DIRECT_MODE_INPUT(); // let pin float, pull up will raise
Delay_Us(ONEWIRE_READ_SAMPLE_TIME); // 8us until sample point
r = DIRECT_READ(); r = DIRECT_READ();
Delay_Us(53); // Wait for remainder of the read timeslot
// Total - init_low - sample = 64 - 6 - 8 = 50us
Delay_Us(ONEWIRE_READ_TOTAL_TIME - ONEWIRE_READ_INIT_LOW_TIME -
ONEWIRE_READ_SAMPLE_TIME);
return r; return r;
} }

29
lib/onewire/onewire.h
View File

@@ -14,14 +14,14 @@ static inline __attribute__((always_inline)) uint8_t directRead() {
return (GPIOB->INDR & (1 << 9)) ? 1 : 0; return (GPIOB->INDR & (1 << 9)) ? 1 : 0;
} }
static inline __attribute__((always_inline)) void directModeInput() { static inline void directModeInput() {
GPIOB->CFGHR &= ~(0xF << (4 * (9 - 8))); GPIOB->CFGHR &= ~(0xF << (4 * (9 - 8)));
GPIOB->CFGHR |= (0x4 << (4 * (9 - 8))); GPIOB->CFGHR |= (GPIO_CNF_IN_FLOATING << (4 * (9 - 8)));
} }
static inline __attribute__((always_inline)) void directModeOutput() { static inline void directModeOutput() {
GPIOB->CFGHR &= ~(0xF << (4 * (9 - 8))); GPIOB->CFGHR &= ~(0xF << (4 * (9 - 8)));
GPIOB->CFGHR |= (0x3 << (4 * (9 - 8))); GPIOB->CFGHR |= ((GPIO_Speed_50MHz | GPIO_CNF_OUT_PP) << (4 * (9 - 8)));
} }
static inline __attribute__((always_inline)) void directWriteLow() { static inline __attribute__((always_inline)) void directWriteLow() {
@@ -39,6 +39,27 @@ static inline __attribute__((always_inline)) void directWriteHigh() {
#define DIRECT_MODE_OUTPUT() directModeOutput() #define DIRECT_MODE_OUTPUT() directModeOutput()
#endif #endif
// timing configuration
// time between line check retries
#define ONEWIRE_RESET_RETRY_TIME 2
// reset cycle
#define ONEWIRE_RESET_LOW_TIME 480
#define ONEWIRE_RESET_SAMPLE_TIME 60
#define ONEWIRE_RESET_POST_TIME 410
// write 1 bit
#define ONEWIRE_WRITE_1_LOW_TIME 6
#define ONEWIRE_WRITE_1_TOTAL_TIME 64
// write 0 bit
#define ONEWIRE_WRITE_0_LOW_TIME 80
#define ONEWIRE_WRITE_0_TOTAL_TIME 84
// read bit
#define ONEWIRE_READ_INIT_LOW_TIME 6
#define ONEWIRE_READ_SAMPLE_TIME 8
#define ONEWIRE_READ_TOTAL_TIME 64
// OneWire Function Declarations // OneWire Function Declarations
// Initialize the OneWire bus // Initialize the OneWire bus

82
src/gpio.c
View File

@@ -1,6 +1,28 @@
#include "gpio.h" #include "gpio.h"
#include <stdbool.h>
#include "ch32v003fun.h" #include "ch32v003fun.h"
#include "systick.h"
#define LED_BLINK_SLOW 1000 // Warning blink interval (ms)
#define LED_BLINK_FAST 500 // Error blink interval (ms)
#define LED_BREATH_PERIOD 2000 // Breathing effect period (ms)
#define STATE_STABILITY 500 // Minimum time before state change (ms)
#define LED_G (1 << 4)
#define LED_B (1 << 3)
typedef struct {
uint32_t last_update;
uint32_t stable_since;
led_state_t current_state;
led_state_t target_state;
uint8_t blink_state;
uint32_t last_blink;
} led_status_t;
static led_status_t led_status = {0};
void init_gpio(void) { void init_gpio(void) {
// Enable clock for GPIOB // Enable clock for GPIOB
@@ -11,8 +33,66 @@ void init_gpio(void) {
GPIOB->CFGLR |= ((GPIO_Speed_10MHz | GPIO_CNF_OUT_PP) << (4 * 3)) | GPIOB->CFGLR |= ((GPIO_Speed_10MHz | GPIO_CNF_OUT_PP) << (4 * 3)) |
((GPIO_Speed_10MHz | GPIO_CNF_OUT_PP) << (4 * 4)); ((GPIO_Speed_10MHz | GPIO_CNF_OUT_PP) << (4 * 4));
// XXX: SysTick debug
// GPIOB: Pin 9 as Output, Push-Pull, 10MHz // GPIOB: Pin 9 as Output, Push-Pull, 10MHz
GPIOB->CFGHR &= ~(0xF << (4 * (9 - 8))); GPIOB->CFGHR &= ~(0xF << (4 * (9 - 8)));
GPIOB->CFGHR |= (GPIO_Speed_10MHz | GPIO_CNF_OUT_PP) << (4 * (9 - 8)); GPIOB->CFGHR |= (GPIO_Speed_10MHz | GPIO_CNF_OUT_PP) << (4 * (9 - 8));
led_status.current_state = LED_STATE_OFF;
led_status.target_state = LED_STATE_OFF;
GPIOB->BSHR = LED_G | LED_B;
}
void led_status_set(led_state_t state) {
uint32_t now = millis();
// stability timer upd on state change
if (led_status.target_state != state) {
led_status.stable_since = now;
led_status.target_state = state;
}
}
static inline void leds(bool g, bool b) {
uint32_t val = (g ? LED_G << 16 : LED_G) | (b ? LED_B << 16 : LED_B);
GPIOB->BSHR = val;
}
void led_status_process(void) {
uint32_t now = millis();
if (now - led_status.stable_since < STATE_STABILITY) {
return;
}
switch (led_status.target_state) {
case LED_STATE_OFF:
GPIOB->BSHR = LED_G | LED_B;
break;
case LED_STATE_ON:
leds(1, 0); // green on, blue off
break;
case LED_STATE_WARNING:
if (now - led_status.last_blink >= LED_BLINK_SLOW) {
led_status.blink_state = !led_status.blink_state;
led_status.last_blink = now;
leds(led_status.blink_state, 0);
}
break;
case LED_STATE_ERROR:
if (now - led_status.last_blink >= LED_BLINK_FAST) {
led_status.blink_state = !led_status.blink_state;
led_status.last_blink = now;
leds(led_status.blink_state, !led_status.blink_state);
}
break;
case LED_STATE_BUSY:
bool blue_on = (now % LED_BREATH_PERIOD) < LED_BREATH_PERIOD / 2;
leds(0, blue_on);
break;
}
} }

15
src/main.c
View File

@@ -4,6 +4,7 @@
#include "config.h" #include "config.h"
#include "debug.h" #include "debug.h"
#include "dhcp.h" #include "dhcp.h"
#include "gpio.h"
#include "modbus_handler.h" #include "modbus_handler.h"
#include "mqtt_handler.h" #include "mqtt_handler.h"
#include "onewire_temp.h" #include "onewire_temp.h"
@@ -29,12 +30,8 @@ int main(void) {
configure_network(); configure_network();
dhcp_init(); dhcp_init();
// block forever until dhcp resolves
if (!wait_for_dhcp()) { wait_for_dhcp();
while (1) {
// TODO: Implement proper error handling
}
}
// init handlers // init handlers
// init sensors before mqtt so we can add them to discovery // init sensors before mqtt so we can add them to discovery
@@ -51,17 +48,19 @@ int main(void) {
while (1) { while (1) {
uint32_t current_time = millis(); uint32_t current_time = millis();
led_status_process();
dhcp_process(); dhcp_process();
mqtt_process(&mqtt_state); mqtt_process(&mqtt_state);
modbus_handler_process(); modbus_handler_process();
// TODO: doesn't make sense to convert every 1s, should be the same interval as publish // TODO: doesn't make sense to convert every 1s, should be the same interval
// as publish
if (current_time - last_temp_conversion >= CONVERSION_INTERVAL) { if (current_time - last_temp_conversion >= CONVERSION_INTERVAL) {
onewire_temp_start_parallel(); onewire_temp_start_parallel();
last_temp_conversion = current_time; last_temp_conversion = current_time;
} }
onewire_temp_process(); // Process all sensors onewire_temp_process(); // process all sensors
if (current_time - last_temp_publish >= TEMP_PUBLISH_INTERVAL) { if (current_time - last_temp_publish >= TEMP_PUBLISH_INTERVAL) {
if (mqtt_state.is_connected) { if (mqtt_state.is_connected) {

26
src/mqtt_handler.c
View File

@@ -5,13 +5,14 @@
#include <string.h> #include <string.h>
#include "debug.h" #include "debug.h"
#include "gpio.h"
#include "modbus_handler.h" #include "modbus_handler.h"
#include "onewire_temp.h" #include "onewire_temp.h"
#include "systick.h" #include "systick.h"
// MQTT // MQTT
#define MQTT_YIELD_INTERVAL 100 // 100ms between yields in main loop #define MQTT_YIELD_INTERVAL 100 // 100ms between yields in main loop
#define MQTT_MAX_PACKET_WAIT 20 // Only wait up to 20ms for packet processing #define MQTT_MAX_PACKET_WAIT 20 // Only wait up to 20ms for packet processing
#define MQTT_RECONNECT_INTERVAL 5000 // 5 seconds between reconnection attempts #define MQTT_RECONNECT_INTERVAL 5000 // 5 seconds between reconnection attempts
// Homie convention constants // Homie convention constants
@@ -26,9 +27,9 @@ char nodes_list[MAX_PAYLOAD_LENGTH];
// Parse Homie topic format: homie/node-id/device-name/property/[set|get] // Parse Homie topic format: homie/node-id/device-name/property/[set|get]
static bool parse_homie_topic(const char* topic, size_t topic_len, static bool parse_homie_topic(const char* topic, size_t topic_len,
char* device_name, size_t name_max, char* device_name, size_t name_max,
char* property, size_t prop_max, char* property, size_t prop_max,
uint8_t* is_set) { uint8_t* is_set) {
const char* segment_start = topic; const char* segment_start = topic;
const char* topic_end = topic + topic_len; const char* topic_end = topic + topic_len;
uint8_t segment = 0; uint8_t segment = 0;
@@ -359,16 +360,15 @@ void message_arrived(MessageData* md) {
void mqtt_process(mqtt_state_t* state) { void mqtt_process(mqtt_state_t* state) {
uint32_t now = millis(); uint32_t now = millis();
int rc; int rc;
static uint8_t discovery_published = 0;
if (!state->is_connected) { if (!state->is_connected) {
if (now - state->last_reconnect >= MQTT_RECONNECT_INTERVAL) { if (now - state->last_reconnect >= MQTT_RECONNECT_INTERVAL) {
rc = setup_mqtt_client(&state->network, &state->opts, &state->client); rc = setup_mqtt_client(&state->network, &state->opts, &state->client);
if (rc == 0) { if (rc == SUCCESS) {
state->is_connected = true; state->is_connected = true;
if (!discovery_published) { if (!state->discovery_published) {
publish_device_attributes(&state->client); publish_device_attributes(&state->client);
for (int i = 0; i < RS485_DEVICE_COUNT; i++) { for (int i = 0; i < RS485_DEVICE_COUNT; i++) {
@@ -379,7 +379,7 @@ void mqtt_process(mqtt_state_t* state) {
// is it worth implementing? // is it worth implementing?
onewire_temp_publish_discovery(&state->client, NODE_CONFIG.id); onewire_temp_publish_discovery(&state->client, NODE_CONFIG.id);
discovery_published = 1; state->discovery_published = 1;
} }
char sub_topic[MAX_TOPIC_LENGTH]; char sub_topic[MAX_TOPIC_LENGTH];
@@ -388,17 +388,23 @@ void mqtt_process(mqtt_state_t* state) {
rc = subscribe_to_topic(&state->client, sub_topic, QOS1, rc = subscribe_to_topic(&state->client, sub_topic, QOS1,
message_arrived); message_arrived);
if (rc != 0) { if (rc != SUCCESS) {
state->is_connected = false; state->is_connected = false;
} }
} }
state->last_reconnect = now; state->last_reconnect = now;
} }
led_status_set(LED_STATE_BUSY);
} else if (now - state->last_yield >= MQTT_YIELD_INTERVAL) { } else if (now - state->last_yield >= MQTT_YIELD_INTERVAL) {
rc = MQTTYield(&state->client, MQTT_MAX_PACKET_WAIT); rc = MQTTYield(&state->client, MQTT_MAX_PACKET_WAIT);
if (rc != 0) { if (rc != SUCCESS) {
DEBUG_PRINT("MQTT Yield failed with rc=%d, ping_outstanding=%d\n", rc,
state->client.ping_outstanding);
state->is_connected = false; state->is_connected = false;
state->discovery_published = false;
} }
state->last_yield = now; state->last_yield = now;
led_status_set(LED_STATE_ON);
} }
} }

10
src/system_init.c
View File

@@ -25,12 +25,12 @@ void init_system(void) {
} }
bool wait_for_dhcp(void) { bool wait_for_dhcp(void) {
uint32_t start = millis(); // uint32_t start = millis();
while (dhcp_get_state() != DHCP_STATE_LEASED) { while (dhcp_get_state() != DHCP_STATE_LEASED) {
if (millis() - start >= DHCP_TIMEOUT_MS) { // if (millis() - start >= DHCP_TIMEOUT_MS) {
DEBUG_PRINT("DHCP timeout\n"); // DEBUG_PRINT("DHCP timeout\n");
return false; // return false;
} // }
dhcp_process(); dhcp_process();
} }
return true; return true;