From cdcd9de05143827c0c138359e0b43887d64cf98f Mon Sep 17 00:00:00 2001
From: Keisuke Tottori <totto8492@gmail.com>
Date: Fri, 27 Sep 2024 17:19:35 +0900
Subject: [PATCH] Enable FPU for RP235X Core1

---
 embassy-rp/src/multicore.rs | 7 +++++++
 1 file changed, 7 insertions(+)

diff --git a/embassy-rp/src/multicore.rs b/embassy-rp/src/multicore.rs
index 9f7d77bf5..7e2e776ea 100644
--- a/embassy-rp/src/multicore.rs
+++ b/embassy-rp/src/multicore.rs
@@ -169,6 +169,13 @@ where
             interrupt::SIO_IRQ_FIFO.enable()
         };
 
+        // Enable FPU
+        #[cfg(feature = "_rp235x")]
+        unsafe {
+            let p = cortex_m::Peripherals::steal();
+            p.SCB.cpacr.modify(|cpacr| cpacr | (3 << 20) | (3 << 22));
+        }
+
         entry()
     }