[rtl872x] Implement WiFi.selectAntenna

hal/inc/radio_hal.h

@@ -23,5 +23,5 @@
 typedef enum radio_antenna_type {
     RADIO_ANT_DEFAULT = 0, ///< Default antenna (platform-specific).
     RADIO_ANT_INTERNAL = 1, ///< Internal antenna.
-    RADIO_ANT_EXTERNAL = 2 ///< External antenna.
+    RADIO_ANT_EXTERNAL = 2, ///< External antenna.
 } radio_antenna_type;

hal/network/ncp/wifi/wlan_hal.cpp

@@ -16,6 +16,7 @@
  */
 
 #include "wlan_hal.h"
+#include "radio_common.h"
 
 #include "network/ncp/wifi/ncp.h"
 #include "network/ncp/wifi/wifi_network_manager.h"
@@ -289,14 +290,34 @@ void HAL_WLAN_notify_simple_config_done() {
 }
 
 int wlan_select_antenna(WLanSelectAntenna_TypeDef antenna) {
-    if (antenna != ANT_AUTO) {
-        return SYSTEM_ERROR_NOT_SUPPORTED;
+    radio_antenna_type new_antenna;
+
+    if (antenna == ANT_AUTO) {
+        new_antenna = RADIO_ANT_DEFAULT;
+    } else if (antenna == ANT_INTERNAL) {
+        new_antenna = RADIO_ANT_INTERNAL;
+    } else if (antenna == ANT_EXTERNAL) {
+        new_antenna = RADIO_ANT_EXTERNAL;
+    } else {
+        return SYSTEM_ERROR_NOT_SUPPORTED;    
     }
+
+    CHECK(selectRadioAntenna(new_antenna));
     return 0;
 }
 
 WLanSelectAntenna_TypeDef wlan_get_antenna(void* reserved) {
-    return ANT_AUTO;
+    radio_antenna_type antenna;
+
+    if (getRadioAntenna(&antenna) || antenna == RADIO_ANT_DEFAULT) {
+        return ANT_AUTO;
+    } else if (antenna == RADIO_ANT_INTERNAL) {
+        return ANT_INTERNAL;
+    } else if (antenna == RADIO_ANT_EXTERNAL) {
+        return ANT_EXTERNAL;
+    } else {
+        return ANT_AUTO;
+    }
 }
 
 void wlan_connect_cancel(bool called_from_isr) {

hal/src/rtl872x/radio_common.cpp

@@ -67,14 +67,14 @@ int selectAntenna(radio_antenna_type antenna) {
 #if HAL_PLATFORM_RADIO_ANTENNA_INTERNAL
     case RADIO_ANT_INTERNAL: {
         CHECK(selectInternalAntenna());
-        LOG(TRACE, "Using internal BLE antenna");
+        LOG(TRACE, "Using internal antenna");
         break;
     }
 #endif
 #if HAL_PLATFORM_RADIO_ANTENNA_EXTERNAL
     case RADIO_ANT_EXTERNAL: {
         CHECK(selectExtenalAntenna());
-        LOG(TRACE, "Using external BLE antenna");
+        LOG(TRACE, "Using external antenna");
         break;
     }
 #endif
@@ -122,4 +122,18 @@ int selectRadioAntenna(radio_antenna_type antenna) {
     return SYSTEM_ERROR_NONE;
 }
 
+int getRadioAntenna(radio_antenna_type * antenna) {
+    if (!antenna) {
+        return SYSTEM_ERROR_INVALID_ARGUMENT;
+    }
+    uint8_t dctAntenna = 0xff;
+    CHECK(dct_read_app_data_copy(DCT_RADIO_ANTENNA_OFFSET, &dctAntenna, sizeof(dctAntenna)));
+    if ((radio_antenna_type)dctAntenna <= RADIO_ANT_EXTERNAL) {
+        *antenna = (radio_antenna_type)dctAntenna;
+        return 0;
+    }
+
+    return SYSTEM_ERROR_INTERNAL;
+}
+
 } // namespace particle

hal/src/rtl872x/radio_common.h

@@ -50,4 +50,12 @@ int enableRadioAntenna();
  */
 int selectRadioAntenna(radio_antenna_type antenna);
 
+/**
+ * Return the currently configured antenna type from DCT.
+ *
+ * @param antenna Currently configured Antenna type.
+ * @return 0 on success or a negative result code in case of an error.
+ */
+int getRadioAntenna(radio_antenna_type * antenna);
+
 } // particle