From 5e74434cb8b89b62f7bc0d2a9ab90d94aa11fe4b Mon Sep 17 00:00:00 2001
From: Ulf Lilleengen <ulf@digili.no>
Date: Fri, 6 Sep 2024 09:52:26 +0200
Subject: [PATCH] Ensure modem is enabled in run()

---
 embassy-net-nrf91/src/context.rs | 12 ++++++++++++
 1 file changed, 12 insertions(+)

diff --git a/embassy-net-nrf91/src/context.rs b/embassy-net-nrf91/src/context.rs
index d5d088ec0..2f2452bd0 100644
--- a/embassy-net-nrf91/src/context.rs
+++ b/embassy-net-nrf91/src/context.rs
@@ -303,6 +303,18 @@ impl<'a> Control<'a> {
 
     /// Run a control loop for this context, ensuring that reaattach is handled.
     pub async fn run<F: Fn(&Status)>(&self, reattach: F) -> Result<(), Error> {
+        let mut cmd: [u8; 256] = [0; 256];
+        let mut buf: [u8; 256] = [0; 256];
+
+        // Make sure modem is enabled
+        let op = CommandBuilder::create_set(&mut cmd, true)
+            .named("+CFUN")
+            .with_int_parameter(1)
+            .finish()
+            .map_err(|_| Error::BufferTooSmall)?;
+
+        let n = self.control.at_command(op, &mut buf).await;
+        CommandParser::parse(&buf[..n]).expect_identifier(b"OK").finish()?;
         let status = self.wait_attached().await?;
         let mut fd = self.control.open_raw_socket().await;
         reattach(&status);