Add dynamic set profile

Author: cujomalainey

src/MainClasses/ANTPLUS_AntPlusRouter.cpp

@@ -90,6 +90,16 @@ uint8_t AntPlusRouter::getMaxChannels() {
  return _maxChannels;
 }
 
+uint8_t AntPlusRouter::addProfileToNextChannel(BaseProfile* profile) {
+ for (uint8_t i = 0; i < _maxChannels; i++) {
+ if (!_profiles[i]) {
+ setProfile(i, profile);
+ return i;
+ }
+ }
+ return 255; //TODO change this to a define
+}
+
 void AntPlusRouter::loop() {
  _ant->loop();
 }

src/MainClasses/ANTPLUS_AntPlusRouter.h

@@ -28,6 +28,12 @@ class AntPlusRouter {
  * Associates a profile with a channel
  */
  void setProfile(uint8_t channel, BaseProfile* profile);
+ /**
+ * Associates a profile with the next lowest available channel
+ * returns associated channel, if all channels full then it 
+ * returns TODO
+ */
+ uint8_t addProfileToNextChannel(BaseProfile* profile);
  /**
  * Stops a provile at the given channel
  * Unassigns channel