From db9c62fa1fd5a6976c76a65bbde669bf40339909 Mon Sep 17 00:00:00 2001
From: TMRh20 <tmrh20@gmail.com>
Date: Sat, 23 Sep 2023 11:12:33 -0600
Subject: [PATCH] Preliminary MultiChannel networks

Per Issue #214
---
 RF24Network.cpp      | 47 +++++++++++++++++++++++++++++++++++++++-----
 RF24Network.h        |  4 ++++
 RF24Network_config.h |  4 ++++
 3 files changed, 50 insertions(+), 5 deletions(-)

diff --git a/RF24Network.cpp b/RF24Network.cpp
index 2ab77180..6facc0fc 100644
--- a/RF24Network.cpp
+++ b/RF24Network.cpp
@@ -54,6 +54,9 @@ ESBNetwork<radio_t>::ESBNetwork(radio_t& _radio) : radio(_radio), frame_size(MAX
     networkFlags = 0;
     returnSysMsgs = 0;
     multicastRelay = 0;
+    #if defined (multichannel)
+      baseChannel = 0;
+    #endif
 }
 #else
 template<class radio_t>
@@ -66,6 +69,9 @@ ESBNetwork<radio_t>::ESBNetwork(radio_t& _radio) : radio(_radio), next_frame(fra
     networkFlags = 0;
     returnSysMsgs = 0;
     multicastRelay = 0;
+    #if defined (multichannel)
+      baseChannel = 0;
+    #endif
 }
 #endif
 /******************************************************************/
@@ -85,6 +91,9 @@ void ESBNetwork<radio_t>::begin(uint8_t _channel, uint16_t _node_address)
     if (_channel != USE_CURRENT_CHANNEL)
         radio.setChannel(_channel);
 
+    #if defined (multichannel)
+      baseChannel = radio.getChannel();
+    #endif
     //radio.enableDynamicAck();
     radio.setAutoAck(1);
     radio.setAutoAck(0, 0);
@@ -947,8 +956,17 @@ void ESBNetwork<radio_t>::logicalToPhysicalAddress(logicalToPhysicalStruct* conv
 
     // On which pipe
     uint8_t pre_conversion_send_pipe = parent_pipe;
-
+    #if defined (multichannel)
+    uint8_t newChannel = baseChannel;
+    if(node_address){
+      newChannel -= 5;
+    }
+    #endif    
+    
     if (*directTo > TX_ROUTED) {
+        #if defined (multichannel)
+          newChannel = baseChannel;
+        #endif
         pre_conversion_send_node = *to_node;
         *multicast = 1;
         //if(*directTo == USER_TX_MULTICAST || *directTo == USER_TX_TO_PHYSICAL_ADDRESS){
@@ -968,8 +986,16 @@ void ESBNetwork<radio_t>::logicalToPhysicalAddress(logicalToPhysicalStruct* conv
         else {
             pre_conversion_send_node = direct_child_route_to(*to_node);
         }
+        #if defined (multichannel)
+          newChannel = baseChannel + 5;
+        #endif
     }
-
+    #if defined (multichannel)
+      
+      radio.setChannel(newChannel % 127);
+      //Serial.print("Set channel");
+      //Serial.println(newChannel);
+    #endif
     *to_node = pre_conversion_send_node;
     *directTo = pre_conversion_send_pipe;
 }
@@ -998,7 +1024,11 @@ bool ESBNetwork<radio_t>::write_to_pipe(uint16_t node, uint8_t pipe, bool multic
         ok = radio.txStandBy(txTimeout);
         radio.setAutoAck(0, 0);
     }
-
+    #if defined (multichannel)
+      radio.setChannel(baseChannel);
+      //Serial.print("Set channel");
+      //Serial.println(baseChannel);
+    #endif
     /*
     #if defined (__arm__) || defined (RF24_LINUX)
     IF_SERIAL_DEBUG(printf_P(PSTR("%u: MAC Sent on %x %s\n\r"), millis(), (uint32_t)out_pipe, ok ? PSTR("ok") : PSTR("failed")));
@@ -1050,18 +1080,25 @@ void ESBNetwork<radio_t>::setup_address(void)
 {
     // First, establish the node_mask
     uint16_t node_mask_check = 0xFFFF;
-#if defined(RF24NetworkMulticast)
+#if defined(RF24NetworkMulticast) || defined (multichannel)
     uint8_t count = 0;
 #endif
 
     while (node_address & node_mask_check) {
         node_mask_check <<= 3;
-#if defined(RF24NetworkMulticast)
+#if defined(RF24NetworkMulticast) || defined (multichannel)
         count++;
     }
     _multicast_level = count;
 #else
     }
+#endif
+#if defined (multichannel)
+    radio.setChannel( (baseChannel + (_multicast_level * 5)) % 127);
+    baseChannel = radio.getChannel();
+    //Serial.print("Set channel");
+    //Serial.println(baseChannel + (_multicast_level *5));
+    
 #endif
 
     node_mask = ~node_mask_check;
diff --git a/RF24Network.h b/RF24Network.h
index 09b882cd..d44b2f65 100644
--- a/RF24Network.h
+++ b/RF24Network.h
@@ -975,6 +975,10 @@ class ESBNetwork
     uint16_t levelToAddress(uint8_t level);
 #endif
 
+#if defined (multichannel)
+    uint8_t baseChannel;
+#endif
+
     /** @} */
 };
 
diff --git a/RF24Network_config.h b/RF24Network_config.h
index ae29865e..1f468c48 100644
--- a/RF24Network_config.h
+++ b/RF24Network_config.h
@@ -82,6 +82,9 @@
         #define ENABLE_DYNAMIC_PAYLOADS
     #endif // DISABLE_DYNAMIC_PAYLOADS
 
+    #define multichannel
+    
+    
     /* Debug Options */
     //#define SERIAL_DEBUG
     //#define SERIAL_DEBUG_MINIMAL
@@ -100,6 +103,7 @@
     #define DISABLE_FRAGMENTATION
     #define ENABLE_DYNAMIC_PAYLOADS
     //#define DISABLE_USER_PAYLOADS
+    #define multichannel
 #endif
 /*************************************/