Handle Capabilities message

This was being waited for and tracked but was not actually handled. The
result meant the router never learned the capabilities of the radio and
was unable to dynamically allocate channels. This bug was discovered
through testing with dynamic channels.

Author: cujomalainey

src/MainClasses/ANTPLUS_AntPlusRouter.cpp

@@ -45,6 +45,8 @@ uint8_t AntPlusRouter::setDriver(BaseAntWithCallbacks* driver) {
     if (_ant->waitFor(cap, ANTPLUS_DRIVER_REQUEST_TIMEOUT)) {
         return ANTPLUS_MAX_CHANNEL_CHECK_FAILED;
     }
+    _ant->getResponse().getCapabilitiesMsg(cap);
+    onCapabilities(cap);
     return 0;
 }