-
Notifications
You must be signed in to change notification settings - Fork 0
/
ESPNOWMQTT.ino
456 lines (385 loc) · 16.5 KB
/
ESPNOWMQTT.ino
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
// ESPNOW to MQTT Gateway made for WLED
// Made for the community by Subrata Dey
// Feel Free to Edit/Use/Reuse as you see fit
#include <WiFi.h>
#include <PubSubClient.h>
#include <esp_now.h>
#include <ArduinoJson.h>
#include <WiFiManager.h>
#include <Preferences.h>
#include "wled_handler.h"
#include "esp_task_wdt.h" // To reset the ESP incase it stops responding
#include <Base64.h>
// MQTT Credentials
char mqttServer[40];
int mqttPort = 1883;
char mqttUser[40];
char mqttPassword[40];
// MQTT Topics
const char* outgoingTopic = "espnow/outgoing";
const char* incomingTopicBase = "espnow/incoming";
const char* statusTopic = "espnow/status";
// LWT Message
const char* lwtTopic = "espnow/status"; // Same topic as regular status updates
const char* lwtMessage = "offline";
// ESP-NOW Configuration
const uint8_t broadcastAddress[] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
esp_now_peer_info_t peerInfo;
// Global Variables
unsigned long startTime = millis();
uint32_t sequenceNumber = 0; // For WLED message sequencing
const unsigned long MAX_UNRESPONSIVE_TIME = 300000; // 5 minutes (adjust as needed)
unsigned long lastReceivedMessageTime = millis(); // Track last message time
// WiFi and MQTT Client
WiFiClient espClient;
PubSubClient mqttClient(espClient);
// MQTT Callback
void callback(char* topic, byte* payload, unsigned int length) {
lastReceivedMessageTime = millis(); // Update message time on each incoming MQTT message
Serial.printf("Message arrived on topic: %s\n", topic);
Serial.printf("Message length: %u bytes\n", length);
DynamicJsonDocument doc(1024);
DeserializationError error = deserializeJson(doc, payload, length);
if (error) {
Serial.printf("JSON deserialization failed: %s\n", error.c_str());
return;
}
// Extract Device Platform (or Determine Default)
String devicePlatform = determineDevicePlatform(doc);
if (devicePlatform == "unknown") {
Serial.println("Device platform not specified or unknown.");
return;
}
// Handle Platform-Specific Messages
handlePlatformMessage(devicePlatform, doc); // Pass the parsed JSON object directly
}
// Helper function to determine device platform
String determineDevicePlatform(DynamicJsonDocument& doc) {
if (doc.containsKey("device_platform")) {
return doc["device_platform"].as<String>();
} else {
return "other"; // Default platform is now "other"
}
}
// Handle platform-specific messages (WLED and "other" implementation)
void handlePlatformMessage(const String& platform, DynamicJsonDocument& doc) {
if (platform == "wiz_remote") {
// Check if 'command' field exists (for raw IR code format)
if (doc.containsKey("command")) {
String irCode = doc["command"].as<String>();
int channel = doc["channel"];
// Check if the channel is valid
if (channel >= 1 && channel <= 14) {
// Send on the specified channel
WiFi.setChannel(channel);
esp_err_t result = esp_now_send(broadcastAddress, (uint8_t*)irCode.c_str(), irCode.length());
logEspNowResult(result, irCode, channel);
} else {
// Broadcast on all channels if the channel is invalid (or 0)
esp_err_t result = ESP_OK; // Assume success initially
for (int i = 1; i <= 14; ++i) {
WiFi.setChannel(i);
delay(10);
result = esp_now_send(broadcastAddress, (uint8_t*)irCode.c_str(), irCode.length());
if (result != ESP_OK) {
break; // Stop if an error occurs on any channel
}
}
// Log the result only once after the loop
logEspNowResult(result, irCode, 0); // 0 indicates broadcast
}
} else {
// Existing code for handling button codes if 'command' is not present
handleWizMessage(doc); // Call the WLED-specific handler (assuming this function exists in your code)
}
} else if (platform == "json_remote") {
handleJsonRemoteMessage(doc);
} else if (platform == "other") {
// Handle arbitrary ESP-NOW messages
if (!doc.containsKey("command")) {
Serial.println("Missing 'command' field in JSON payload.");
return;
}
String command = doc["command"].as<String>();
int channel = doc["channel"].as<int>();
// Validate channel (0 means broadcast on all channels)
bool broadcast = (channel < 1 || channel > 14);
if (broadcast) {
Serial.println("Invalid channel. Broadcasting on all channels.");
channel = 0; // Set to 0 for status update
}
const uint8_t* commandBytes = reinterpret_cast<const uint8_t*>(command.c_str());
esp_err_t result = ESP_OK; // Assume success initially
if (broadcast) {
// Broadcast on all channels
for (int i = 1; i <= 14; ++i) {
WiFi.setChannel(i);
delay(10);
// Check result of each send operation
result = esp_now_send(broadcastAddress, commandBytes, command.length());
if (result != ESP_OK) {
break; // Stop if an error occurs on any channel
}
}
Serial.println("Broadcast ESP-NOW message on all channels");
} else {
// Send on specific channel
WiFi.setChannel(channel);
result = esp_now_send(broadcastAddress, commandBytes, command.length());
}
// Log the result only once after the loop
logEspNowResult(result, command, channel);
} else {
Serial.println("Unsupported platform: " + platform);
}
}
// Helper function to log ESP-NOW send results
void logEspNowResult(esp_err_t result, const String& command, int channel) {
if (result == ESP_OK) {
Serial.printf("Sent ESP-NOW command: %s on channel %d\n", command.c_str(), channel);
// Create status message
DynamicJsonDocument statusDoc(256);
statusDoc["platform"] = "other";
statusDoc["command"] = command;
statusDoc["channel"] = channel;
statusDoc["status"] = "success";
// Serialize and publish status message
String statusMessage;
serializeJson(statusDoc, statusMessage);
mqttClient.publish(statusTopic, statusMessage.c_str());
} else {
Serial.printf("Error sending ESP-NOW command: %s on channel %d (Error code: %d)\n", command.c_str(), channel, result);
// Create status message
DynamicJsonDocument statusDoc(256);
statusDoc["platform"] = "other";
statusDoc["command"] = command;
statusDoc["channel"] = channel;
statusDoc["status"] = "failure";
statusDoc["error_code"] = result;
// Serialize and publish status message
String statusMessage;
serializeJson(statusDoc, statusMessage);
mqttClient.publish(statusTopic, statusMessage.c_str());
}
}
// ESP-NOW Data Receive Callback
void onDataRecv(const esp_now_recv_info_t *esp_now_info, const uint8_t *data, int data_len) {
lastReceivedMessageTime = millis();
char macStr[18]; // Mac Address of the ESP which sent the message
snprintf(macStr, sizeof(macStr), "%02x:%02x:%02x:%02x:%02x:%02x", esp_now_info->src_addr[0], esp_now_info->src_addr[1], esp_now_info->src_addr[2], esp_now_info->src_addr[3], esp_now_info->src_addr[4], esp_now_info->src_addr[5]);
String topic = String(incomingTopicBase) + "/"; // Base topic for ESP-NOW messages
// Create JSON object for message
DynamicJsonDocument doc(1024);
// Attempt to parse JSON
DeserializationError error = deserializeJson(doc, (const char*)data, data_len);
if (!error) {
// Valid JSON: Add encoding and preserve existing data
doc["encoding"] = "json";
} else {
// Handle non-JSON data
bool isBinary = false;
for (int i = 0; i < data_len; i++) {
if (data[i] < 32 || data[i] > 126) {
isBinary = true;
break;
}
}
if (isBinary) {
doc["encoding"] = "binary";
doc["data"] = base64::encode(data, data_len);
} else {
doc["encoding"] = "raw";
doc["data"] = (const char*)data;
}
}
doc["device_mac"] = macStr;
doc["protocol"] = "ESPNOW";
String jsonString;
serializeJson(doc, jsonString);
mqttClient.publish(topic.c_str(), jsonString.c_str(), false);
Serial.println("Published ESP-NOW message to MQTT: " + jsonString);
}
void sendStatusUpdate() {
DynamicJsonDocument doc(256);
unsigned long uptimeSeconds = (millis() - startTime) / 1000;
doc["uptime"] = uptimeSeconds;
uint8_t mac[6];
WiFi.macAddress(mac);
char macStr[13];
snprintf(macStr, sizeof(macStr), "%02x%02x%02x%02x%02x%02x", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
doc["mac"] = macStr;
long rssi = WiFi.RSSI();
doc["rssi"] = rssi;
String output;
serializeJson(doc, output);
mqttClient.publish(statusTopic, output.c_str());
Serial.print("Sent status update: ");
Serial.println(output);
}
void setup() {
Serial.begin(115200);
// Initialize Preferences
Preferences preferences;
if (!preferences.begin("mqtt_settings", false)) {
Serial.println("Failed to initialize preferences");
return;
}
// Load MQTT Credentials from Preferences
mqttPort = preferences.getInt("mqttPort", mqttPort);
preferences.getString("mqttServer", mqttServer, sizeof(mqttServer));
preferences.getString("mqttUser", mqttUser, sizeof(mqttUser));
preferences.getString("mqttPassword", mqttPassword, sizeof(mqttPassword));
// WiFiManager Setup
WiFiManager wm;
// Add Custom Parameters for MQTT
WiFiManagerParameter custom_mqtt_server("server", "MQTT Server", mqttServer, 40);
char mqttPortStr[6];
snprintf(mqttPortStr, sizeof(mqttPortStr), "%d", mqttPort);
WiFiManagerParameter custom_mqtt_port("port", "MQTT Port", mqttPortStr, 6);
WiFiManagerParameter custom_mqtt_user("user", "MQTT User", mqttUser, 40);
WiFiManagerParameter custom_mqtt_password("password", "MQTT Password", mqttPassword, 40);
wm.addParameter(&custom_mqtt_server);
wm.addParameter(&custom_mqtt_port);
wm.addParameter(&custom_mqtt_user);
wm.addParameter(&custom_mqtt_password);
// Save Config Callback
wm.setSaveConfigCallback([&custom_mqtt_server, &custom_mqtt_port, &custom_mqtt_user, &custom_mqtt_password]() {
Preferences preferences;
if (preferences.begin("mqtt_settings", false)) {
// Save MQTT Credentials to Preferences
preferences.putInt("mqttPort", atoi(custom_mqtt_port.getValue()));
preferences.putString("mqttServer", custom_mqtt_server.getValue());
preferences.putString("mqttUser", custom_mqtt_user.getValue());
preferences.putString("mqttPassword", custom_mqtt_password.getValue());
preferences.end();
} else {
Serial.println("Failed to save preferences");
}
});
WiFi.setSleep(false);
// Print Initial WiFiManager Settings
Serial.println("\nInitial WiFiManager Settings:");
Serial.print("Server: "); Serial.println(mqttServer);
Serial.print("Port: "); Serial.println(mqttPort);
Serial.print("User: "); Serial.println(mqttUser);
Serial.println("Password: <hidden>");
// Attempt to connect to a saved network. If it fails, start the config portal
if (!wm.autoConnect("ESPNowGateway")) {
Serial.println("Failed to connect, starting config portal...");
wm.startConfigPortal("ESPNowGateway"); // Explicitly start the portal
while(true) {
wm.process(); // keep the portal running until the user has saved credentials
}
}
//Close preferences
preferences.end();
Serial.println("Connected to WiFi");
// Print Updated WiFiManager Settings
Serial.println("\nUpdated WiFiManager Settings:");
Serial.print("Server: "); Serial.println(custom_mqtt_server.getValue());
Serial.print("Port: "); Serial.println(custom_mqtt_port.getValue());
Serial.print("User: "); Serial.println(custom_mqtt_user.getValue());
Serial.println("Password: <hidden>");
// Initialize ESP-NOW
if (esp_now_init() != ESP_OK) {
Serial.println("Error initializing ESP-NOW");
return;
}
esp_now_register_recv_cb(onDataRecv);
// Register Broadcast Peer
memcpy(peerInfo.peer_addr, broadcastAddress, 6);
peerInfo.channel = 0;
peerInfo.encrypt = false;
esp_now_add_peer(&peerInfo);
// Initialize MQTT Client
mqttClient.setServer(custom_mqtt_server.getValue(), atoi(custom_mqtt_port.getValue()));
mqttClient.setCallback(callback);
// Get MAC address
uint8_t mac[6];
WiFi.macAddress(mac);
char uniqueClientId[20]; // Make it large enough to hold the MAC address
snprintf(uniqueClientId, sizeof(uniqueClientId), "ESP32Client-%02x%02x%02x%02x%02x%02x", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
// Connect to MQTT Broker
while (!mqttClient.connected()) {
Serial.println("Connecting to MQTT...");
Serial.print("MQTT Server: "); Serial.println(custom_mqtt_server.getValue());
Serial.print("MQTT Port: "); Serial.println(custom_mqtt_port.getValue());
Serial.print("MQTT User: "); Serial.println(custom_mqtt_user.getValue());
if (mqttClient.connect(uniqueClientId, custom_mqtt_user.getValue(), custom_mqtt_password.getValue(), lwtTopic, 0, true, lwtMessage)) {
Serial.println("Connected to MQTT");
Serial.print("Subscribed to MQTT Topic: ");
Serial.println(outgoingTopic);
mqttClient.subscribe(outgoingTopic);
} else {
Serial.print("Failed to connect to MQTT, rc=");
Serial.print(mqttClient.state());
Serial.println(" try again in 5 seconds");
delay(5000);
}
}
// Watchdog Timer Configuration
const int WDT_TIMEOUT = 30000; // Timeout in milliseconds (30 seconds)
esp_task_wdt_config_t wdt_config = {
.timeout_ms = WDT_TIMEOUT,
.idle_core_mask = 0,
.trigger_panic = true,
};
// Deinitialize if the watchdog timer is already running
esp_task_wdt_deinit();
// Enable and configure the watchdog timer
esp_err_t err = esp_task_wdt_init(&wdt_config);
// Add the current task (loop) to be monitored
if (err == ESP_OK) {
esp_task_wdt_add(NULL);
}
// Send Initial Status Update
sendStatusUpdate();
}
// Function to reconnect to MQTT broker
void reconnect() {
// Load MQTT Credentials from Preferences (once, before the loop)
Preferences preferences;
preferences.begin("mqtt_settings", false);
mqttPort = preferences.getInt("mqttPort", 1883);
preferences.getString("mqttServer", mqttServer, sizeof(mqttServer));
preferences.getString("mqttUser", mqttUser, sizeof(mqttUser));
preferences.getString("mqttPassword", mqttPassword, sizeof(mqttPassword));
preferences.end(); // Close preferences after loading
// Get MAC address
uint8_t mac[6];
WiFi.macAddress(mac);
char uniqueClientId[20]; // Make it large enough to hold the MAC address
snprintf(uniqueClientId, sizeof(uniqueClientId), "ESP32Client-%02x%02x%02x%02x%02x%02x", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
while (!mqttClient.connected()) {
Serial.print("Attempting MQTT connection...");
// Attempt to connect with the loaded credentials and unique client ID
if (mqttClient.connect(uniqueClientId, mqttUser, mqttPassword, lwtTopic, 0, true, lwtMessage)) {
Serial.println("connected");
mqttClient.subscribe(outgoingTopic);
} else {
Serial.print("failed, rc=");
Serial.print(mqttClient.state());
Serial.println(" try again in 5 seconds");
delay(5000);
}
}
}
// Loop Function
void loop() {
if (!mqttClient.connected()) {
reconnect(); // Attempt to reconnect
}
mqttClient.loop();
// Send Status Updates Periodically
static unsigned long lastStatusTime = 0;
if (millis() - lastStatusTime > 300000) {
sendStatusUpdate();
lastStatusTime = millis();
}
if (ESP.getFreeHeap() < 10000) { // Example threshold: 10 KB
Serial.println("WARNING: Low memory!");
mqttClient.publish("espnow/status", "memory low");
}
// Feed the Watchdog Timer
esp_task_wdt_reset();
}