From 4ae5289410eb1823f3918be4da668fae3d4dcce1 Mon Sep 17 00:00:00 2001
From: Andreas Berthoud <andreasberthoud@gmail.com>
Date: Tue, 22 Jun 2021 19:10:25 +0200
Subject: [PATCH] Add Debug_write()

---
 nucleo-wb55-usb/Core/Src/main.c              |  1 +
 nucleo-wb55-usb/USB_Device/App/usbd_cdc_if.c |  9 ++++++++-
 nucleo-wb55-usb/nucleo-wb55-usb.ioc          | 19 ++++++++++++++-----
 3 files changed, 23 insertions(+), 6 deletions(-)

diff --git a/nucleo-wb55-usb/Core/Src/main.c b/nucleo-wb55-usb/Core/Src/main.c
index 1da8a3e..8bd7484 100644
--- a/nucleo-wb55-usb/Core/Src/main.c
+++ b/nucleo-wb55-usb/Core/Src/main.c
@@ -187,6 +187,7 @@ static void MX_GPIO_Init(void)
 
   /* GPIO Ports Clock Enable */
   __HAL_RCC_GPIOA_CLK_ENABLE();
+  __HAL_RCC_GPIOB_CLK_ENABLE();
 
 }
 
diff --git a/nucleo-wb55-usb/USB_Device/App/usbd_cdc_if.c b/nucleo-wb55-usb/USB_Device/App/usbd_cdc_if.c
index 159893d..65c88d9 100644
--- a/nucleo-wb55-usb/USB_Device/App/usbd_cdc_if.c
+++ b/nucleo-wb55-usb/USB_Device/App/usbd_cdc_if.c
@@ -129,7 +129,13 @@ static int8_t CDC_Receive_FS(uint8_t* pbuf, uint32_t *Len);
 static int8_t CDC_TransmitCplt_FS(uint8_t *pbuf, uint32_t *Len, uint8_t epnum);
 
 /* USER CODE BEGIN PRIVATE_FUNCTIONS_DECLARATION */
-
+int Debug_write(uint8_t *ptr, uint16_t *Len) {
+	uint16_t i;
+	for (i=0; i<Len; i++) {
+		ITM_SendChar(*ptr++);
+	}
+	return i;
+}
 /* USER CODE END PRIVATE_FUNCTIONS_DECLARATION */
 
 /**
@@ -271,6 +277,7 @@ static int8_t CDC_Receive_FS(uint8_t* Buf, uint32_t *Len)
   USBD_CDC_SetRxBuffer(&hUsbDeviceFS, &Buf[0]);
   USBD_CDC_ReceivePacket(&hUsbDeviceFS);
   CDC_Transmit_FS(Buf, *Len);
+  Debug_write("count\n", (uint16_t)7);
   return (USBD_OK);
   /* USER CODE END 6 */
 }
diff --git a/nucleo-wb55-usb/nucleo-wb55-usb.ioc b/nucleo-wb55-usb/nucleo-wb55-usb.ioc
index 0a5b173..2118249 100644
--- a/nucleo-wb55-usb/nucleo-wb55-usb.ioc
+++ b/nucleo-wb55-usb/nucleo-wb55-usb.ioc
@@ -10,7 +10,7 @@ RCC.SAI1Freq_Value=48000000
 RCC.CortexFreq_Value=64000000
 ProjectManager.KeepUserCode=true
 Mcu.UserName=STM32WB55RGVx
-Mcu.PinsNb=5
+Mcu.PinsNb=8
 ProjectManager.NoMain=false
 USB_DEVICE.VirtualModeFS=Cdc_FS
 RCC.RFWKPFreq_Value=244.140625
@@ -32,6 +32,7 @@ RCC.SYSCLKSource=RCC_SYSCLKSOURCE_PLLCLK
 ProjectManager.StackSize=0x4000
 RCC.I2C3Freq_Value=64000000
 RCC.LPTIM1Freq_Value=64000000
+PA13.Signal=SYS_JTMS-SWDIO
 Mcu.IP4=USB_DEVICE
 RCC.FCLKCortexFreq_Value=64000000
 NVIC.SVCall_IRQn=true\:0\:0\:false\:false\:true\:false\:false
@@ -51,6 +52,8 @@ RCC.HCLKRFFreq_Value=4000000
 ProjectManager.PreviousToolchain=
 RCC.APB2TimFreq_Value=64000000
 PCC.Ble.PowerLevel=Min
+Mcu.Pin6=VP_SYS_VS_Systick
+Mcu.Pin7=VP_USB_DEVICE_VS_USB_DEVICE_CDC_FS
 ProjectManager.RegisterCallBack=
 OSC_IN.Signal=RCC_OSC_IN
 RCC.USBFreq_Value=48000000
@@ -60,18 +63,20 @@ RCC.PLLSAI1PoutputFreq_Value=48000000
 Mcu.Pin0=OSC_IN
 Mcu.Pin1=PA11
 Mcu.Pin2=PA12
