From 248cabd3c3c7c1000c20613f2d34d52510fc61d6 Mon Sep 17 00:00:00 2001
From: Mictronics <github@mictronics.de>
Date: Tue, 20 Aug 2024 10:13:52 +0200
Subject: [PATCH] Set RP2040 in dormant mode when deep sleep is triggered.

---
 src/platform/rp2040/main-rp2040.cpp | 7 ++++++-
 1 file changed, 6 insertions(+), 1 deletion(-)

diff --git a/src/platform/rp2040/main-rp2040.cpp b/src/platform/rp2040/main-rp2040.cpp
index af3aeadc3..6306f34c1 100644
--- a/src/platform/rp2040/main-rp2040.cpp
+++ b/src/platform/rp2040/main-rp2040.cpp
@@ -1,4 +1,5 @@
 #include "configuration.h"
+#include "hardware/xosc.h"
 #include <hardware/clocks.h>
 #include <hardware/pll.h>
 #include <pico/stdlib.h>
@@ -12,7 +13,11 @@ void setBluetoothEnable(bool enable)
 
 void cpuDeepSleep(uint32_t msecs)
 {
-    // not needed
+    /* Disable both PLL to avoid power dissipation */
+    pll_deinit(pll_sys);
+    pll_deinit(pll_usb);
+    /* Set RP2040 in dormant mode. Will not wake up. */
+    xosc_dormant();
 }
 
 void updateBatteryLevel(uint8_t level)