Make sure CYW43 GPIO writes also protected

Author: earlephilhower

cores/rp2040/lwip_wrap.cpp

@@ -892,9 +892,14 @@ extern "C" {
         return __real_cyw43_arch_wifi_connect_bssid_timeout_ms(ssid, bssid, pw, auth, timeout_ms);
     }
     extern int __real_cyw43_arch_wifi_connect_timeout_ms(const char *ssid, const char *pw, uint32_t auth, uint32_t timeout_ms);
-    extern "C" int __wrap_cyw43_arch_wifi_connect_timeout_ms(const char *ssid, const char *pw, uint32_t auth, uint32_t timeout_ms) {
+    int __wrap_cyw43_arch_wifi_connect_timeout_ms(const char *ssid, const char *pw, uint32_t auth, uint32_t timeout_ms) {
         return __real_cyw43_arch_wifi_connect_timeout_ms(ssid, pw, auth, timeout_ms);
     }
+    extern void __real_cyw43_arch_gpio_put(uint wl_gpio, bool value);
+    void __wrap_cyw43_arch_gpio_put(uint wl_gpio, bool value) {
+        __real_cyw43_arch_gpio_put(wl_gpio, value);
+    }
+
 
 #endif
 

lib/core_wrap.txt

@@ -92,3 +92,4 @@
 -Wl,--wrap=cyw43_schedule_internal_poll_dispatch
 -Wl,--wrap=cyw43_arch_wifi_connect_bssid_timeout_ms
 -Wl,--wrap=cyw43_arch_wifi_connect_timeout_ms
+-Wl,--wrap=cyw43_arch_gpio_put

libraries/lwIP_CYW43/src/cyw43_driver_freertos.cpp

@@ -226,4 +226,18 @@ extern "C" int __wrap_cyw43_arch_wifi_connect_timeout_ms(const char *ssid, const
     return __wrap_cyw43_arch_wifi_connect_bssid_timeout_ms(ssid, nullptr, pw, auth, timeout_ms);
 }
 
+extern "C" void __real_cyw43_arch_gpio_put(uint wl_gpio, bool value);
+void do_cyw43_arch_gpio_put(void *data) {
+    uint32_t d = (uint32_t)data;
+    uint wl_gpio = d >> 1;
+    bool value = d & 1;
+    __real_cyw43_arch_gpio_put(wl_gpio, value);
+}
+
+extern "C" void __wrap_cyw43_arch_gpio_put(uint wl_gpio, bool value) {
+    uint32_t cbdata = (wl_gpio << 1) | (value ? 1 : 0);
+    lwip_callback(do_cyw43_arch_gpio_put, (void *)cbdata);
+}
+
+
 #endif