-Mcu.Pin3=VP_SYS_VS_Systick
-Mcu.Pin4=VP_USB_DEVICE_VS_USB_DEVICE_CDC_FS
+Mcu.Pin3=PA13
+Mcu.Pin4=PA14
+Mcu.Pin5=PB3
 RCC.SMPSCLockSelectionVirtual=RCC_SMPSCLKSOURCE_HSI
 ProjectManager.ProjectBuild=false
 RCC.HSE_VALUE=8000000
 RCC.FCLK2Freq_Value=32000000
 NVIC.UsageFault_IRQn=true\:0\:0\:false\:false\:true\:false\:false
 NVIC.DebugMonitor_IRQn=true\:0\:0\:false\:false\:true\:false\:false
+PB3.Mode=Trace_Asynchronous_SW
 board=P-NUCLEO-WB55-Nucleo
 RCC.Cortex2Freq_Value=4000000
-RCC.VCOOutputFreq_Value=128000000
 RCC.Cortex2_Div=SYSTICK_CLKSOURCE_HCLK_DIV8
+RCC.VCOOutputFreq_Value=128000000
 NVIC.SysTick_IRQn=true\:0\:0\:false\:false\:true\:false\:true
 ProjectManager.LastFirmware=true
 RCC.SMPS1Freq_Value=16000000
@@ -83,6 +88,7 @@ MxCube.Version=6.2.1
 RCC.VCOInputFreq_Value=4000000
 PCC.Ble.DataLength=6
 RCC.I2C1Freq_Value=64000000
+PA14.Mode=Trace_Asynchronous_SW
 RCC.RNGFreq_Value=32000
 RCC.PLLSAI1QoutputFreq_Value=48000000
 RCC.ADCFreq_Value=48000000
@@ -91,6 +97,7 @@ VP_SYS_VS_Systick.Mode=SysTick
 NVIC.NonMaskableInt_IRQn=true\:0\:0\:false\:false\:true\:false\:false
 RCC.PLLRCLKFreq_Value=64000000
 NVIC.PendSV_IRQn=true\:0\:0\:false\:false\:true\:false\:false
+PA13.Mode=Trace_Asynchronous_SW
 ProjectManager.FreePins=false
 RCC.IPParameters=ADCFreq_Value,AHB2CLKDivider,AHBFreq_Value,APB1Freq_Value,APB1TimFreq_Value,APB2Freq_Value,APB2TimFreq_Value,APB3Freq_Value,Cortex2Freq_Value,Cortex2_Div,CortexFreq_Value,FCLK2Freq_Value,FCLKCortexFreq_Value,FamilyName,HCLK2Freq_Value,HCLK3Freq_Value,HCLKFreq_Value,HCLKRFFreq_Value,HSE_VALUE,HSI48_VALUE,HSI_VALUE,I2C1Freq_Value,I2C3Freq_Value,LPTIM1Freq_Value,LPTIM2Freq_Value,LPUART1Freq_Value,LSCOPinFreq_Value,LSE_VALUE,LSI_VALUE,MCO1PinFreq_Value,PLLN,PLLPoutputFreq_Value,PLLQoutputFreq_Value,PLLRCLKFreq_Value,PLLSAI1N,PLLSAI1PoutputFreq_Value,PLLSAI1QoutputFreq_Value,PLLSAI1RoutputFreq_Value,PWRFreq_Value,RFWKPFreq_Value,RNGFreq_Value,SAI1Freq_Value,SMPS1Freq_Value,SMPSCLockSelectionVirtual,SMPSCLockSelectionVirtualVirtual,SMPSDivider,SYSCLKFreq_VALUE,SYSCLKSource,USART1Freq_Value,USBFreq_Value,VCOInputFreq_Value,VCOOutputFreq_Value,VCOSAI1OutputFreq_Value
 ProjectManager.AskForMigrate=true
@@ -101,6 +108,7 @@ ProjectManager.ProjectName=nucleo-wb55-usb
 ProjectManager.UnderRoot=true
 RCC.APB3Freq_Value=4000000
 ProjectManager.CoupleFile=false
+PB3.Signal=SYS_JTDO-SWO
 RCC.SYSCLKFreq_VALUE=64000000
 Mcu.Package=VFQFPN68
 PA12.Mode=Device
@@ -115,6 +123,7 @@ RCC.LSI_VALUE=32000
 VP_SYS_VS_Systick.Signal=SYS_VS_Systick
 PA11.Signal=USB_DM
 RCC.LSCOPinFreq_Value=32000
+PA14.Signal=SYS_JTCK-SWCLK
 ProjectManager.HeapSize=0x2000
 NVIC.HardFault_IRQn=true\:0\:0\:false\:false\:true\:false\:false
 VP_USB_DEVICE_VS_USB_DEVICE_CDC_FS.Signal=USB_DEVICE_VS_USB_DEVICE_CDC_FS
@@ -122,8 +131,8 @@ NVIC.USB_LP_IRQn=true\:0\:0\:false\:false\:true\:false\:true
 ProjectManager.ComputerToolchain=false
 RCC.HSI_VALUE=16000000
 NVIC.PriorityGroup=NVIC_PRIORITYGROUP_4
-RCC.PLLPoutputFreq_Value=64000000
 RCC.PLLN=32
+RCC.PLLPoutputFreq_Value=64000000
 RCC.APB1TimFreq_Value=64000000
 NVIC.BusFault_IRQn=true\:0\:0\:false\:false\:true\:false\:false
 RCC.PWRFreq_Value=64000000