Added ESPNow Multi-Slave example (#669)
* Added ESPNow basic example * fixed meta doc for slave * refactored folder structure * bug fixes * Added Single Master Multi-Slave * updated meta docs
This commit is contained in:
parent
2b6d47ac17
commit
a66b544d18
@ -55,7 +55,10 @@ void InitESPNow() {
|
||||
// Scan for slaves in AP mode
|
||||
void ScanForSlave() {
|
||||
int8_t scanResults = WiFi.scanNetworks();
|
||||
// reset on each scan
|
||||
bool slaveFound = 0;
|
||||
memset(&slave, 0, sizeof(slave));
|
||||
|
||||
Serial.println("");
|
||||
if (scanResults == 0) {
|
||||
Serial.println("No WiFi devices in AP Mode found");
|
||||
@ -128,14 +131,6 @@ bool manageSlave() {
|
||||
// Slave already paired.
|
||||
Serial.println("Already Paired");
|
||||
return true;
|
||||
} else if (exists == ESP_ERR_ESPNOW_NOT_INIT) {
|
||||
// How did we get so far!!
|
||||
Serial.println("ESPNOW Not InitESP_ERR_ESPNOW_NOT_INIT");
|
||||
return false;
|
||||
} else if (exists == ESP_ERR_ESPNOW_ARG) {
|
||||
// Invalid Argument
|
||||
Serial.println("Invalid Argument");
|
||||
return false;
|
||||
} else {
|
||||
// Slave not paired, attempt pair
|
||||
esp_err_t addStatus = esp_now_add_peer(peer);
|
||||
@ -191,8 +186,6 @@ void deletePeer() {
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
uint8_t data = 0;
|
||||
// send data
|
||||
void sendData() {
|
||||
|
245
libraries/ESP32/examples/ESPNow/Multi-Slave/Master/Master.ino
Normal file
245
libraries/ESP32/examples/ESPNow/Multi-Slave/Master/Master.ino
Normal file
@ -0,0 +1,245 @@
|
||||
/**
|
||||
ESPNOW - Basic communication - Master
|
||||
Date: 26th September 2017
|
||||
Author: Arvind Ravulavaru <https://github.com/arvindr21>
|
||||
Purpose: ESPNow Communication between a Master ESP32 and multiple ESP32 Slaves
|
||||
Description: This sketch consists of the code for the Master module.
|
||||
Resources: (A bit outdated)
|
||||
a. https://espressif.com/sites/default/files/documentation/esp-now_user_guide_en.pdf
|
||||
b. http://www.esploradores.com/practica-6-conexion-esp-now/
|
||||
|
||||
<< This Device Master >>
|
||||
|
||||
Flow: Master
|
||||
Step 1 : ESPNow Init on Master and set it in STA mode
|
||||
Step 2 : Start scanning for Slave ESP32 (we have added a prefix of `slave` to the SSID of slave for an easy setup)
|
||||
Step 3 : Once found, add Slave as peer
|
||||
Step 4 : Register for send callback
|
||||
Step 5 : Start Transmitting data from Master to Slave(s)
|
||||
|
||||
Flow: Slave
|
||||
Step 1 : ESPNow Init on Slave
|
||||
Step 2 : Update the SSID of Slave with a prefix of `slave`
|
||||
Step 3 : Set Slave in AP mode
|
||||
Step 4 : Register for receive callback and wait for data
|
||||
Step 5 : Once data arrives, print it in the serial monitor
|
||||
|
||||
Note: Master and Slave have been defined to easily understand the setup.
|
||||
Based on the ESPNOW API, there is no concept of Master and Slave.
|
||||
Any devices can act as master or salve.
|
||||
|
||||
|
||||
// Sample Serial log with 1 master & 2 slaves
|
||||
Found 12 devices
|
||||
1: Slave:24:0A:C4:81:CF:A4 [24:0A:C4:81:CF:A5] (-44)
|
||||
3: Slave:30:AE:A4:02:6D:CC [30:AE:A4:02:6D:CD] (-55)
|
||||
2 Slave(s) found, processing..
|
||||
Processing: 24:A:C4:81:CF:A5 Status: Already Paired
|
||||
Processing: 30:AE:A4:2:6D:CD Status: Already Paired
|
||||
Sending: 9
|
||||
Send Status: Success
|
||||
Last Packet Sent to: 24:0a:c4:81:cf:a5
|
||||
Last Packet Send Status: Delivery Success
|
||||
Send Status: Success
|
||||
Last Packet Sent to: 30:ae:a4:02:6d:cd
|
||||
Last Packet Send Status: Delivery Success
|
||||
|
||||
*/
|
||||
|
||||
#include <esp_now.h>
|
||||
#include <WiFi.h>
|
||||
|
||||
// Global copy of slave
|
||||
#define NUMSLAVES 20
|
||||
esp_now_peer_info_t slaves[NUMSLAVES] = {};
|
||||
int SlaveCnt = 0;
|
||||
|
||||
#define CHANNEL 3
|
||||
#define PRINTSCANRESULTS 0
|
||||
|
||||
// Init ESP Now with fallback
|
||||
void InitESPNow() {
|
||||
if (esp_now_init() == ESP_OK) {
|
||||
Serial.println("ESPNow Init Success");
|
||||
}
|
||||
else {
|
||||
Serial.println("ESPNow Init Failed");
|
||||
// Retry InitESPNow, add a counte and then restart?
|
||||
// InitESPNow();
|
||||
// or Simply Restart
|
||||
ESP.restart();
|
||||
}
|
||||
}
|
||||
|
||||
// Scan for slaves in AP mode
|
||||
void ScanForSlave() {
|
||||
int8_t scanResults = WiFi.scanNetworks();
|
||||
//reset slaves
|
||||
memset(slaves, 0, sizeof(slaves));
|
||||
SlaveCnt = 0;
|
||||
Serial.println("");
|
||||
if (scanResults == 0) {
|
||||
Serial.println("No WiFi devices in AP Mode found");
|
||||
} else {
|
||||
Serial.print("Found "); Serial.print(scanResults); Serial.println(" devices ");
|
||||
for (int i = 0; i < scanResults; ++i) {
|
||||
// Print SSID and RSSI for each device found
|
||||
String SSID = WiFi.SSID(i);
|
||||
int32_t RSSI = WiFi.RSSI(i);
|
||||
String BSSIDstr = WiFi.BSSIDstr(i);
|
||||
|
||||
if (PRINTSCANRESULTS) {
|
||||
Serial.print(i + 1); Serial.print(": "); Serial.print(SSID); Serial.print(" ["); Serial.print(BSSIDstr); Serial.print("]"); Serial.print(" ("); Serial.print(RSSI); Serial.print(")"); Serial.println("");
|
||||
}
|
||||
delay(10);
|
||||
// Check if the current device starts with `Slave`
|
||||
if (SSID.indexOf("Slave") == 0) {
|
||||
// SSID of interest
|
||||
Serial.print(i + 1); Serial.print(": "); Serial.print(SSID); Serial.print(" ["); Serial.print(BSSIDstr); Serial.print("]"); Serial.print(" ("); Serial.print(RSSI); Serial.print(")"); Serial.println("");
|
||||
// Get BSSID => Mac Address of the Slave
|
||||
int mac[6];
|
||||
|
||||
if ( 6 == sscanf(BSSIDstr.c_str(), "%x:%x:%x:%x:%x:%x%c", &mac[0], &mac[1], &mac[2], &mac[3], &mac[4], &mac[5] ) ) {
|
||||
for (int ii = 0; ii < 6; ++ii ) {
|
||||
slaves[SlaveCnt].peer_addr[ii] = (uint8_t) mac[ii];
|
||||
}
|
||||
}
|
||||
slaves[SlaveCnt].channel = CHANNEL; // pick a channel
|
||||
slaves[SlaveCnt].encrypt = 0; // no encryption
|
||||
SlaveCnt++;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (SlaveCnt > 0) {
|
||||
Serial.print(SlaveCnt); Serial.println(" Slave(s) found, processing..");
|
||||
} else {
|
||||
Serial.println("No Slave Found, trying again.");
|
||||
}
|
||||
|
||||
// clean up ram
|
||||
WiFi.scanDelete();
|
||||
}
|
||||
|
||||
// Check if the slave is already paired with the master.
|
||||
// If not, pair the slave with master
|
||||
void manageSlave() {
|
||||
if (SlaveCnt > 0) {
|
||||
for (int i = 0; i < SlaveCnt; i++) {
|
||||
const esp_now_peer_info_t *peer = &slaves[i];
|
||||
const uint8_t *peer_addr = slaves[i].peer_addr;
|
||||
Serial.print("Processing: ");
|
||||
for (int ii = 0; ii < 6; ++ii ) {
|
||||
Serial.print((uint8_t) slaves[i].peer_addr[ii], HEX);
|
||||
if (ii != 5) Serial.print(":");
|
||||
}
|
||||
Serial.print(" Status: ");
|
||||
// check if the peer exists
|
||||
bool exists = esp_now_is_peer_exist(peer_addr);
|
||||
if (exists) {
|
||||
// Slave already paired.
|
||||
Serial.println("Already Paired");
|
||||
} else {
|
||||
// Slave not paired, attempt pair
|
||||
esp_err_t addStatus = esp_now_add_peer(peer);
|
||||
if (addStatus == ESP_OK) {
|
||||
// Pair success
|
||||
Serial.println("Pair success");
|
||||
} else if (addStatus == ESP_ERR_ESPNOW_NOT_INIT) {
|
||||
// How did we get so far!!
|
||||
Serial.println("ESPNOW Not Init");
|
||||
} else if (addStatus == ESP_ERR_ESPNOW_ARG) {
|
||||
Serial.println("Add Peer - Invalid Argument");
|
||||
} else if (addStatus == ESP_ERR_ESPNOW_FULL) {
|
||||
Serial.println("Peer list full");
|
||||
} else if (addStatus == ESP_ERR_ESPNOW_NO_MEM) {
|
||||
Serial.println("Out of memory");
|
||||
} else if (addStatus == ESP_ERR_ESPNOW_EXIST) {
|
||||
Serial.println("Peer Exists");
|
||||
} else {
|
||||
Serial.println("Not sure what happened");
|
||||
}
|
||||
delay(100);
|
||||
}
|
||||
}
|
||||
} else {
|
||||
// No slave found to process
|
||||
Serial.println("No Slave found to process");
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
uint8_t data = 0;
|
||||
// send data
|
||||
void sendData() {
|
||||
data++;
|
||||
for (int i = 0; i < SlaveCnt; i++) {
|
||||
const uint8_t *peer_addr = slaves[i].peer_addr;
|
||||
if (i == 0) { // print only for first slave
|
||||
Serial.print("Sending: ");
|
||||
Serial.println(data);
|
||||
}
|
||||
esp_err_t result = esp_now_send(peer_addr, &data, sizeof(data));
|
||||
Serial.print("Send Status: ");
|
||||
if (result == ESP_OK) {
|
||||
Serial.println("Success");
|
||||
} else if (result == ESP_ERR_ESPNOW_NOT_INIT) {
|
||||
// How did we get so far!!
|
||||
Serial.println("ESPNOW not Init.");
|
||||
} else if (result == ESP_ERR_ESPNOW_ARG) {
|
||||
Serial.println("Invalid Argument");
|
||||
} else if (result == ESP_ERR_ESPNOW_INTERNAL) {
|
||||
Serial.println("Internal Error");
|
||||
} else if (result == ESP_ERR_ESPNOW_NO_MEM) {
|
||||
Serial.println("ESP_ERR_ESPNOW_NO_MEM");
|
||||
} else if (result == ESP_ERR_ESPNOW_NOT_FOUND) {
|
||||
Serial.println("Peer not found.");
|
||||
} else {
|
||||
Serial.println("Not sure what happened");
|
||||
}
|
||||
delay(100);
|
||||
}
|
||||
}
|
||||
|
||||
// callback when data is sent from Master to Slave
|
||||
void OnDataSent(const uint8_t *mac_addr, esp_now_send_status_t status) {
|
||||
char macStr[18];
|
||||
snprintf(macStr, sizeof(macStr), "%02x:%02x:%02x:%02x:%02x:%02x",
|
||||
mac_addr[0], mac_addr[1], mac_addr[2], mac_addr[3], mac_addr[4], mac_addr[5]);
|
||||
Serial.print("Last Packet Sent to: "); Serial.println(macStr);
|
||||
Serial.print("Last Packet Send Status: "); Serial.println(status == ESP_NOW_SEND_SUCCESS ? "Delivery Success" : "Delivery Fail");
|
||||
}
|
||||
|
||||
void setup() {
|
||||
Serial.begin(115200);
|
||||
//Set device in STA mode to begin with
|
||||
WiFi.mode(WIFI_STA);
|
||||
Serial.println("ESPNow/Multi-Slave/Master Example");
|
||||
// This is the mac address of the Master in Station Mode
|
||||
Serial.print("STA MAC: "); Serial.println(WiFi.macAddress());
|
||||
// Init ESPNow with a fallback logic
|
||||
InitESPNow();
|
||||
// Once ESPNow is successfully Init, we will register for Send CB to
|
||||
// get the status of Trasnmitted packet
|
||||
esp_now_register_send_cb(OnDataSent);
|
||||
}
|
||||
|
||||
void loop() {
|
||||
// In the loop we scan for slave
|
||||
ScanForSlave();
|
||||
// If Slave is found, it would be populate in `slave` variable
|
||||
// We will check if `slave` is defined and then we proceed further
|
||||
if (SlaveCnt > 0) { // check if slave channel is defined
|
||||
// `slave` is defined
|
||||
// Add slave as peer if it has not been added already
|
||||
manageSlave();
|
||||
// pair success or already paired
|
||||
// Send data to device
|
||||
sendData();
|
||||
} else {
|
||||
// No slave found to process
|
||||
}
|
||||
|
||||
// wait for 3seconds to run the logic again
|
||||
delay(1000);
|
||||
}
|
93
libraries/ESP32/examples/ESPNow/Multi-Slave/Slave/Slave.ino
Normal file
93
libraries/ESP32/examples/ESPNow/Multi-Slave/Slave/Slave.ino
Normal file
@ -0,0 +1,93 @@
|
||||
/**
|
||||
ESPNOW - Basic communication - Slave
|
||||
Date: 26th September 2017
|
||||
Author: Arvind Ravulavaru <https://github.com/arvindr21>
|
||||
Purpose: ESPNow Communication between a Master ESP32 and multiple ESP32 Slaves
|
||||
Description: This sketch consists of the code for the Slave module.
|
||||
Resources: (A bit outdated)
|
||||
a. https://espressif.com/sites/default/files/documentation/esp-now_user_guide_en.pdf
|
||||
b. http://www.esploradores.com/practica-6-conexion-esp-now/
|
||||
|
||||
<< This Device Slave >>
|
||||
|
||||
Flow: Master
|
||||
Step 1 : ESPNow Init on Master and set it in STA mode
|
||||
Step 2 : Start scanning for Slave ESP32 (we have added a prefix of `slave` to the SSID of slave for an easy setup)
|
||||
Step 3 : Once found, add Slave as peer
|
||||
Step 4 : Register for send callback
|
||||
Step 5 : Start Transmitting data from Master to Slave(s)
|
||||
|
||||
Flow: Slave
|
||||
Step 1 : ESPNow Init on Slave
|
||||
Step 2 : Update the SSID of Slave with a prefix of `slave`
|
||||
Step 3 : Set Slave in AP mode
|
||||
Step 4 : Register for receive callback and wait for data
|
||||
Step 5 : Once data arrives, print it in the serial monitor
|
||||
|
||||
Note: Master and Slave have been defined to easily understand the setup.
|
||||
Based on the ESPNOW API, there is no concept of Master and Slave.
|
||||
Any devices can act as master or salve.
|
||||
*/
|
||||
|
||||
#include <esp_now.h>
|
||||
#include <WiFi.h>
|
||||
|
||||
#define CHANNEL 1
|
||||
|
||||
// Init ESP Now with fallback
|
||||
void InitESPNow() {
|
||||
if (esp_now_init() == ESP_OK) {
|
||||
Serial.println("ESPNow Init Success");
|
||||
}
|
||||
else {
|
||||
Serial.println("ESPNow Init Failed");
|
||||
// Retry InitESPNow, add a counte and then restart?
|
||||
// InitESPNow();
|
||||
// or Simply Restart
|
||||
ESP.restart();
|
||||
}
|
||||
}
|
||||
|
||||
// config AP SSID
|
||||
void configDeviceAP() {
|
||||
String Prefix = "Slave:";
|
||||
String Mac = WiFi.macAddress();
|
||||
String SSID = Prefix + Mac;
|
||||
String Password = "123456789";
|
||||
bool result = WiFi.softAP(SSID.c_str(), Password.c_str(), CHANNEL, 0);
|
||||
if (!result) {
|
||||
Serial.println("AP Config failed.");
|
||||
} else {
|
||||
Serial.println("AP Config Success. Broadcasting with AP: " + String(SSID));
|
||||
}
|
||||
}
|
||||
|
||||
void setup() {
|
||||
Serial.begin(115200);
|
||||
Serial.println("ESPNow/Basic/Slave Example");
|
||||
//Set device in AP mode to begin with
|
||||
WiFi.mode(WIFI_AP);
|
||||
// configure device AP mode
|
||||
configDeviceAP();
|
||||
// This is the mac address of the Slave in AP Mode
|
||||
Serial.print("AP MAC: "); Serial.println(WiFi.softAPmacAddress());
|
||||
// Init ESPNow with a fallback logic
|
||||
InitESPNow();
|
||||
// Once ESPNow is successfully Init, we will register for recv CB to
|
||||
// get recv packer info.
|
||||
esp_now_register_recv_cb(OnDataRecv);
|
||||
}
|
||||
|
||||
// callback when data is recv from Master
|
||||
void OnDataRecv(const uint8_t *mac_addr, const uint8_t *data, int data_len) {
|
||||
char macStr[18];
|
||||
snprintf(macStr, sizeof(macStr), "%02x:%02x:%02x:%02x:%02x:%02x",
|
||||
mac_addr[0], mac_addr[1], mac_addr[2], mac_addr[3], mac_addr[4], mac_addr[5]);
|
||||
Serial.print("Last Packet Recv from: "); Serial.println(macStr);
|
||||
Serial.print("Last Packet Recv Data: "); Serial.println(*data);
|
||||
Serial.println("");
|
||||
}
|
||||
|
||||
void loop() {
|
||||
// Chill
|
||||
}
|
Loading…
Reference in New Issue
Block a user