From 0c6e04b28d162294a7b16730872c44bfcee331c3 Mon Sep 17 00:00:00 2001
From: Matthias Ringwald <matthias@ringwald.ch>
Date: Sat, 25 Jul 2020 23:23:18 +0200
Subject: [PATCH] stm32-sx1280: implement hal_cpu

---
 port/stm32-sx1280/README.md           |  1 -
 port/stm32-sx1280/port/btstack_port.c | 20 ++++++++++++++++----
 2 files changed, 16 insertions(+), 5 deletions(-)

diff --git a/port/stm32-sx1280/README.md b/port/stm32-sx1280/README.md
index d8ba79e49..a32f86765 100644
--- a/port/stm32-sx1280/README.md
+++ b/port/stm32-sx1280/README.md
@@ -49,7 +49,6 @@ e.g. with Ozone using the provided EXAMPLE.jdebug, and run it.
 ## TODO
 
 ### General
-- handle disconnect for gatt streamer demo
 - multiple packets per connection interval
 - indicate random address in advertising pdus
 - allow to set random BD_ADDR via HCI command
diff --git a/port/stm32-sx1280/port/btstack_port.c b/port/stm32-sx1280/port/btstack_port.c
index 1f6d01991..199db55d3 100644
--- a/port/stm32-sx1280/port/btstack_port.c
+++ b/port/stm32-sx1280/port/btstack_port.c
@@ -41,9 +41,11 @@
 
 #include <string.h>
 
+// to get cpu intrinsics, .e.g __dissble_irq(), before BTstack includes to avoid re-defining UNUSED
+#include "stm32l4xx.h"
+
 #include "controller.h"
 
-//#include "debug.h"
 #include "btstack_config.h"
 #include "btstack_debug.h"
 #include "btstack_util.h"
@@ -56,6 +58,7 @@
 #include "btstack_tlv_none.h"
 #include "ble/le_device_db_tlv.h"
 
+
 void btstack_assert_failed(const char * file, uint16_t line_nr){
     printf("Assert: file %s, line %u\n", file, line_nr);
     while (1);
@@ -64,9 +67,18 @@ void btstack_assert_failed(const char * file, uint16_t line_nr){
 /** hal_cpu.h */
 
 // TODO: implement
-void hal_cpu_disable_irqs(void){}
-void hal_cpu_enable_irqs(void){}
-void hal_cpu_enable_irqs_and_sleep(void){}
+void hal_cpu_disable_irqs(void){
+    __disable_irq();
+}
+
+void hal_cpu_enable_irqs(void){
+    __enable_irq();
+}
+
+void hal_cpu_enable_irqs_and_sleep(void){
+    __enable_irq();
+    // __asm__("wfe");	// go to sleep if event flag isn't set. if set, just clear it. IRQs set event flag
+}
 
 void btstack_main(void);
 void btstack_port(void){