From 50e08983c584d7fccd72dd51252ad911a1f1116e Mon Sep 17 00:00:00 2001
From: Andreas Berthoud <andreasberthoud@gmail.com>
Date: Fri, 16 Jul 2021 21:59:37 +0200
Subject: [PATCH] ble-dongle: Add HSE tuning

---
 backend/defaults/config.yml                         |  4 ++--
 nucleo-wb55-dongle-ble/Core/Src/stm32wbxx_hal_msp.c | 10 +++++++++-
 2 files changed, 11 insertions(+), 3 deletions(-)

diff --git a/backend/defaults/config.yml b/backend/defaults/config.yml
index 69fff56..232414b 100644
--- a/backend/defaults/config.yml
+++ b/backend/defaults/config.yml
@@ -1,5 +1,5 @@
-# device_id: /dev/tty.usbmodem2067368F32521
-device_id: /dev/tty.usbmodem207E3283544E1
+device_id: /dev/tty.usbmodem2067368F32521
+# device_id: /dev/tty.usbmodem207E3283544E1
 baudrate: 115200
 header_size: 4
 heartbeat_interval: 1
diff --git a/nucleo-wb55-dongle-ble/Core/Src/stm32wbxx_hal_msp.c b/nucleo-wb55-dongle-ble/Core/Src/stm32wbxx_hal_msp.c
index afec4dc..b853f27 100644
--- a/nucleo-wb55-dongle-ble/Core/Src/stm32wbxx_hal_msp.c
+++ b/nucleo-wb55-dongle-ble/Core/Src/stm32wbxx_hal_msp.c
@@ -22,7 +22,7 @@
 /* Includes ------------------------------------------------------------------*/
 #include "main.h"
 /* USER CODE BEGIN Includes */
-
+#include "otp.h"
 /* USER CODE END Includes */
 
 /* Private typedef -----------------------------------------------------------*/
@@ -64,7 +64,15 @@
 void HAL_MspInit(void)
 {
   /* USER CODE BEGIN MspInit 0 */
+  OTP_ID0_t * p_otp;
 
+  /*
+  * Read HSE_Tuning from OTP 
+  */
+  p_otp = (OTP_ID0_t *) OTP_Read(0);
+  if (p_otp) {
+    LL_RCC_HSE_SetCapacitorTuning(p_otp->hse_tuning);
+  }
   /* USER CODE END MspInit 0 */
 
   __HAL_RCC_HSEM_CLK_ENABLE();