add Crazyflie::broadcastUriFromUnicastUri

Author: whoenig

include/crazyflie_cpp/Crazyflie.h

@@ -131,6 +131,9 @@ class Crazyflie
   static std::vector<std::string> scan(
     uint64_t address = 0xE7E7E7E7E7);
 
+  // returns the URI that can be used for broadcast communication (or empty string if there is none)
+  static std::string broadcastUriFromUnicastUri(const std::string& link_uri);
+
   const bitcraze::crazyflieLinkCpp::Connection::Statistics connectionStats() const
   {
     return m_connection.statistics();

src/Crazyflie.cpp

@@ -46,16 +46,12 @@ std::vector<std::string> Crazyflie::scan(
   return bitcraze::crazyflieLinkCpp::Connection::scan(address);
 }
 
-std::string Crazyflie::uri() const
-{
-  return m_connection.uri();
-}
-
-std::string Crazyflie::broadcastUri() const
+std::string Crazyflie::broadcastUriFromUnicastUri(
+  const std::string& link_uri)
 {
   const std::regex uri_regex("radio:\\/\\/(\\d+|\\*)\\/(\\d+)\\/(250K|1M|2M)\\/([a-fA-F0-9]+)");
   std::smatch match;
-  if (!std::regex_match(m_connection.uri(), match, uri_regex))
+  if (!std::regex_match(link_uri, match, uri_regex))
   {
     // unsupported for broadcast
     return std::string();
@@ -64,6 +60,16 @@ std::string Crazyflie::broadcastUri() const
   return "radiobroadcast://*/" + match[2].str() + "/" + match[3].str();
 }
 
+std::string Crazyflie::uri() const
+{
+  return m_connection.uri();
+}
+
+std::string Crazyflie::broadcastUri() const
+{
+  return Crazyflie::broadcastUriFromUnicastUri(uri());
+}
+
 uint64_t Crazyflie::address() const
 {
   const std::regex uri_regex("radio:\\/\\/(\\d+|\\*)\\/(\\d+)\\/(250K|1M|2M)\\/([a-fA-F0-9]+)");