From e5bc2666547d0320635fede91c76d936c56a1a90 Mon Sep 17 00:00:00 2001
From: Haobo Gu <haobogu@outlook.com>
Date: Wed, 23 Oct 2024 12:54:50 +0800
Subject: [PATCH] feat: set ospi memory mapped mode

Signed-off-by: Haobo Gu <haobogu@outlook.com>
---
 embassy-stm32/src/ospi/mod.rs | 37 +++++++++++++++++++++++++++++++++++
 1 file changed, 37 insertions(+)

diff --git a/embassy-stm32/src/ospi/mod.rs b/embassy-stm32/src/ospi/mod.rs
index e4adc4b09..0574f7816 100644
--- a/embassy-stm32/src/ospi/mod.rs
+++ b/embassy-stm32/src/ospi/mod.rs
@@ -179,6 +179,43 @@ pub struct Ospi<'d, T: Instance, M: PeriMode> {
 }
 
 impl<'d, T: Instance, M: PeriMode> Ospi<'d, T, M> {
+    pub fn enable_memory_mapped_mode(&mut self) {
+        let reg = T::REGS;
+        while reg.sr().read().busy() {
+            info!("wait ospi busy");
+        }
+    
+        reg.ccr().modify(|r| {
+            r.set_isize(crate::ospi::vals::SizeInBits::_8BIT);
+            r.set_adsize(crate::ospi::vals::SizeInBits::_24BIT);
+            r.set_admode(crate::ospi::vals::PhaseMode::ONELINE);
+            r.set_imode(crate::ospi::vals::PhaseMode::ONELINE);
+            r.set_dmode(crate::ospi::vals::PhaseMode::FOURLINES);
+        });
+    
+        reg.cr().modify(|r| {
+            r.set_fmode(crate::ospi::vals::FunctionalMode::MEMORYMAPPED);
+            r.set_dmaen(false);
+            r.set_en(true);
+        });
+    
+        // reg.tcr().modify(|r| {
+        //     r.set_dcyc(6);
+        // });
+
+    }
+    pub fn disable_memory_mapped_mode(&mut self) {
+        let reg = T::REGS;
+        while reg.sr().read().busy() {
+            info!("wait ospi busy");
+        }
+        reg.cr().modify(|r| {
+            r.set_fmode(crate::ospi::vals::FunctionalMode::INDIRECTWRITE);
+            r.set_dmaen(false);
+            r.set_en(true);
+        });
+    }
+
     fn new_inner(
         peri: impl Peripheral<P = T> + 'd,
         d0: Option<PeripheralRef<'d, AnyPin>>,