wip
This commit is contained in:
File diff suppressed because it is too large
Load Diff
File diff suppressed because one or more lines are too long
37838
workspace/.metadata/.ide.log-2025-12-08.log
Normal file
37838
workspace/.metadata/.ide.log-2025-12-08.log
Normal file
File diff suppressed because one or more lines are too long
File diff suppressed because it is too large
Load Diff
@@ -11,3 +11,4 @@
|
|||||||
*** SESSION dic 07, 2025 19:18:34.790 ------------------------------------------
|
*** SESSION dic 07, 2025 19:18:34.790 ------------------------------------------
|
||||||
*** SESSION dic 08, 2025 11:52:34.203 ------------------------------------------
|
*** SESSION dic 08, 2025 11:52:34.203 ------------------------------------------
|
||||||
*** SESSION dic 08, 2025 13:49:44.543 ------------------------------------------
|
*** SESSION dic 08, 2025 13:49:44.543 ------------------------------------------
|
||||||
|
*** SESSION dic 24, 2025 16:22:32.878 ------------------------------------------
|
||||||
|
|||||||
Binary file not shown.
@@ -1,10 +1,17 @@
|
|||||||
16:16:58 **** Incremental Build of configuration Debug for project AUTOM10 ****
|
16:34:44 **** Incremental Build of configuration Debug for project AUTOM10 ****
|
||||||
make -j12 all
|
make -j12 all
|
||||||
|
arm-none-eabi-gcc "../Core/Src/cdc_int.c" -mcpu=cortex-m3 -std=gnu11 -g3 -DDEBUG -DUSE_HAL_DRIVER -DSTM32F103xB -c -I../Core/Inc -I../Drivers/STM32F1xx_HAL_Driver/Inc/Legacy -I../Drivers/STM32F1xx_HAL_Driver/Inc -I../Drivers/CMSIS/Device/ST/STM32F1xx/Include -I../Drivers/CMSIS/Include -I../USB_DEVICE/App -I../USB_DEVICE/Target -I../Middlewares/ST/STM32_USB_Device_Library/Core/Inc -I../Middlewares/ST/STM32_USB_Device_Library/Class/CDC/Inc -O0 -ffunction-sections -fdata-sections -Wall -fstack-usage -fcyclomatic-complexity -MMD -MP -MF"Core/Src/cdc_int.d" -MT"Core/Src/cdc_int.o" --specs=nano.specs -mfloat-abi=soft -mthumb -o "Core/Src/cdc_int.o"
|
||||||
|
arm-none-eabi-gcc -o "AUTOM10.elf" @"objects.list" -mcpu=cortex-m3 -T"C:\progetti\AUTOM\workspace\AUTOM10\STM32F103C8TX_FLASH.ld" --specs=nosys.specs -Wl,-Map="AUTOM10.map" -Wl,--gc-sections -static --specs=nano.specs -mfloat-abi=soft -mthumb -Wl,--start-group -lc -lm -Wl,--end-group
|
||||||
|
Finished building target: AUTOM10.elf
|
||||||
|
|
||||||
arm-none-eabi-size AUTOM10.elf
|
arm-none-eabi-size AUTOM10.elf
|
||||||
|
arm-none-eabi-objdump -h -S AUTOM10.elf > "AUTOM10.list"
|
||||||
text data bss dec hex filename
|
text data bss dec hex filename
|
||||||
48728 464 7248 56440 dc78 AUTOM10.elf
|
48788 464 7248 56500 dcb4 AUTOM10.elf
|
||||||
Finished building: default.size.stdout
|
Finished building: default.size.stdout
|
||||||
|
|
||||||
|
Finished building: AUTOM10.list
|
||||||
|
|
||||||
16:16:58 Build Finished. 0 errors, 0 warnings. (took 242ms)
|
|
||||||
|
16:34:45 Build Finished. 0 errors, 0 warnings. (took 806ms)
|
||||||
|
|
||||||
|
|||||||
@@ -1,4 +1,4 @@
|
|||||||
16:16:54 **** Incremental Build of configuration Debug for project AUTOM10 ****
|
16:32:16 **** Incremental Build of configuration Debug for project AUTOM10 ****
|
||||||
make -j12 all
|
make -j12 all
|
||||||
arm-none-eabi-gcc "../Core/Src/cdc_int.c" -mcpu=cortex-m3 -std=gnu11 -g3 -DDEBUG -DUSE_HAL_DRIVER -DSTM32F103xB -c -I../Core/Inc -I../Drivers/STM32F1xx_HAL_Driver/Inc/Legacy -I../Drivers/STM32F1xx_HAL_Driver/Inc -I../Drivers/CMSIS/Device/ST/STM32F1xx/Include -I../Drivers/CMSIS/Include -I../USB_DEVICE/App -I../USB_DEVICE/Target -I../Middlewares/ST/STM32_USB_Device_Library/Core/Inc -I../Middlewares/ST/STM32_USB_Device_Library/Class/CDC/Inc -O0 -ffunction-sections -fdata-sections -Wall -fstack-usage -fcyclomatic-complexity -MMD -MP -MF"Core/Src/cdc_int.d" -MT"Core/Src/cdc_int.o" --specs=nano.specs -mfloat-abi=soft -mthumb -o "Core/Src/cdc_int.o"
|
arm-none-eabi-gcc "../Core/Src/cdc_int.c" -mcpu=cortex-m3 -std=gnu11 -g3 -DDEBUG -DUSE_HAL_DRIVER -DSTM32F103xB -c -I../Core/Inc -I../Drivers/STM32F1xx_HAL_Driver/Inc/Legacy -I../Drivers/STM32F1xx_HAL_Driver/Inc -I../Drivers/CMSIS/Device/ST/STM32F1xx/Include -I../Drivers/CMSIS/Include -I../USB_DEVICE/App -I../USB_DEVICE/Target -I../Middlewares/ST/STM32_USB_Device_Library/Core/Inc -I../Middlewares/ST/STM32_USB_Device_Library/Class/CDC/Inc -O0 -ffunction-sections -fdata-sections -Wall -fstack-usage -fcyclomatic-complexity -MMD -MP -MF"Core/Src/cdc_int.d" -MT"Core/Src/cdc_int.o" --specs=nano.specs -mfloat-abi=soft -mthumb -o "Core/Src/cdc_int.o"
|
||||||
arm-none-eabi-gcc -o "AUTOM10.elf" @"objects.list" -mcpu=cortex-m3 -T"C:\progetti\AUTOM\workspace\AUTOM10\STM32F103C8TX_FLASH.ld" --specs=nosys.specs -Wl,-Map="AUTOM10.map" -Wl,--gc-sections -static --specs=nano.specs -mfloat-abi=soft -mthumb -Wl,--start-group -lc -lm -Wl,--end-group
|
arm-none-eabi-gcc -o "AUTOM10.elf" @"objects.list" -mcpu=cortex-m3 -T"C:\progetti\AUTOM\workspace\AUTOM10\STM32F103C8TX_FLASH.ld" --specs=nosys.specs -Wl,-Map="AUTOM10.map" -Wl,--gc-sections -static --specs=nano.specs -mfloat-abi=soft -mthumb -Wl,--start-group -lc -lm -Wl,--end-group
|
||||||
@@ -7,15 +7,29 @@ Finished building target: AUTOM10.elf
|
|||||||
arm-none-eabi-size AUTOM10.elf
|
arm-none-eabi-size AUTOM10.elf
|
||||||
arm-none-eabi-objdump -h -S AUTOM10.elf > "AUTOM10.list"
|
arm-none-eabi-objdump -h -S AUTOM10.elf > "AUTOM10.list"
|
||||||
text data bss dec hex filename
|
text data bss dec hex filename
|
||||||
48728 464 7248 56440 dc78 AUTOM10.elf
|
48788 464 7248 56500 dcb4 AUTOM10.elf
|
||||||
Finished building: default.size.stdout
|
Finished building: default.size.stdout
|
||||||
|
|
||||||
Finished building: AUTOM10.list
|
Finished building: AUTOM10.list
|
||||||
|
|
||||||
16:16:58 **** Incremental Build of configuration Debug for project AUTOM10 ****
|
16:33:18 **** Incremental Build of configuration Debug for project AUTOM10 ****
|
||||||
make -j12 all
|
make -j12 all
|
||||||
arm-none-eabi-size AUTOM10.elf
|
arm-none-eabi-size AUTOM10.elf
|
||||||
text data bss dec hex filename
|
text data bss dec hex filename
|
||||||
48728 464 7248 56440 dc78 AUTOM10.elf
|
48788 464 7248 56500 dcb4 AUTOM10.elf
|
||||||
Finished building: default.size.stdout
|
Finished building: default.size.stdout
|
||||||
|
|
||||||
|
16:34:44 **** Incremental Build of configuration Debug for project AUTOM10 ****
|
||||||
|
make -j12 all
|
||||||
|
arm-none-eabi-gcc "../Core/Src/cdc_int.c" -mcpu=cortex-m3 -std=gnu11 -g3 -DDEBUG -DUSE_HAL_DRIVER -DSTM32F103xB -c -I../Core/Inc -I../Drivers/STM32F1xx_HAL_Driver/Inc/Legacy -I../Drivers/STM32F1xx_HAL_Driver/Inc -I../Drivers/CMSIS/Device/ST/STM32F1xx/Include -I../Drivers/CMSIS/Include -I../USB_DEVICE/App -I../USB_DEVICE/Target -I../Middlewares/ST/STM32_USB_Device_Library/Core/Inc -I../Middlewares/ST/STM32_USB_Device_Library/Class/CDC/Inc -O0 -ffunction-sections -fdata-sections -Wall -fstack-usage -fcyclomatic-complexity -MMD -MP -MF"Core/Src/cdc_int.d" -MT"Core/Src/cdc_int.o" --specs=nano.specs -mfloat-abi=soft -mthumb -o "Core/Src/cdc_int.o"
|
||||||
|
arm-none-eabi-gcc -o "AUTOM10.elf" @"objects.list" -mcpu=cortex-m3 -T"C:\progetti\AUTOM\workspace\AUTOM10\STM32F103C8TX_FLASH.ld" --specs=nosys.specs -Wl,-Map="AUTOM10.map" -Wl,--gc-sections -static --specs=nano.specs -mfloat-abi=soft -mthumb -Wl,--start-group -lc -lm -Wl,--end-group
|
||||||
|
Finished building target: AUTOM10.elf
|
||||||
|
|
||||||
|
arm-none-eabi-size AUTOM10.elf
|
||||||
|
arm-none-eabi-objdump -h -S AUTOM10.elf > "AUTOM10.list"
|
||||||
|
text data bss dec hex filename
|
||||||
|
48788 464 7248 56500 dcb4 AUTOM10.elf
|
||||||
|
Finished building: default.size.stdout
|
||||||
|
|
||||||
|
Finished building: AUTOM10.list
|
||||||
|
|
||||||
|
|||||||
@@ -1,105 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]>='r'){
|
|
||||||
|
|
||||||
}else if(rxbuf[1]>='w'){
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY); }
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,620 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
#include "adc.h"
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
DMA_HandleTypeDef hdma_adc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
UART_HandleTypeDef huart1;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
#define ADC_NUM_CHANNELS 5 // CH4..CH8
|
|
||||||
#define ADC_AVG_WINDOW 5 // 5 * 10ms = 50ms averaging window
|
|
||||||
|
|
||||||
|
|
||||||
uint8_t pulsanti=0;
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_DMA_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_USART1_UART_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
static uint8_t inidx=0;
|
|
||||||
static uint8_t inbuf[4];
|
|
||||||
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
inidx++;
|
|
||||||
inidx&=0x03;
|
|
||||||
if(HAL_GPIO_ReadPin(P1_GPIO_Port, P1_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP1;else inbuf[inidx]&=(~INP1);
|
|
||||||
if(HAL_GPIO_ReadPin(P2_GPIO_Port, P2_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP2;else inbuf[inidx]&=(~INP2);
|
|
||||||
pulsanti|=(inbuf[0]&inbuf[1]&inbuf[2]&inbuf[3]);
|
|
||||||
pulsanti&=(inbuf[0]|inbuf[1]|inbuf[2]|inbuf[3]);
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_DMA_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_USART1_UART_Init();
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
HAL_ADC_Start_DMA(&hadc1, (uint32_t *)adc_dma_buf, ADC_NUM_CHANNELS);
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
//CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
while (CDC_Transmit_FS((uint8_t*)"Start\r\n", 7) == USBD_BUSY);
|
|
||||||
if (EE_Init() != EE_OK){
|
|
||||||
for(;;);//errore eeprom
|
|
||||||
}
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_ENABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = ENABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 5;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_28CYCLES_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_5;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_2;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_6;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_3;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_7;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_4;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_8;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief USART1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_USART1_UART_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 1 */
|
|
||||||
huart1.Instance = USART1;
|
|
||||||
huart1.Init.BaudRate = 115200;
|
|
||||||
huart1.Init.WordLength = UART_WORDLENGTH_8B;
|
|
||||||
huart1.Init.StopBits = UART_STOPBITS_1;
|
|
||||||
huart1.Init.Parity = UART_PARITY_NONE;
|
|
||||||
huart1.Init.Mode = UART_MODE_TX_RX;
|
|
||||||
huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
||||||
huart1.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
||||||
if (HAL_UART_Init(&huart1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN USART1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Enable DMA controller clock
|
|
||||||
*/
|
|
||||||
static void MX_DMA_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* DMA controller clock enable */
|
|
||||||
__HAL_RCC_DMA1_CLK_ENABLE();
|
|
||||||
|
|
||||||
/* DMA interrupt init */
|
|
||||||
/* DMA1_Channel1_IRQn interrupt configuration */
|
|
||||||
HAL_NVIC_SetPriority(DMA1_Channel1_IRQn, 0, 0);
|
|
||||||
HAL_NVIC_EnableIRQ(DMA1_Channel1_IRQn);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOB, INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOA, BUZ_Pin|LED1_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : LED2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = LED2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(LED2_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : P1_Pin P2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = P1_Pin|P2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : AIN1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = AIN1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
||||||
HAL_GPIO_Init(AIN1_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : INH1_Pin INH2_Pin INH3_Pin INH4_Pin
|
|
||||||
EXP1_Pin EXP2_Pin EXP3_Pin */
|
|
||||||
GPIO_InitStruct.Pin = INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : CH1_Pin CH2_Pin CH3_Pin CH4_Pin */
|
|
||||||
GPIO_InitStruct.Pin = CH1_Pin|CH2_Pin|CH3_Pin|CH4_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : BUZ_Pin LED1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = BUZ_Pin|LED1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,197 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
extern const uint16_t EE_VirtAddrs[];
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t st;
|
|
||||||
uint16_t eeadd;
|
|
||||||
uint8_t i;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
st=EEW_Read(EE_VirtAddrs[eeadd], &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\nee read error %d",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
st=EEW_Write(EE_VirtAddrs[eeadd], val);
|
|
||||||
if (st == EE_OK)sprintf((char*)s,"\ndone 0x%02x=0x%04x",eeadd,val);
|
|
||||||
else sprintf((char*)s,"\nee write error %d", st);
|
|
||||||
}else sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
}else sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
}else sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else if(rxbuf[1]=='d'){
|
|
||||||
if(rxidx==2){
|
|
||||||
for(i=0;i<32;i++){
|
|
||||||
if((i%4)==0){
|
|
||||||
sprintf((char*)s,"\n");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
st=EEW_Read(EE_VirtAddrs[i], &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"0x%02x=0x%04x ",i,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"rderr %d ",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ed");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w|d");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,179 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
retval=c1;
|
|
||||||
retval*=10;
|
|
||||||
retval+=c2;
|
|
||||||
retval*=10;
|
|
||||||
retval+=c3;
|
|
||||||
retval*=10;
|
|
||||||
retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t eeadd;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]>='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%c%c=%04x",val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]>='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
EEW_Write(eeadd, val);
|
|
||||||
sprintf((char*)s,"\ndone");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%c%c=%04x",val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,35 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef INC_PWM_H_
|
|
||||||
#define INC_PWM_H_
|
|
||||||
#include <stdbool.h>
|
|
||||||
bool IsPwmRunning(TIM_HandleTypeDef *htim, uint32_t Channel);;
|
|
||||||
void StopMot(TIM_HandleTypeDef *htim,uint32_t Channel);
|
|
||||||
void StartMot(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval);
|
|
||||||
void SetMotPwm(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval);
|
|
||||||
|
|
||||||
#define timMot1 &htim2
|
|
||||||
#define FWMot1 TIM_CHANNEL_1
|
|
||||||
#define BWMot1 TIM_CHANNEL_2
|
|
||||||
|
|
||||||
#define timMot2 &htim2
|
|
||||||
#define FWMot2 TIM_CHANNEL_3
|
|
||||||
#define BWMot2 TIM_CHANNEL_4
|
|
||||||
|
|
||||||
#define timMot3 &htim4
|
|
||||||
#define FWMot3 TIM_CHANNEL_1
|
|
||||||
#define BWMot3 TIM_CHANNEL_2
|
|
||||||
|
|
||||||
#define timMot4 &htim4
|
|
||||||
#define FWMot4 TIM_CHANNEL_3
|
|
||||||
#define BWMot4 TIM_CHANNEL_4
|
|
||||||
|
|
||||||
#define FW 0
|
|
||||||
#define BW 1
|
|
||||||
|
|
||||||
#endif /* INC_PWM_H_ */
|
|
||||||
@@ -1,619 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
#include "adc.h"
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
DMA_HandleTypeDef hdma_adc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
UART_HandleTypeDef huart1;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
extern volatile uint16_t adc_dma_buf[];
|
|
||||||
|
|
||||||
uint8_t pulsanti=0;
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_DMA_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_USART1_UART_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
static uint8_t inidx=0;
|
|
||||||
static uint8_t inbuf[4];
|
|
||||||
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
inidx++;
|
|
||||||
inidx&=0x03;
|
|
||||||
if(HAL_GPIO_ReadPin(P1_GPIO_Port, P1_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP1;else inbuf[inidx]&=(~INP1);
|
|
||||||
if(HAL_GPIO_ReadPin(P2_GPIO_Port, P2_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP2;else inbuf[inidx]&=(~INP2);
|
|
||||||
pulsanti|=(inbuf[0]&inbuf[1]&inbuf[2]&inbuf[3]);
|
|
||||||
pulsanti&=(inbuf[0]|inbuf[1]|inbuf[2]|inbuf[3]);
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_DMA_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_USART1_UART_Init();
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
HAL_ADC_Start_DMA(&hadc1, (uint32_t *)adc_dma_buf, ADC_NUM_CHANNELS);
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
//CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
while (CDC_Transmit_FS((uint8_t*)"Start\r\n", 7) == USBD_BUSY);
|
|
||||||
if (EE_Init() != EE_OK){
|
|
||||||
for(;;);//errore eeprom
|
|
||||||
}
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_ENABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = ENABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 5;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_28CYCLES_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_5;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_2;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_6;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_3;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_7;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_4;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_8;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief USART1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_USART1_UART_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 1 */
|
|
||||||
huart1.Instance = USART1;
|
|
||||||
huart1.Init.BaudRate = 115200;
|
|
||||||
huart1.Init.WordLength = UART_WORDLENGTH_8B;
|
|
||||||
huart1.Init.StopBits = UART_STOPBITS_1;
|
|
||||||
huart1.Init.Parity = UART_PARITY_NONE;
|
|
||||||
huart1.Init.Mode = UART_MODE_TX_RX;
|
|
||||||
huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
||||||
huart1.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
||||||
if (HAL_UART_Init(&huart1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN USART1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Enable DMA controller clock
|
|
||||||
*/
|
|
||||||
static void MX_DMA_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* DMA controller clock enable */
|
|
||||||
__HAL_RCC_DMA1_CLK_ENABLE();
|
|
||||||
|
|
||||||
/* DMA interrupt init */
|
|
||||||
/* DMA1_Channel1_IRQn interrupt configuration */
|
|
||||||
HAL_NVIC_SetPriority(DMA1_Channel1_IRQn, 0, 0);
|
|
||||||
HAL_NVIC_EnableIRQ(DMA1_Channel1_IRQn);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOB, INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOA, BUZ_Pin|LED1_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : LED2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = LED2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(LED2_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : P1_Pin P2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = P1_Pin|P2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : AIN1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = AIN1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
||||||
HAL_GPIO_Init(AIN1_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : INH1_Pin INH2_Pin INH3_Pin INH4_Pin
|
|
||||||
EXP1_Pin EXP2_Pin EXP3_Pin */
|
|
||||||
GPIO_InitStruct.Pin = INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : CH1_Pin CH2_Pin CH3_Pin CH4_Pin */
|
|
||||||
GPIO_InitStruct.Pin = CH1_Pin|CH2_Pin|CH3_Pin|CH4_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : BUZ_Pin LED1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = BUZ_Pin|LED1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,36 +0,0 @@
|
|||||||
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,94 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,48 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,35 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef INC_PWM_H_
|
|
||||||
#define INC_PWM_H_
|
|
||||||
#include <stdbool.h>
|
|
||||||
bool IsPwmRunning(TIM_HandleTypeDef *htim, uint32_t Channel);;
|
|
||||||
void StopMot(TIM_HandleTypeDef *htim,uint32_t Channel);
|
|
||||||
void StartMot(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval);
|
|
||||||
void SetMotPwm(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval);
|
|
||||||
|
|
||||||
#define timMot1 &htim2
|
|
||||||
#define FWMot1 TIM_CHANNEL_1
|
|
||||||
#define BWMot1 TIM_CHANNEL_2
|
|
||||||
|
|
||||||
#define timMot2 &htim2
|
|
||||||
#define FWMot2 TIM_CHANNEL_3
|
|
||||||
#define BWMot2 TIM_CHANNEL_4
|
|
||||||
|
|
||||||
#define timMot3 &htim4
|
|
||||||
#define FWMot3 TIM_CHANNEL_1
|
|
||||||
#define BWMot3 TIM_CHANNEL_2
|
|
||||||
|
|
||||||
#define timMot4 &htim4
|
|
||||||
#define FWMot4 TIM_CHANNEL_3
|
|
||||||
#define BWMot4 TIM_CHANNEL_4
|
|
||||||
|
|
||||||
#define FW 0
|
|
||||||
@define BW 1
|
|
||||||
|
|
||||||
#endif /* INC_PWM_H_ */
|
|
||||||
@@ -1,549 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
|
|
||||||
#include "pwm.h"
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
UART_HandleTypeDef huart1;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
TIM_HandleTypeDef htim1;
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim3;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_USART1_UART_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_USART1_UART_Init();
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 1;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief USART1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_USART1_UART_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 1 */
|
|
||||||
huart1.Instance = USART1;
|
|
||||||
huart1.Init.BaudRate = 115200;
|
|
||||||
huart1.Init.WordLength = UART_WORDLENGTH_8B;
|
|
||||||
huart1.Init.StopBits = UART_STOPBITS_1;
|
|
||||||
huart1.Init.Parity = UART_PARITY_NONE;
|
|
||||||
huart1.Init.Mode = UART_MODE_TX_RX;
|
|
||||||
huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
||||||
huart1.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
||||||
if (HAL_UART_Init(&huart1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN USART1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOB, INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOA, BUZ_Pin|LED1_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : LED2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = LED2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(LED2_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : P1_Pin P2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = P1_Pin|P2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : AIN1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = AIN1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
||||||
HAL_GPIO_Init(AIN1_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : INH1_Pin INH2_Pin INH3_Pin INH4_Pin
|
|
||||||
EXP1_Pin EXP2_Pin EXP3_Pin */
|
|
||||||
GPIO_InitStruct.Pin = INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : CH1_Pin CH2_Pin CH3_Pin CH4_Pin */
|
|
||||||
GPIO_InitStruct.Pin = CH1_Pin|CH2_Pin|CH3_Pin|CH4_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : BUZ_Pin LED1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = BUZ_Pin|LED1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,204 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t st;
|
|
||||||
uint16_t eeadd;
|
|
||||||
uint8_t i;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
st=EEW_Read(eeadd, &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\nee read error %d",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
EEW_Write(eeadd, val);
|
|
||||||
sprintf((char*)s,"\ndone 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='d'){
|
|
||||||
if(rxidx==2){
|
|
||||||
for(i=0;i<32;i++){
|
|
||||||
if((i%4)==0){
|
|
||||||
sprintf((char*)s,"\n");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
st=EEW_Read(i, &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"0x%02x=0x%04x ",i,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"rderr %d ",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ed");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w|d");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,631 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
DMA_HandleTypeDef hdma_adc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
UART_HandleTypeDef huart1;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
#define ADC_NUM_CHANNELS 5 // CH4..CH8
|
|
||||||
#define ADC_AVG_WINDOW 5 // 5 * 10ms = 50ms averaging window
|
|
||||||
|
|
||||||
/* Filled by ADC+DMA: latest raw value of each channel */
|
|
||||||
volatile uint16_t adc_dma_buf[ADC_NUM_CHANNELS];
|
|
||||||
|
|
||||||
/* Smoothed value (50ms average with settings above) */
|
|
||||||
volatile uint16_t adc_avg[ADC_NUM_CHANNELS];
|
|
||||||
|
|
||||||
/* Internal accumulators used only in the timer ISR */
|
|
||||||
static uint32_t adc_sum[ADC_NUM_CHANNELS];
|
|
||||||
static uint8_t adc_sum_count = 0;
|
|
||||||
|
|
||||||
/* Optional flag to tell main loop that a new averaged set is ready */
|
|
||||||
volatile uint8_t adc_avg_ready = 0;
|
|
||||||
|
|
||||||
uint8_t pulsanti=0;
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_DMA_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_USART1_UART_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
static uint8_t inidx=0;
|
|
||||||
static uint8_t inbuf[4];
|
|
||||||
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
inidx++;
|
|
||||||
inidx&=0x03;
|
|
||||||
if(HAL_GPIO_ReadPin(P1_GPIO_Port, P1_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP1;else inbuf[inidx]&=(~INP1);
|
|
||||||
if(HAL_GPIO_ReadPin(P2_GPIO_Port, P2_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP2;else inbuf[inidx]&=(~INP2);
|
|
||||||
pulsanti|=(inbuf[0]&inbuf[1]&inbuf[2]&inbuf[3]);
|
|
||||||
pulsanti&=(inbuf[0]|inbuf[1]|inbuf[2]|inbuf[3]);
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_DMA_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_USART1_UART_Init();
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
HAL_ADC_Start_DMA(&hadc1, (uint32_t *)adc_dma_buf, ADC_NUM_CHANNELS);
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
//CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
while (CDC_Transmit_FS((uint8_t*)"Start\r\n", 7) == USBD_BUSY);
|
|
||||||
if (EE_Init() != EE_OK){
|
|
||||||
for(;;);//errore eeprom
|
|
||||||
}
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_ENABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = ENABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 5;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_28CYCLES_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_5;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_2;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_6;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_3;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_7;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_4;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_8;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief USART1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_USART1_UART_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 1 */
|
|
||||||
huart1.Instance = USART1;
|
|
||||||
huart1.Init.BaudRate = 115200;
|
|
||||||
huart1.Init.WordLength = UART_WORDLENGTH_8B;
|
|
||||||
huart1.Init.StopBits = UART_STOPBITS_1;
|
|
||||||
huart1.Init.Parity = UART_PARITY_NONE;
|
|
||||||
huart1.Init.Mode = UART_MODE_TX_RX;
|
|
||||||
huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
||||||
huart1.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
||||||
if (HAL_UART_Init(&huart1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN USART1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Enable DMA controller clock
|
|
||||||
*/
|
|
||||||
static void MX_DMA_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* DMA controller clock enable */
|
|
||||||
__HAL_RCC_DMA1_CLK_ENABLE();
|
|
||||||
|
|
||||||
/* DMA interrupt init */
|
|
||||||
/* DMA1_Channel1_IRQn interrupt configuration */
|
|
||||||
HAL_NVIC_SetPriority(DMA1_Channel1_IRQn, 0, 0);
|
|
||||||
HAL_NVIC_EnableIRQ(DMA1_Channel1_IRQn);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOB, INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOA, BUZ_Pin|LED1_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : LED2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = LED2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(LED2_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : P1_Pin P2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = P1_Pin|P2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : AIN1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = AIN1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
||||||
HAL_GPIO_Init(AIN1_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : INH1_Pin INH2_Pin INH3_Pin INH4_Pin
|
|
||||||
EXP1_Pin EXP2_Pin EXP3_Pin */
|
|
||||||
GPIO_InitStruct.Pin = INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : CH1_Pin CH2_Pin CH3_Pin CH4_Pin */
|
|
||||||
GPIO_InitStruct.Pin = CH1_Pin|CH2_Pin|CH3_Pin|CH4_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : BUZ_Pin LED1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = BUZ_Pin|LED1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,119 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]>='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]>='w'){
|
|
||||||
if(rxidx==4){
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,177 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t eeadd;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
EEW_Write(eeadd, val);
|
|
||||||
sprintf((char*)s,"\ndone");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,287 +0,0 @@
|
|||||||
#include "eeprom.h"
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Record format (4 bytes):
|
|
||||||
* [0] VirtAddress (uint16_t)
|
|
||||||
* [2] Data (uint16_t)
|
|
||||||
*
|
|
||||||
* Page layout:
|
|
||||||
* [0] PageStatus (uint16_t)
|
|
||||||
* [2..] Records...
|
|
||||||
*/
|
|
||||||
|
|
||||||
typedef struct
|
|
||||||
{
|
|
||||||
uint16_t VirtAddress;
|
|
||||||
uint16_t Data;
|
|
||||||
} EE_Record_t;
|
|
||||||
|
|
||||||
/* Active page base address (runtime selected in EE_Init) */
|
|
||||||
static uint32_t EE_ActivePageBase = EE_PAGE0_BASE;
|
|
||||||
|
|
||||||
/* 32 sequential virtual addresses */
|
|
||||||
const uint16_t EE_VirtAddrs[EE_NUM_VIRTUAL_ADDR] =
|
|
||||||
{
|
|
||||||
0x0001, 0x0002, 0x0003, 0x0004,
|
|
||||||
0x0005, 0x0006, 0x0007, 0x0008,
|
|
||||||
0x0009, 0x000A, 0x000B, 0x000C,
|
|
||||||
0x000D, 0x000E, 0x000F, 0x0010,
|
|
||||||
0x0011, 0x0012, 0x0013, 0x0014,
|
|
||||||
0x0015, 0x0016, 0x0017, 0x0018,
|
|
||||||
0x0019, 0x001A, 0x001B, 0x001C,
|
|
||||||
0x001D, 0x001E, 0x001F, 0x0020
|
|
||||||
};
|
|
||||||
|
|
||||||
/* ========================================================================= */
|
|
||||||
|
|
||||||
/* --- Internal helpers ---------------------------------------------------- */
|
|
||||||
|
|
||||||
static uint16_t EE_GetPageStatus(uint32_t pageBase)
|
|
||||||
{
|
|
||||||
return *(__IO uint16_t *)pageBase;
|
|
||||||
}
|
|
||||||
|
|
||||||
static HAL_StatusTypeDef EE_FlashProgramHalfWord(uint32_t Address, uint16_t Data)
|
|
||||||
{
|
|
||||||
HAL_StatusTypeDef status;
|
|
||||||
|
|
||||||
HAL_FLASH_Unlock();
|
|
||||||
status = HAL_FLASH_Program(FLASH_TYPEPROGRAM_HALFWORD, Address, Data);
|
|
||||||
HAL_FLASH_Lock();
|
|
||||||
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
|
|
||||||
static HAL_StatusTypeDef EE_FlashErasePage(uint32_t PageAddress)
|
|
||||||
{
|
|
||||||
HAL_StatusTypeDef status;
|
|
||||||
FLASH_EraseInitTypeDef EraseInit;
|
|
||||||
uint32_t PageError = 0;
|
|
||||||
|
|
||||||
HAL_FLASH_Unlock();
|
|
||||||
|
|
||||||
EraseInit.TypeErase = FLASH_TYPEERASE_PAGES;
|
|
||||||
EraseInit.PageAddress = PageAddress;
|
|
||||||
EraseInit.NbPages = 1;
|
|
||||||
|
|
||||||
status = HAL_FLASHEx_Erase(&EraseInit, &PageError);
|
|
||||||
|
|
||||||
HAL_FLASH_Lock();
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Find first free record address in given page (returns 0 if full) */
|
|
||||||
static uint32_t EE_FindFreeAddress(uint32_t pageBase)
|
|
||||||
{
|
|
||||||
uint32_t addr = pageBase + 2U; /* Skip status word */
|
|
||||||
uint32_t pageEnd = pageBase + EE_PAGE_SIZE;
|
|
||||||
|
|
||||||
while (addr < (pageEnd - sizeof(EE_Record_t) + 1U))
|
|
||||||
{
|
|
||||||
uint16_t vaddr = *(__IO uint16_t *)addr;
|
|
||||||
|
|
||||||
if (vaddr == 0xFFFFU)
|
|
||||||
{
|
|
||||||
/* Empty slot */
|
|
||||||
return addr;
|
|
||||||
}
|
|
||||||
addr += sizeof(EE_Record_t);
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0U; /* No space */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Find latest value of VirtAddress in a specific page */
|
|
||||||
static EE_Status EE_FindInPage(uint32_t pageBase, uint16_t VirtAddress, uint16_t *Data)
|
|
||||||
{
|
|
||||||
uint32_t pageEnd = pageBase + EE_PAGE_SIZE;
|
|
||||||
uint32_t addr;
|
|
||||||
|
|
||||||
if (Data == NULL)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
/* Start from last possible record and go backwards */
|
|
||||||
for (addr = pageEnd - sizeof(EE_Record_t); addr > pageBase + 1U; addr -= sizeof(EE_Record_t))
|
|
||||||
{
|
|
||||||
uint16_t vaddr = *(__IO uint16_t *)addr;
|
|
||||||
uint16_t value = *(__IO uint16_t *)(addr + 2U);
|
|
||||||
|
|
||||||
if (vaddr == 0xFFFFU)
|
|
||||||
{
|
|
||||||
/* Empty slot, skip */
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (vaddr == VirtAddress)
|
|
||||||
{
|
|
||||||
*Data = value;
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return EE_NOT_FOUND;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Format both pages: erase and set PAGE0 as VALID */
|
|
||||||
static EE_Status EE_Format(void)
|
|
||||||
{
|
|
||||||
if (EE_FlashErasePage(EE_PAGE0_BASE) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
if (EE_FlashErasePage(EE_PAGE1_BASE) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
if (EE_FlashProgramHalfWord(EE_PAGE0_BASE, EE_PAGE_STATUS_VALID) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
/* PAGE1 will remain erased (status = 0xFFFF) */
|
|
||||||
EE_ActivePageBase = EE_PAGE0_BASE;
|
|
||||||
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Get the base of the other page */
|
|
||||||
static uint32_t EE_GetOtherPageBase(uint32_t pageBase)
|
|
||||||
{
|
|
||||||
return (pageBase == EE_PAGE0_BASE) ? EE_PAGE1_BASE : EE_PAGE0_BASE;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Page transfer (garbage collection + new write) */
|
|
||||||
static EE_Status EE_PageTransfer(uint16_t VirtAddress, uint16_t Data)
|
|
||||||
{
|
|
||||||
uint32_t oldBase = EE_ActivePageBase;
|
|
||||||
uint32_t newBase = EE_GetOtherPageBase(oldBase);
|
|
||||||
uint32_t addr;
|
|
||||||
uint16_t value;
|
|
||||||
EE_Status st;
|
|
||||||
|
|
||||||
/* Erase new page */
|
|
||||||
if (EE_FlashErasePage(newBase) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
/* Mark new page as RECEIVE */
|
|
||||||
if (EE_FlashProgramHalfWord(newBase, EE_PAGE_STATUS_RECEIVE) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
/* Start writing records just after status */
|
|
||||||
addr = newBase + 2U;
|
|
||||||
|
|
||||||
/* For each known virtual variable */
|
|
||||||
for (uint16_t i = 0; i < EE_NUM_VIRTUAL_ADDR; i++)
|
|
||||||
{
|
|
||||||
uint16_t vaddr = EE_VirtAddrs[i];
|
|
||||||
|
|
||||||
if (vaddr == VirtAddress)
|
|
||||||
{
|
|
||||||
/* Use the new data passed into PageTransfer */
|
|
||||||
value = Data;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
/* Read latest value from old active page */
|
|
||||||
st = EE_FindInPage(oldBase, vaddr, &value);
|
|
||||||
if (st != EE_OK)
|
|
||||||
{
|
|
||||||
/* Variable never written -> skip */
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Write record to new page */
|
|
||||||
if (EE_FlashProgramHalfWord(addr, vaddr) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
if (EE_FlashProgramHalfWord(addr + 2U, value) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
addr += sizeof(EE_Record_t);
|
|
||||||
if (addr >= (newBase + EE_PAGE_SIZE))
|
|
||||||
return EE_NO_SPACE;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Erase old page */
|
|
||||||
if (EE_FlashErasePage(oldBase) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
/* Mark new page as VALID */
|
|
||||||
if (EE_FlashProgramHalfWord(newBase, EE_PAGE_STATUS_VALID) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
/* Update active page */
|
|
||||||
EE_ActivePageBase = newBase;
|
|
||||||
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* --- Public API ----------------------------------------------------------- */
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Initialize the EEPROM emulation.
|
|
||||||
* - Checks page statuses and chooses the active page.
|
|
||||||
* - If inconsistent or blank, formats pages.
|
|
||||||
*/
|
|
||||||
EE_Status EE_Init(void)
|
|
||||||
{
|
|
||||||
uint16_t status0 = EE_GetPageStatus(EE_PAGE0_BASE);
|
|
||||||
uint16_t status1 = EE_GetPageStatus(EE_PAGE1_BASE);
|
|
||||||
|
|
||||||
if ((status0 == EE_PAGE_STATUS_ERASED) && (status1 == EE_PAGE_STATUS_ERASED))
|
|
||||||
{
|
|
||||||
/* Fresh device -> format */
|
|
||||||
return EE_Format();
|
|
||||||
}
|
|
||||||
else if ((status0 == EE_PAGE_STATUS_VALID) && (status1 == EE_PAGE_STATUS_ERASED))
|
|
||||||
{
|
|
||||||
EE_ActivePageBase = EE_PAGE0_BASE;
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
else if ((status1 == EE_PAGE_STATUS_VALID) && (status0 == EE_PAGE_STATUS_ERASED))
|
|
||||||
{
|
|
||||||
EE_ActivePageBase = EE_PAGE1_BASE;
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
/* Any weird or inconsistent state -> reformat */
|
|
||||||
return EE_Format();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Read a 16-bit variable by its virtual address.
|
|
||||||
*/
|
|
||||||
EE_Status EE_ReadVariable(uint16_t VirtAddress, uint16_t *Data)
|
|
||||||
{
|
|
||||||
if (Data == NULL)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
return EE_FindInPage(EE_ActivePageBase, VirtAddress, Data);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Write (append) a 16-bit variable.
|
|
||||||
* - Writes a new record in the active page.
|
|
||||||
* - If the page is full, triggers a page transfer (GC).
|
|
||||||
*/
|
|
||||||
EE_Status EE_WriteVariable(uint16_t VirtAddress, uint16_t Data)
|
|
||||||
{
|
|
||||||
uint32_t freeAddr;
|
|
||||||
EE_Status st;
|
|
||||||
|
|
||||||
/* Find free space in active page */
|
|
||||||
freeAddr = EE_FindFreeAddress(EE_ActivePageBase);
|
|
||||||
if (freeAddr != 0U)
|
|
||||||
{
|
|
||||||
/* Write new record */
|
|
||||||
if (EE_FlashProgramHalfWord(freeAddr, VirtAddress) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
if (EE_FlashProgramHalfWord(freeAddr + 2U, Data) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* No space -> page transfer */
|
|
||||||
st = EE_PageTransfer(VirtAddress, Data);
|
|
||||||
return st;
|
|
||||||
}
|
|
||||||
|
|
||||||
@@ -1,36 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef INC_PWM_H_
|
|
||||||
#define INC_PWM_H_
|
|
||||||
#include <stdbool.h>
|
|
||||||
bool IsPwmRunning(TIM_HandleTypeDef *htim, uint32_t Channel);;
|
|
||||||
void StopMot(TIM_HandleTypeDef *htim,uint32_t Channel);
|
|
||||||
void StartMot(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval);
|
|
||||||
void SetMotPwm(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval);
|
|
||||||
void SetMot(TIM_HandleTypeDef *htim,uint8_t dir,uint16_t pwmval);
|
|
||||||
|
|
||||||
#define timMot1 &htim2
|
|
||||||
#define FWMot1 TIM_CHANNEL_1
|
|
||||||
#define BWMot1 TIM_CHANNEL_2
|
|
||||||
|
|
||||||
#define timMot2 &htim2
|
|
||||||
#define FWMot2 TIM_CHANNEL_3
|
|
||||||
#define BWMot2 TIM_CHANNEL_4
|
|
||||||
|
|
||||||
#define timMot3 &htim4
|
|
||||||
#define FWMot3 TIM_CHANNEL_1
|
|
||||||
#define BWMot3 TIM_CHANNEL_2
|
|
||||||
|
|
||||||
#define timMot4 &htim4
|
|
||||||
#define FWMot4 TIM_CHANNEL_3
|
|
||||||
#define BWMot4 TIM_CHANNEL_4
|
|
||||||
|
|
||||||
#define FW 0
|
|
||||||
#define BW 1
|
|
||||||
|
|
||||||
#endif /* INC_PWM_H_ */
|
|
||||||
@@ -1,619 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
#include "adc.h"
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
DMA_HandleTypeDef hdma_adc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
UART_HandleTypeDef huart1;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
extern volatile uint16_t adc_dma_buf[
|
|
||||||
|
|
||||||
uint8_t pulsanti=0;
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_DMA_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_USART1_UART_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
static uint8_t inidx=0;
|
|
||||||
static uint8_t inbuf[4];
|
|
||||||
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
inidx++;
|
|
||||||
inidx&=0x03;
|
|
||||||
if(HAL_GPIO_ReadPin(P1_GPIO_Port, P1_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP1;else inbuf[inidx]&=(~INP1);
|
|
||||||
if(HAL_GPIO_ReadPin(P2_GPIO_Port, P2_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP2;else inbuf[inidx]&=(~INP2);
|
|
||||||
pulsanti|=(inbuf[0]&inbuf[1]&inbuf[2]&inbuf[3]);
|
|
||||||
pulsanti&=(inbuf[0]|inbuf[1]|inbuf[2]|inbuf[3]);
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_DMA_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_USART1_UART_Init();
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
HAL_ADC_Start_DMA(&hadc1, (uint32_t *)adc_dma_buf, ADC_NUM_CHANNELS);
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
//CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
while (CDC_Transmit_FS((uint8_t*)"Start\r\n", 7) == USBD_BUSY);
|
|
||||||
if (EE_Init() != EE_OK){
|
|
||||||
for(;;);//errore eeprom
|
|
||||||
}
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_ENABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = ENABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 5;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_28CYCLES_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_5;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_2;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_6;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_3;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_7;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_4;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_8;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief USART1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_USART1_UART_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 1 */
|
|
||||||
huart1.Instance = USART1;
|
|
||||||
huart1.Init.BaudRate = 115200;
|
|
||||||
huart1.Init.WordLength = UART_WORDLENGTH_8B;
|
|
||||||
huart1.Init.StopBits = UART_STOPBITS_1;
|
|
||||||
huart1.Init.Parity = UART_PARITY_NONE;
|
|
||||||
huart1.Init.Mode = UART_MODE_TX_RX;
|
|
||||||
huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
||||||
huart1.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
||||||
if (HAL_UART_Init(&huart1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN USART1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Enable DMA controller clock
|
|
||||||
*/
|
|
||||||
static void MX_DMA_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* DMA controller clock enable */
|
|
||||||
__HAL_RCC_DMA1_CLK_ENABLE();
|
|
||||||
|
|
||||||
/* DMA interrupt init */
|
|
||||||
/* DMA1_Channel1_IRQn interrupt configuration */
|
|
||||||
HAL_NVIC_SetPriority(DMA1_Channel1_IRQn, 0, 0);
|
|
||||||
HAL_NVIC_EnableIRQ(DMA1_Channel1_IRQn);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOB, INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOA, BUZ_Pin|LED1_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : LED2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = LED2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(LED2_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : P1_Pin P2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = P1_Pin|P2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : AIN1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = AIN1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
||||||
HAL_GPIO_Init(AIN1_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : INH1_Pin INH2_Pin INH3_Pin INH4_Pin
|
|
||||||
EXP1_Pin EXP2_Pin EXP3_Pin */
|
|
||||||
GPIO_InitStruct.Pin = INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : CH1_Pin CH2_Pin CH3_Pin CH4_Pin */
|
|
||||||
GPIO_InitStruct.Pin = CH1_Pin|CH2_Pin|CH3_Pin|CH4_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : BUZ_Pin LED1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = BUZ_Pin|LED1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,137 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.c
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool IsPwmRunning(TIM_HandleTypeDef *htim, uint32_t Channel)
|
|
||||||
{
|
|
||||||
HAL_TIM_ChannelStateTypeDef chState = HAL_TIM_GetChannelState(htim, Channel);
|
|
||||||
|
|
||||||
return (chState == HAL_TIM_CHANNEL_STATE_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
void StopMot(TIM_HandleTypeDef *htim,uint32_t Channel){
|
|
||||||
HAL_TIM_PWM_Stop(htim, Channel);
|
|
||||||
}
|
|
||||||
|
|
||||||
void StartMot(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval){
|
|
||||||
__HAL_TIM_SET_COMPARE(htim, Channel, pwmval);
|
|
||||||
HAL_TIM_PWM_Start(htim, Channel);
|
|
||||||
}
|
|
||||||
|
|
||||||
void SetMotPwm(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval){
|
|
||||||
__HAL_TIM_SET_COMPARE(htim, Channel, pwmval);
|
|
||||||
}
|
|
||||||
|
|
||||||
void SetMot(uint8_t mot,uint8_t dir,uint16_t pwmval){
|
|
||||||
TIM_HandleTypeDef *htim;
|
|
||||||
switch(mot){
|
|
||||||
case 1:
|
|
||||||
if(dir==FW){
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
HAL_GPIO_WritePin(INH1_GPIO_Port, INH1_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot1, FWMot1)){
|
|
||||||
SetMotPwm(timMot1,FWMot1,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH1_GPIO_Port, INH1_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot1,FWMot1,pwmval);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
HAL_GPIO_WritePin(INH1_GPIO_Port, INH1_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot1, BWMot1)){
|
|
||||||
SetMotPwm(timMot1,BWMot1,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH1_GPIO_Port, INH1_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot1,BWMot1,pwmval);
|
|
||||||
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
if(dir==FW){
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
HAL_GPIO_WritePin(INH2_GPIO_Port, INH2_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot2, FWMot2)){
|
|
||||||
SetMotPwm(timMot2,FWMot2,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH2_GPIO_Port, INH2_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot2,FWMot2,pwmval);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
HAL_GPIO_WritePin(INH2_GPIO_Port, INH2_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot2, BWMot2)){
|
|
||||||
SetMotPwm(timMot2,BWMot2,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH2_GPIO_Port, INH2_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot2,BWMot2,pwmval);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 3:
|
|
||||||
if(dir==FW){
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
HAL_GPIO_WritePin(INH3_GPIO_Port, INH3_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot3, FWMot3)){
|
|
||||||
SetMotPwm(timMot3,FWMot3,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH3_GPIO_Port, INH3_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot3,FWMot3,pwmval);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
HAL_GPIO_WritePin(INH3_GPIO_Port, INH3_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot3, BWMot3)){
|
|
||||||
SetMotPwm(timMot3,BWMot3,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH3_GPIO_Port, INH3_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot3,BWMot3,pwmval);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 4:
|
|
||||||
if(dir==FW){
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
HAL_GPIO_WritePin(INH4_GPIO_Port, INH4_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot4, FWMot4)){
|
|
||||||
SetMotPwm(timMot4,FWMot4,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH4_GPIO_Port, INH4_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot4,FWMot4,pwmval);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
HAL_GPIO_WritePin(INH4_GPIO_Port, INH4_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot4, BWMot4)){
|
|
||||||
SetMotPwm(timMot4,BWMot4,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH4_GPIO_Port, INH4_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot4,BWMot4,pwmval);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,13 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef INC_PWM_H_
|
|
||||||
#define INC_PWM_H_
|
|
||||||
|
|
||||||
bool IsPwmRunning(TIM_HandleTypeDef *htim, uint32_t Channel);
|
|
||||||
|
|
||||||
#endif /* INC_PWM_H_ */
|
|
||||||
@@ -1,620 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
#include "adc.h"
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
DMA_HandleTypeDef hdma_adc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
UART_HandleTypeDef huart1;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
extern volatile uint16_t adc_dma_buf[];
|
|
||||||
|
|
||||||
uint8_t pulsanti=0;
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_DMA_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_USART1_UART_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
static uint8_t inidx=0;
|
|
||||||
static uint8_t inbuf[4];
|
|
||||||
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
inidx++;
|
|
||||||
inidx&=0x03;
|
|
||||||
if(HAL_GPIO_ReadPin(P1_GPIO_Port, P1_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP1;else inbuf[inidx]&=(~INP1);
|
|
||||||
if(HAL_GPIO_ReadPin(P2_GPIO_Port, P2_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP2;else inbuf[inidx]&=(~INP2);
|
|
||||||
pulsanti|=(inbuf[0]&inbuf[1]&inbuf[2]&inbuf[3]);
|
|
||||||
pulsanti&=(inbuf[0]|inbuf[1]|inbuf[2]|inbuf[3]);
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_DMA_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_USART1_UART_Init();
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
HAL_ADC_Start_DMA(&hadc1, (uint32_t *)adc_dma_buf, ADC_NUM_CHANNELS);
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
//CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
while (CDC_Transmit_FS((uint8_t*)"Start\r\n", 7) == USBD_BUSY);
|
|
||||||
if (EE_Init() != EE_OK){
|
|
||||||
for(;;);//errore eeprom
|
|
||||||
}
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
managAdc();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_ENABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = ENABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 5;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_28CYCLES_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_5;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_2;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_6;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_3;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_7;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_4;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_8;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief USART1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_USART1_UART_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 1 */
|
|
||||||
huart1.Instance = USART1;
|
|
||||||
huart1.Init.BaudRate = 115200;
|
|
||||||
huart1.Init.WordLength = UART_WORDLENGTH_8B;
|
|
||||||
huart1.Init.StopBits = UART_STOPBITS_1;
|
|
||||||
huart1.Init.Parity = UART_PARITY_NONE;
|
|
||||||
huart1.Init.Mode = UART_MODE_TX_RX;
|
|
||||||
huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
||||||
huart1.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
||||||
if (HAL_UART_Init(&huart1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN USART1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Enable DMA controller clock
|
|
||||||
*/
|
|
||||||
static void MX_DMA_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* DMA controller clock enable */
|
|
||||||
__HAL_RCC_DMA1_CLK_ENABLE();
|
|
||||||
|
|
||||||
/* DMA interrupt init */
|
|
||||||
/* DMA1_Channel1_IRQn interrupt configuration */
|
|
||||||
HAL_NVIC_SetPriority(DMA1_Channel1_IRQn, 0, 0);
|
|
||||||
HAL_NVIC_EnableIRQ(DMA1_Channel1_IRQn);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOB, INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOA, BUZ_Pin|LED1_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : LED2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = LED2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(LED2_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : P1_Pin P2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = P1_Pin|P2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : AIN1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = AIN1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
||||||
HAL_GPIO_Init(AIN1_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : INH1_Pin INH2_Pin INH3_Pin INH4_Pin
|
|
||||||
EXP1_Pin EXP2_Pin EXP3_Pin */
|
|
||||||
GPIO_InitStruct.Pin = INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : CH1_Pin CH2_Pin CH3_Pin CH4_Pin */
|
|
||||||
GPIO_InitStruct.Pin = CH1_Pin|CH2_Pin|CH3_Pin|CH4_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : BUZ_Pin LED1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = BUZ_Pin|LED1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,8 +0,0 @@
|
|||||||
/*
|
|
||||||
* eeprom.c
|
|
||||||
*
|
|
||||||
* Created on: Dec 7, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
@@ -1,16 +0,0 @@
|
|||||||
/*
|
|
||||||
* adc.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 8, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef INC_ADC_H_
|
|
||||||
#define INC_ADC_H_
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#define ADC_NUM_CHANNELS 5 // CH4..CH8
|
|
||||||
#define ADC_AVG_WINDOW 5 // 5 * 10ms = 50ms averaging window
|
|
||||||
|
|
||||||
void manageAdc(void);
|
|
||||||
|
|
||||||
#endif /* INC_ADC_H_ */
|
|
||||||
@@ -1,620 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
#include "adc.h"
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
DMA_HandleTypeDef hdma_adc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
UART_HandleTypeDef huart1;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
extern volatile uint16_t adc_dma_buf[];
|
|
||||||
|
|
||||||
uint8_t pulsanti=0;
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_DMA_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_USART1_UART_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
static uint8_t inidx=0;
|
|
||||||
static uint8_t inbuf[4];
|
|
||||||
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
inidx++;
|
|
||||||
inidx&=0x03;
|
|
||||||
if(HAL_GPIO_ReadPin(P1_GPIO_Port, P1_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP1;else inbuf[inidx]&=(~INP1);
|
|
||||||
if(HAL_GPIO_ReadPin(P2_GPIO_Port, P2_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP2;else inbuf[inidx]&=(~INP2);
|
|
||||||
pulsanti|=(inbuf[0]&inbuf[1]&inbuf[2]&inbuf[3]);
|
|
||||||
pulsanti&=(inbuf[0]|inbuf[1]|inbuf[2]|inbuf[3]);
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_DMA_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_USART1_UART_Init();
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
HAL_ADC_Start_DMA(&hadc1, (uint32_t *)adc_dma_buf, ADC_NUM_CHANNELS);
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
//CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
while (CDC_Transmit_FS((uint8_t*)"Start\r\n", 7) == USBD_BUSY);
|
|
||||||
if (EE_Init() != EE_OK){
|
|
||||||
for(;;);//errore eeprom
|
|
||||||
}
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
manageAdc();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_ENABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = ENABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 5;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_28CYCLES_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_5;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_2;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_6;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_3;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_7;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_4;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_8;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief USART1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_USART1_UART_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 1 */
|
|
||||||
huart1.Instance = USART1;
|
|
||||||
huart1.Init.BaudRate = 115200;
|
|
||||||
huart1.Init.WordLength = UART_WORDLENGTH_8B;
|
|
||||||
huart1.Init.StopBits = UART_STOPBITS_1;
|
|
||||||
huart1.Init.Parity = UART_PARITY_NONE;
|
|
||||||
huart1.Init.Mode = UART_MODE_TX_RX;
|
|
||||||
huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
||||||
huart1.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
||||||
if (HAL_UART_Init(&huart1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN USART1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Enable DMA controller clock
|
|
||||||
*/
|
|
||||||
static void MX_DMA_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* DMA controller clock enable */
|
|
||||||
__HAL_RCC_DMA1_CLK_ENABLE();
|
|
||||||
|
|
||||||
/* DMA interrupt init */
|
|
||||||
/* DMA1_Channel1_IRQn interrupt configuration */
|
|
||||||
HAL_NVIC_SetPriority(DMA1_Channel1_IRQn, 0, 0);
|
|
||||||
HAL_NVIC_EnableIRQ(DMA1_Channel1_IRQn);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOB, INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOA, BUZ_Pin|LED1_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : LED2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = LED2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(LED2_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : P1_Pin P2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = P1_Pin|P2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : AIN1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = AIN1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
||||||
HAL_GPIO_Init(AIN1_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : INH1_Pin INH2_Pin INH3_Pin INH4_Pin
|
|
||||||
EXP1_Pin EXP2_Pin EXP3_Pin */
|
|
||||||
GPIO_InitStruct.Pin = INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : CH1_Pin CH2_Pin CH3_Pin CH4_Pin */
|
|
||||||
GPIO_InitStruct.Pin = CH1_Pin|CH2_Pin|CH3_Pin|CH4_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : BUZ_Pin LED1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = BUZ_Pin|LED1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,45 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS((char*)s, strlen(s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,617 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
DMA_HandleTypeDef hdma_adc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
UART_HandleTypeDef huart1;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
|
|
||||||
uint8_t pulsanti=0;
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_DMA_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_USART1_UART_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
static uint8_t inidx=0;
|
|
||||||
static uint8_t inbuf[4];
|
|
||||||
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
inidx++;
|
|
||||||
inidx&=0x03;
|
|
||||||
if(HAL_GPIO_ReadPin(P1_GPIO_Port, P1_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP1;else inbuf[inidx]&=(~INP1);
|
|
||||||
if(HAL_GPIO_ReadPin(P2_GPIO_Port, P2_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP2;else inbuf[inidx]&=(~INP2);
|
|
||||||
pulsanti|=(inbuf[0]&inbuf[1]&inbuf[2]&inbuf[3]);
|
|
||||||
pulsanti&=(inbuf[0]|inbuf[1]|inbuf[2]|inbuf[3]);
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_DMA_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_USART1_UART_Init();
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
HAL_ADC_Start_DMA(&hadc1, (uint32_t *)adc_dma_buf, ADC_NUM_CHANNELS);
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
//CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
while (CDC_Transmit_FS((uint8_t*)"Start\r\n", 7) == USBD_BUSY);
|
|
||||||
if (EE_Init() != EE_OK){
|
|
||||||
for(;;);//errore eeprom
|
|
||||||
}
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_ENABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = ENABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 5;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_28CYCLES_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_5;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_2;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_6;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_3;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_7;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_4;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_8;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief USART1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_USART1_UART_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 1 */
|
|
||||||
huart1.Instance = USART1;
|
|
||||||
huart1.Init.BaudRate = 115200;
|
|
||||||
huart1.Init.WordLength = UART_WORDLENGTH_8B;
|
|
||||||
huart1.Init.StopBits = UART_STOPBITS_1;
|
|
||||||
huart1.Init.Parity = UART_PARITY_NONE;
|
|
||||||
huart1.Init.Mode = UART_MODE_TX_RX;
|
|
||||||
huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
||||||
huart1.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
||||||
if (HAL_UART_Init(&huart1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN USART1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Enable DMA controller clock
|
|
||||||
*/
|
|
||||||
static void MX_DMA_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* DMA controller clock enable */
|
|
||||||
__HAL_RCC_DMA1_CLK_ENABLE();
|
|
||||||
|
|
||||||
/* DMA interrupt init */
|
|
||||||
/* DMA1_Channel1_IRQn interrupt configuration */
|
|
||||||
HAL_NVIC_SetPriority(DMA1_Channel1_IRQn, 0, 0);
|
|
||||||
HAL_NVIC_EnableIRQ(DMA1_Channel1_IRQn);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOB, INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOA, BUZ_Pin|LED1_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : LED2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = LED2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(LED2_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : P1_Pin P2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = P1_Pin|P2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : AIN1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = AIN1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
||||||
HAL_GPIO_Init(AIN1_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : INH1_Pin INH2_Pin INH3_Pin INH4_Pin
|
|
||||||
EXP1_Pin EXP2_Pin EXP3_Pin */
|
|
||||||
GPIO_InitStruct.Pin = INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : CH1_Pin CH2_Pin CH3_Pin CH4_Pin */
|
|
||||||
GPIO_InitStruct.Pin = CH1_Pin|CH2_Pin|CH3_Pin|CH4_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : BUZ_Pin LED1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = BUZ_Pin|LED1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,644 +0,0 @@
|
|||||||
|
|
||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim1;
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim3;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_TIM3_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_TIM1_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_TIM3_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_TIM1_Init();
|
|
||||||
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_4);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_3);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_4);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_4);
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
|
|
||||||
|
|
||||||
CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
void manageCDC(void);
|
|
||||||
while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
}
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 1;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
TIM_BreakDeadTimeConfigTypeDef sBreakDeadTimeConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 1 */
|
|
||||||
htim1.Instance = TIM1;
|
|
||||||
htim1.Init.Prescaler = 0;
|
|
||||||
htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim1.Init.Period = 17999;
|
|
||||||
htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim1.Init.RepetitionCounter = 0;
|
|
||||||
htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim1, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 2400;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCNPolarity = TIM_OCNPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
sConfigOC.OCIdleState = TIM_OCIDLESTATE_RESET;
|
|
||||||
sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 5500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sBreakDeadTimeConfig.OffStateRunMode = TIM_OSSR_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.OffStateIDLEMode = TIM_OSSI_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.LockLevel = TIM_LOCKLEVEL_OFF;
|
|
||||||
sBreakDeadTimeConfig.DeadTime = 0;
|
|
||||||
sBreakDeadTimeConfig.BreakState = TIM_BREAK_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.BreakPolarity = TIM_BREAKPOLARITY_HIGH;
|
|
||||||
sBreakDeadTimeConfig.AutomaticOutput = TIM_AUTOMATICOUTPUT_DISABLE;
|
|
||||||
if (HAL_TIMEx_ConfigBreakDeadTime(&htim1, &sBreakDeadTimeConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim1);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM3 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM3_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 1 */
|
|
||||||
htim3.Instance = TIM3;
|
|
||||||
htim3.Init.Prescaler = 0;
|
|
||||||
htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim3.Init.Period = 17999;
|
|
||||||
htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim3, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim3, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 9000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 10000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 11000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 12000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM3_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim3);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_13, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : PC13 */
|
|
||||||
GPIO_InitStruct.Pin = GPIO_PIN_13;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,22 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.c
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool IsPwmRunning(TIM_HandleTypeDef *htim, uint32_t Channel)
|
|
||||||
{
|
|
||||||
HAL_TIM_ChannelStateTypeDef chState = HAL_TIM_GetChannelState(htim, Channel);
|
|
||||||
|
|
||||||
return (chState == HAL_TIM_CHANNEL_STATE_BUSY);
|
|
||||||
}
|
|
||||||
@@ -1,88 +0,0 @@
|
|||||||
/*
|
|
||||||
* eeprom.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 7, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef __EEPROM_H
|
|
||||||
#define __EEPROM_H
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
extern "C" {
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Simple EEPROM emulation for STM32F103C8T6 (medium density).
|
|
||||||
* - Uses 2 Flash pages (1 kB each) at the end of Flash.
|
|
||||||
* - Stores variables as 16-bit values identified by 16-bit "virtual addresses".
|
|
||||||
*
|
|
||||||
* You must define the list of virtual addresses in eeprom.c: EE_VirtAddrs[].
|
|
||||||
*/
|
|
||||||
|
|
||||||
typedef enum
|
|
||||||
{
|
|
||||||
EE_OK = 0,
|
|
||||||
EE_ERROR,
|
|
||||||
EE_NOT_FOUND,
|
|
||||||
EE_NO_SPACE
|
|
||||||
} EE_Status;
|
|
||||||
|
|
||||||
/* Flash parameters for STM32F103C8T6 */
|
|
||||||
#define EE_FLASH_BASE_ADDR 0x08000000U
|
|
||||||
#define EE_PAGE_SIZE 0x400U /* 1 kB pages */
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Here we assume a 64 kB Flash device (STM32F103C8T6):
|
|
||||||
* Flash range: 0x0800 0000 - 0x0800 FFFF
|
|
||||||
* Pages: 0..63 (64 pages)
|
|
||||||
* We use the last 2 pages for EEPROM:
|
|
||||||
* - Page 62: 0x0800 F800
|
|
||||||
* - Page 63: 0x0800 FC00
|
|
||||||
*/
|
|
||||||
#define EE_PAGE0_BASE (EE_FLASH_BASE_ADDR + (62U * EE_PAGE_SIZE))
|
|
||||||
#define EE_PAGE1_BASE (EE_FLASH_BASE_ADDR + (63U * EE_PAGE_SIZE))
|
|
||||||
|
|
||||||
/* Page status markers (stored in the first halfword of each page) */
|
|
||||||
#define EE_PAGE_STATUS_ERASED 0xFFFFU
|
|
||||||
#define EE_PAGE_STATUS_VALID 0xAAAAU
|
|
||||||
#define EE_PAGE_STATUS_RECEIVE 0x5555U
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Configure how many virtual variables you have.
|
|
||||||
* Example: bytes, words, and array elements mapped to 16-bit variables.
|
|
||||||
* Set EE_NUM_VIRTUAL_ADDR and define EE_VirtAddrs[] in eeprom.c.
|
|
||||||
*/
|
|
||||||
/* 32 virtual variables, sequential addresses */
|
|
||||||
#define EE_NUM_VIRTUAL_ADDR 32U
|
|
||||||
#define EEW_ADDR(i) (uint16_t)(0x0001 + (i)) // i = 0..31
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* Virtual address table (defined in eeprom.c, can be customized) */
|
|
||||||
extern const uint16_t EE_VirtAddrs[EE_NUM_VIRTUAL_ADDR];
|
|
||||||
|
|
||||||
/* Public API */
|
|
||||||
EE_Status EE_Init(void);
|
|
||||||
EE_Status EE_ReadVariable(uint16_t VirtAddress, uint16_t *Data);
|
|
||||||
EE_Status EE_WriteVariable(uint16_t VirtAddress, uint16_t Data);
|
|
||||||
|
|
||||||
/* Pseudo-array accessor */
|
|
||||||
static inline EE_Status EEW_Read(uint8_t idx, uint16_t *value)
|
|
||||||
{
|
|
||||||
return EE_ReadVariable(EEW_ADDR(idx), value);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline EE_Status EEW_Write(uint8_t idx, uint16_t value)
|
|
||||||
{
|
|
||||||
return EE_WriteVariable(EEW_ADDR(idx), value);
|
|
||||||
}
|
|
||||||
#ifdef __cplusplus
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#endif /* __EEPROM_H */
|
|
||||||
|
|
||||||
@@ -1,16 +0,0 @@
|
|||||||
/*
|
|
||||||
* adc.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 8, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef INC_ADC_H_
|
|
||||||
#define INC_ADC_H_
|
|
||||||
|
|
||||||
#define ADC_NUM_CHANNELS 5 // CH4..CH8
|
|
||||||
#define ADC_AVG_WINDOW 5 // 5 * 10ms = 50ms averaging window
|
|
||||||
|
|
||||||
void manageAdc(void);
|
|
||||||
|
|
||||||
#endif /* INC_ADC_H_ */
|
|
||||||
@@ -1,632 +0,0 @@
|
|||||||
|
|
||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim1;
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim3;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_TIM3_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_TIM1_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_TIM3_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_TIM1_Init();
|
|
||||||
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_4);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_3);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_4);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_4);
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
|
|
||||||
|
|
||||||
CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
void manageCDC(void);
|
|
||||||
}
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 1;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
TIM_BreakDeadTimeConfigTypeDef sBreakDeadTimeConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 1 */
|
|
||||||
htim1.Instance = TIM1;
|
|
||||||
htim1.Init.Prescaler = 0;
|
|
||||||
htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim1.Init.Period = 17999;
|
|
||||||
htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim1.Init.RepetitionCounter = 0;
|
|
||||||
htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim1, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 2400;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCNPolarity = TIM_OCNPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
sConfigOC.OCIdleState = TIM_OCIDLESTATE_RESET;
|
|
||||||
sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 5500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sBreakDeadTimeConfig.OffStateRunMode = TIM_OSSR_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.OffStateIDLEMode = TIM_OSSI_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.LockLevel = TIM_LOCKLEVEL_OFF;
|
|
||||||
sBreakDeadTimeConfig.DeadTime = 0;
|
|
||||||
sBreakDeadTimeConfig.BreakState = TIM_BREAK_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.BreakPolarity = TIM_BREAKPOLARITY_HIGH;
|
|
||||||
sBreakDeadTimeConfig.AutomaticOutput = TIM_AUTOMATICOUTPUT_DISABLE;
|
|
||||||
if (HAL_TIMEx_ConfigBreakDeadTime(&htim1, &sBreakDeadTimeConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim1);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM3 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM3_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 1 */
|
|
||||||
htim3.Instance = TIM3;
|
|
||||||
htim3.Init.Prescaler = 0;
|
|
||||||
htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim3.Init.Period = 17999;
|
|
||||||
htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim3, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim3, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 9000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 10000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 11000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 12000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM3_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim3);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_13, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : PC13 */
|
|
||||||
GPIO_InitStruct.Pin = GPIO_PIN_13;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,295 +0,0 @@
|
|||||||
#include "eeprom.h"
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Record format (4 bytes):
|
|
||||||
* [0] VirtAddress (uint16_t)
|
|
||||||
* [2] Data (uint16_t)
|
|
||||||
*
|
|
||||||
* Page layout:
|
|
||||||
* [0] PageStatus (uint16_t)
|
|
||||||
* [2..] Records...
|
|
||||||
*/
|
|
||||||
|
|
||||||
typedef struct
|
|
||||||
{
|
|
||||||
uint16_t VirtAddress;
|
|
||||||
uint16_t Data;
|
|
||||||
} EE_Record_t;
|
|
||||||
|
|
||||||
/* Active page base address (runtime selected in EE_Init) */
|
|
||||||
static uint32_t EE_ActivePageBase = EE_PAGE0_BASE;
|
|
||||||
|
|
||||||
/* 32 sequential virtual addresses */
|
|
||||||
const uint16_t EE_VirtAddrs[EE_NUM_VIRTUAL_ADDR] =
|
|
||||||
{
|
|
||||||
0x0001, 0x0002, 0x0003, 0x0004,
|
|
||||||
0x0005, 0x0006, 0x0007, 0x0008,
|
|
||||||
0x0009, 0x000A, 0x000B, 0x000C,
|
|
||||||
0x000D, 0x000E, 0x000F, 0x0010,
|
|
||||||
0x0011, 0x0012, 0x0013, 0x0014,
|
|
||||||
0x0015, 0x0016, 0x0017, 0x0018,
|
|
||||||
0x0019, 0x001A, 0x001B, 0x001C,
|
|
||||||
0x001D, 0x001E, 0x001F, 0x0020
|
|
||||||
};
|
|
||||||
/* ========================================================================= */
|
|
||||||
|
|
||||||
/* --- Internal helpers ---------------------------------------------------- */
|
|
||||||
|
|
||||||
static uint16_t EE_GetPageStatus(uint32_t pageBase)
|
|
||||||
{
|
|
||||||
return *(__IO uint16_t *)pageBase;
|
|
||||||
}
|
|
||||||
|
|
||||||
static HAL_StatusTypeDef EE_FlashProgramHalfWord(uint32_t Address, uint16_t Data)
|
|
||||||
{
|
|
||||||
HAL_StatusTypeDef status;
|
|
||||||
|
|
||||||
HAL_FLASH_Unlock();
|
|
||||||
status = HAL_FLASH_Program(FLASH_TYPEPROGRAM_HALFWORD, Address, Data);
|
|
||||||
HAL_FLASH_Lock();
|
|
||||||
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
|
|
||||||
static HAL_StatusTypeDef EE_FlashErasePage(uint32_t PageAddress)
|
|
||||||
{
|
|
||||||
HAL_StatusTypeDef status;
|
|
||||||
FLASH_EraseInitTypeDef EraseInit;
|
|
||||||
uint32_t PageError = 0;
|
|
||||||
|
|
||||||
HAL_FLASH_Unlock();
|
|
||||||
|
|
||||||
EraseInit.TypeErase = FLASH_TYPEERASE_PAGES;
|
|
||||||
EraseInit.PageAddress = PageAddress;
|
|
||||||
EraseInit.NbPages = 1;
|
|
||||||
|
|
||||||
status = HAL_FLASHEx_Erase(&EraseInit, &PageError);
|
|
||||||
|
|
||||||
HAL_FLASH_Lock();
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Find first free record address in given page (returns 0 if full) */
|
|
||||||
static uint32_t EE_FindFreeAddress(uint32_t pageBase)
|
|
||||||
{
|
|
||||||
uint32_t addr = pageBase + 2U; /* Skip status word */
|
|
||||||
uint32_t pageEnd = pageBase + EE_PAGE_SIZE;
|
|
||||||
|
|
||||||
while (addr < (pageEnd - sizeof(EE_Record_t) + 1U))
|
|
||||||
{
|
|
||||||
uint16_t vaddr = *(__IO uint16_t *)addr;
|
|
||||||
|
|
||||||
if (vaddr == 0xFFFFU)
|
|
||||||
{
|
|
||||||
/* Empty slot */
|
|
||||||
return addr;
|
|
||||||
}
|
|
||||||
addr += sizeof(EE_Record_t);
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0U; /* No space */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Find latest value of VirtAddress in a specific page (internal, uses EE_Status) */
|
|
||||||
static EE_Status EE_FindInPage(uint32_t pageBase, uint16_t VirtAddress, uint16_t *Data)
|
|
||||||
{
|
|
||||||
uint32_t pageEnd = pageBase + EE_PAGE_SIZE;
|
|
||||||
uint32_t addr;
|
|
||||||
|
|
||||||
if (Data == NULL)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
/* Start from last possible record and go backwards */
|
|
||||||
for (addr = pageEnd - sizeof(EE_Record_t);
|
|
||||||
addr >= pageBase + 2U; // <-- FIX HERE
|
|
||||||
addr -= sizeof(EE_Record_t))
|
|
||||||
{
|
|
||||||
uint16_t vaddr = *(__IO uint16_t *)addr;
|
|
||||||
uint16_t value = *(__IO uint16_t *)(addr + 2U);
|
|
||||||
|
|
||||||
if (vaddr == 0xFFFFU)
|
|
||||||
{
|
|
||||||
/* Empty slot, skip */
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (vaddr == VirtAddress)
|
|
||||||
{
|
|
||||||
*Data = value;
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return EE_STATUS_NOT_FOUND; // or EE_NOT_FOUND depending on your enum
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* Format both pages: erase and set PAGE0 as VALID */
|
|
||||||
static EE_Status EE_Format(void)
|
|
||||||
{
|
|
||||||
if (EE_FlashErasePage(EE_PAGE0_BASE) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
if (EE_FlashErasePage(EE_PAGE1_BASE) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
if (EE_FlashProgramHalfWord(EE_PAGE0_BASE, EE_PAGE_STATUS_VALID) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* PAGE1 will remain erased (status = 0xFFFF) */
|
|
||||||
EE_ActivePageBase = EE_PAGE0_BASE;
|
|
||||||
|
|
||||||
return EE_STATUS_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Get the base of the other page */
|
|
||||||
static uint32_t EE_GetOtherPageBase(uint32_t pageBase)
|
|
||||||
{
|
|
||||||
return (pageBase == EE_PAGE0_BASE) ? EE_PAGE1_BASE : EE_PAGE0_BASE;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Page transfer (garbage collection + new write) */
|
|
||||||
static EE_Status EE_PageTransfer(uint16_t VirtAddress, uint16_t Data)
|
|
||||||
{
|
|
||||||
uint32_t oldBase = EE_ActivePageBase;
|
|
||||||
uint32_t newBase = EE_GetOtherPageBase(oldBase);
|
|
||||||
uint32_t addr;
|
|
||||||
uint16_t value;
|
|
||||||
EE_Status st;
|
|
||||||
|
|
||||||
/* Erase new page */
|
|
||||||
if (EE_FlashErasePage(newBase) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Mark new page as RECEIVE */
|
|
||||||
if (EE_FlashProgramHalfWord(newBase, EE_PAGE_STATUS_RECEIVE) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Start writing records just after status */
|
|
||||||
addr = newBase + 2U;
|
|
||||||
|
|
||||||
/* For each known virtual variable */
|
|
||||||
for (uint16_t i = 0; i < EE_NUM_VIRTUAL_ADDR; i++)
|
|
||||||
{
|
|
||||||
uint16_t vaddr = EE_VirtAddrs[i];
|
|
||||||
|
|
||||||
if (vaddr == VirtAddress)
|
|
||||||
{
|
|
||||||
/* Use the new data passed into PageTransfer */
|
|
||||||
value = Data;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
/* Read latest value from old active page */
|
|
||||||
st = EE_FindInPage(oldBase, vaddr, &value);
|
|
||||||
if (st != EE_STATUS_OK)
|
|
||||||
{
|
|
||||||
/* Variable never written -> skip */
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Write record to new page */
|
|
||||||
if (EE_FlashProgramHalfWord(addr, vaddr) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
if (EE_FlashProgramHalfWord(addr + 2U, value) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
addr += sizeof(EE_Record_t);
|
|
||||||
if (addr >= (newBase + EE_PAGE_SIZE))
|
|
||||||
return EE_STATUS_NO_SPACE;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Erase old page */
|
|
||||||
if (EE_FlashErasePage(oldBase) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Mark new page as VALID */
|
|
||||||
if (EE_FlashProgramHalfWord(newBase, EE_PAGE_STATUS_VALID) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Update active page */
|
|
||||||
EE_ActivePageBase = newBase;
|
|
||||||
|
|
||||||
return EE_STATUS_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* --- Public API ----------------------------------------------------------- */
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Initialize the EEPROM emulation.
|
|
||||||
* - Checks page statuses and chooses the active page.
|
|
||||||
* - If inconsistent or blank, formats pages.
|
|
||||||
* PUBLIC RETURN TYPE: uint16_t (EE_OK / EE_ERROR / ...)
|
|
||||||
*/
|
|
||||||
uint16_t EE_Init(void)
|
|
||||||
{
|
|
||||||
uint16_t status0 = EE_GetPageStatus(EE_PAGE0_BASE);
|
|
||||||
uint16_t status1 = EE_GetPageStatus(EE_PAGE1_BASE);
|
|
||||||
|
|
||||||
if ((status0 == EE_PAGE_STATUS_ERASED) && (status1 == EE_PAGE_STATUS_ERASED))
|
|
||||||
{
|
|
||||||
/* Fresh device -> format */
|
|
||||||
return (uint16_t)EE_Format();
|
|
||||||
}
|
|
||||||
else if ((status0 == EE_PAGE_STATUS_VALID) && (status1 == EE_PAGE_STATUS_ERASED))
|
|
||||||
{
|
|
||||||
EE_ActivePageBase = EE_PAGE0_BASE;
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
else if ((status1 == EE_PAGE_STATUS_VALID) && (status0 == EE_PAGE_STATUS_ERASED))
|
|
||||||
{
|
|
||||||
EE_ActivePageBase = EE_PAGE1_BASE;
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
/* Any weird or inconsistent state -> reformat */
|
|
||||||
return (uint16_t)EE_Format();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Read a 16-bit variable by its virtual address.
|
|
||||||
* PUBLIC RETURN: EE_OK / EE_NOT_FOUND / EE_ERROR (as uint16_t)
|
|
||||||
*/
|
|
||||||
uint16_t EE_ReadVariable(uint16_t VirtAddress, uint16_t *Data)
|
|
||||||
{
|
|
||||||
EE_Status st;
|
|
||||||
|
|
||||||
if (Data == NULL)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
st = EE_FindInPage(EE_ActivePageBase, VirtAddress, Data);
|
|
||||||
return (uint16_t)st;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Write (append) a 16-bit variable.
|
|
||||||
* - Writes a new record in the active page.
|
|
||||||
* - If the page is full, triggers a page transfer (GC).
|
|
||||||
* PUBLIC RETURN: EE_OK / EE_ERROR / EE_NO_SPACE (as uint16_t)
|
|
||||||
*/
|
|
||||||
uint16_t EE_WriteVariable(uint16_t VirtAddress, uint16_t Data)
|
|
||||||
{
|
|
||||||
uint32_t freeAddr;
|
|
||||||
EE_Status st;
|
|
||||||
|
|
||||||
/* Find free space in active page */
|
|
||||||
freeAddr = EE_FindFreeAddress(EE_ActivePageBase);
|
|
||||||
if (freeAddr != 0U)
|
|
||||||
{
|
|
||||||
/* Write new record */
|
|
||||||
if (EE_FlashProgramHalfWord(freeAddr, VirtAddress) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
if (EE_FlashProgramHalfWord(freeAddr + 2U, Data) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* No space -> page transfer */
|
|
||||||
st = EE_PageTransfer(VirtAddress, Data);
|
|
||||||
return (uint16_t)st;
|
|
||||||
}
|
|
||||||
@@ -1,105 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]>='r'){
|
|
||||||
|
|
||||||
}else if(rxbuf[1]>='w'){
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY); }
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,193 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t eeadd;
|
|
||||||
uint8_t i;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
EEW_Write(eeadd, val);
|
|
||||||
sprintf((char*)s,"\ndone");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='d'){
|
|
||||||
if(rxidx==2){
|
|
||||||
for(i=0;i<32;i++){
|
|
||||||
if((i%4)==0){
|
|
||||||
sprintf((char*)s,"\n");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
EEW_Read(i, &val);
|
|
||||||
sprintf((char*)s,"0x%02x=0x%04x ",i,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ed");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w|d");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,76 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,s,dm,m,c,d,u;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
s=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
s=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if((rxbuf[3]>='0')&&(rxbuf[1]<='9')){
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,177 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t eeadd;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]>='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%c%c=%04x",rxbuf[2],rxbuf[3],val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]>='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
EEW_Write(eeadd, val);
|
|
||||||
sprintf((char*)s,"\ndone");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,643 +0,0 @@
|
|||||||
|
|
||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim1;
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim3;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_TIM3_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_TIM1_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_TIM3_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_TIM1_Init();
|
|
||||||
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_4);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_3);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_4);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_4);
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
|
|
||||||
|
|
||||||
CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
while (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
unsigned char s[100];
|
|
||||||
sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 1;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
TIM_BreakDeadTimeConfigTypeDef sBreakDeadTimeConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 1 */
|
|
||||||
htim1.Instance = TIM1;
|
|
||||||
htim1.Init.Prescaler = 0;
|
|
||||||
htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim1.Init.Period = 17999;
|
|
||||||
htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim1.Init.RepetitionCounter = 0;
|
|
||||||
htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim1, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 2400;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCNPolarity = TIM_OCNPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
sConfigOC.OCIdleState = TIM_OCIDLESTATE_RESET;
|
|
||||||
sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 5500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sBreakDeadTimeConfig.OffStateRunMode = TIM_OSSR_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.OffStateIDLEMode = TIM_OSSI_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.LockLevel = TIM_LOCKLEVEL_OFF;
|
|
||||||
sBreakDeadTimeConfig.DeadTime = 0;
|
|
||||||
sBreakDeadTimeConfig.BreakState = TIM_BREAK_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.BreakPolarity = TIM_BREAKPOLARITY_HIGH;
|
|
||||||
sBreakDeadTimeConfig.AutomaticOutput = TIM_AUTOMATICOUTPUT_DISABLE;
|
|
||||||
if (HAL_TIMEx_ConfigBreakDeadTime(&htim1, &sBreakDeadTimeConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim1);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM3 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM3_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 1 */
|
|
||||||
htim3.Instance = TIM3;
|
|
||||||
htim3.Init.Prescaler = 0;
|
|
||||||
htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim3.Init.Period = 17999;
|
|
||||||
htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim3, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim3, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 9000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 10000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 11000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 12000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM3_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim3);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_13, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : PC13 */
|
|
||||||
GPIO_InitStruct.Pin = GPIO_PIN_13;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,37 +0,0 @@
|
|||||||
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,45 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,197 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
extern const uint16_t EE_VirtAddrs[];
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t st;
|
|
||||||
uint16_t eeadd;
|
|
||||||
uint8_t i;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
st=EEW_Read(EE_VirtAddrse[eeadd], &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\nee read error %d",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
st=EEW_Write(EE_VirtAddrse[eeadd], val);
|
|
||||||
if (st == EE_OK)sprintf((char*)s,"\ndone 0x%02x=0x%04x",eeadd,val);
|
|
||||||
else sprintf((char*)s,"\nee write error %d", st);
|
|
||||||
}else sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
}else sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
}else sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else if(rxbuf[1]=='d'){
|
|
||||||
if(rxidx==2){
|
|
||||||
for(i=0;i<32;i++){
|
|
||||||
if((i%4)==0){
|
|
||||||
sprintf((char*)s,"\n");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
st=EEW_Read(EE_VirtAddrse[i], &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"0x%02x=0x%04x ",i,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"rderr %d ",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ed");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w|d");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,193 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t eeadd;
|
|
||||||
uint8_t i;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
EEW_Write(eeadd, val);
|
|
||||||
sprintf((char*)s,"\ndone 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='d'){
|
|
||||||
if(rxidx==2){
|
|
||||||
for(i=0;i<32;i++){
|
|
||||||
if((i%4)==0){
|
|
||||||
sprintf((char*)s,"\n");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
EEW_Read(i, &val);
|
|
||||||
sprintf((char*)s,"0x%02x=0x%04x ",i,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ed");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w|d");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,104 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.c
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool IsPwmRunning(TIM_HandleTypeDef *htim, uint32_t Channel)
|
|
||||||
{
|
|
||||||
HAL_TIM_ChannelStateTypeDef chState = HAL_TIM_GetChannelState(htim, Channel);
|
|
||||||
|
|
||||||
return (chState == HAL_TIM_CHANNEL_STATE_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
void StopMot(TIM_HandleTypeDef *htim,uint32_t Channel){
|
|
||||||
HAL_TIM_PWM_Stop(htim, Channel);
|
|
||||||
}
|
|
||||||
|
|
||||||
void StartMot(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval){
|
|
||||||
__HAL_TIM_SET_COMPARE(htim, Channel, pwmval);
|
|
||||||
HAL_TIM_PWM_Start(htim, Channel);
|
|
||||||
}
|
|
||||||
|
|
||||||
void SetMotPwm(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval){
|
|
||||||
__HAL_TIM_SET_COMPARE(htim, Channel, pwmval);
|
|
||||||
}
|
|
||||||
|
|
||||||
void SetMot(uint8_t mot,uint8_t dir,uint16_t pwmval){
|
|
||||||
TIM_HandleTypeDef *htim;
|
|
||||||
switch(mot){
|
|
||||||
case 1:
|
|
||||||
if(dir==FW){
|
|
||||||
if(IsPwmRunning(timMot1, FWMot1)){
|
|
||||||
SetMotPwm(timMot1,FWMot1,pwmval);
|
|
||||||
}else{
|
|
||||||
StartMot(timMot1,FWMot1,pwmval);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
if(IsPwmRunning(timMot1, BWMot1)){
|
|
||||||
SetMotPwm(timMot1,BWMot1,pwmval);
|
|
||||||
}else{
|
|
||||||
StartMot(timMot1,BWMot1,pwmval);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
if(dir==FW){
|
|
||||||
if(IsPwmRunning(timMot2, FWMot2)){
|
|
||||||
SetMotPwm(timMot2,FWMot2,pwmval);
|
|
||||||
}else{
|
|
||||||
StartMot(timMot2,FWMot2,pwmval);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
if(IsPwmRunning(timMot2, BWMot2)){
|
|
||||||
SetMotPwm(timMot2,BWMot2,pwmval);
|
|
||||||
}else{
|
|
||||||
StartMot(timMot2,BWMot2,pwmval);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 3:
|
|
||||||
if(dir==FW){
|
|
||||||
if(IsPwmRunning(timMot3, FWMot3)){
|
|
||||||
SetMotPwm(timMot3,FWMot3,pwmval);
|
|
||||||
}else{
|
|
||||||
StartMot(timMot3,FWMot3,pwmval);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
if(IsPwmRunning(timMot3, BWMot3)){
|
|
||||||
SetMotPwm(timMot3,BWMot3,pwmval);
|
|
||||||
}else{
|
|
||||||
StartMot(timMot3,BWMot3,pwmval);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 4:
|
|
||||||
if(dir==FW){
|
|
||||||
if(IsPwmRunning(timMot4, FWMot4)){
|
|
||||||
SetMotPwm(timMot4,FWMot4,pwmval);
|
|
||||||
}else{
|
|
||||||
StartMot(timMot4,FWMot4,pwmval);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
if(IsPwmRunning(timMot4, BWMot4)){
|
|
||||||
SetMotPwm(timMot4,BWMot4,pwmval);
|
|
||||||
}else{
|
|
||||||
StartMot(timMot4,BWMot4,pwmval);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,138 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.c
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "main.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool IsPwmRunning(TIM_HandleTypeDef *htim, uint32_t Channel)
|
|
||||||
{
|
|
||||||
HAL_TIM_ChannelStateTypeDef chState = HAL_TIM_GetChannelState(htim, Channel);
|
|
||||||
|
|
||||||
return (chState == HAL_TIM_CHANNEL_STATE_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
void StopMot(TIM_HandleTypeDef *htim,uint32_t Channel){
|
|
||||||
HAL_TIM_PWM_Stop(htim, Channel);
|
|
||||||
}
|
|
||||||
|
|
||||||
void StartMot(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval){
|
|
||||||
__HAL_TIM_SET_COMPARE(htim, Channel, pwmval);
|
|
||||||
HAL_TIM_PWM_Start(htim, Channel);
|
|
||||||
}
|
|
||||||
|
|
||||||
void SetMotPwm(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval){
|
|
||||||
__HAL_TIM_SET_COMPARE(htim, Channel, pwmval);
|
|
||||||
}
|
|
||||||
|
|
||||||
void SetMot(uint8_t mot,uint8_t dir,uint16_t pwmval){
|
|
||||||
TIM_HandleTypeDef *htim;
|
|
||||||
switch(mot){
|
|
||||||
case 1:
|
|
||||||
if(dir==FW){
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
HAL_GPIO_WritePin(INH1_GPIO_Port, INH1_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot1, FWMot1)){
|
|
||||||
SetMotPwm(timMot1,FWMot1,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH1_GPIO_Port, INH1_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot1,FWMot1,pwmval);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
HAL_GPIO_WritePin(INH1_GPIO_Port, INH1_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot1, BWMot1)){
|
|
||||||
SetMotPwm(timMot1,BWMot1,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH1_GPIO_Port, INH1_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot1,BWMot1,pwmval);
|
|
||||||
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
if(dir==FW){
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
HAL_GPIO_WritePin(INH2_GPIO_Port, INH2_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot2, FWMot2)){
|
|
||||||
SetMotPwm(timMot2,FWMot2,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH2_GPIO_Port, INH2_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot2,FWMot2,pwmval);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
HAL_GPIO_WritePin(INH2_GPIO_Port, INH2_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot2, BWMot2)){
|
|
||||||
SetMotPwm(timMot2,BWMot2,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH2_GPIO_Port, INH2_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot2,BWMot2,pwmval);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 3:
|
|
||||||
if(dir==FW){
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
HAL_GPIO_WritePin(INH3_GPIO_Port, INH3_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot3, FWMot3)){
|
|
||||||
SetMotPwm(timMot3,FWMot3,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH3_GPIO_Port, INH3_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot3,FWMot3,pwmval);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
HAL_GPIO_WritePin(INH3_GPIO_Port, INH3_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot3, BWMot3)){
|
|
||||||
SetMotPwm(timMot3,BWMot3,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH3_GPIO_Port, INH3_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot3,BWMot3,pwmval);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 4:
|
|
||||||
if(dir==FW){
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
HAL_GPIO_WritePin(INH4_GPIO_Port, INH4_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot4, FWMot4)){
|
|
||||||
SetMotPwm(timMot4,FWMot4,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH4_GPIO_Port, INH4_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot4,FWMot4,pwmval);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
if(pwmval==0){
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
HAL_GPIO_WritePin(INH4_GPIO_Port, INH4_Pin, GPIO_PIN_RESET);
|
|
||||||
}else if(IsPwmRunning(timMot4, BWMot4)){
|
|
||||||
SetMotPwm(timMot4,BWMot4,pwmval);
|
|
||||||
}else{
|
|
||||||
HAL_GPIO_WritePin(INH4_GPIO_Port, INH4_Pin, GPIO_PIN_SET);
|
|
||||||
StartMot(timMot4,BWMot4,pwmval);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,644 +0,0 @@
|
|||||||
|
|
||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim1;
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim3;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_TIM3_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_TIM1_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_TIM3_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_TIM1_Init();
|
|
||||||
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_4);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_3);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_4);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_4);
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
|
|
||||||
|
|
||||||
CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 1;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
TIM_BreakDeadTimeConfigTypeDef sBreakDeadTimeConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 1 */
|
|
||||||
htim1.Instance = TIM1;
|
|
||||||
htim1.Init.Prescaler = 0;
|
|
||||||
htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim1.Init.Period = 17999;
|
|
||||||
htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim1.Init.RepetitionCounter = 0;
|
|
||||||
htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim1, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 2400;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCNPolarity = TIM_OCNPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
sConfigOC.OCIdleState = TIM_OCIDLESTATE_RESET;
|
|
||||||
sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 5500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sBreakDeadTimeConfig.OffStateRunMode = TIM_OSSR_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.OffStateIDLEMode = TIM_OSSI_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.LockLevel = TIM_LOCKLEVEL_OFF;
|
|
||||||
sBreakDeadTimeConfig.DeadTime = 0;
|
|
||||||
sBreakDeadTimeConfig.BreakState = TIM_BREAK_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.BreakPolarity = TIM_BREAKPOLARITY_HIGH;
|
|
||||||
sBreakDeadTimeConfig.AutomaticOutput = TIM_AUTOMATICOUTPUT_DISABLE;
|
|
||||||
if (HAL_TIMEx_ConfigBreakDeadTime(&htim1, &sBreakDeadTimeConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim1);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM3 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM3_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 1 */
|
|
||||||
htim3.Instance = TIM3;
|
|
||||||
htim3.Init.Prescaler = 0;
|
|
||||||
htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim3.Init.Period = 17999;
|
|
||||||
htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim3, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim3, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 9000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 10000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 11000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 12000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM3_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim3);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_13, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : PC13 */
|
|
||||||
GPIO_InitStruct.Pin = GPIO_PIN_13;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,180 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t eeadd;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
EEW_Write(eeadd, val);
|
|
||||||
sprintf((char*)s,"\ndone");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w|d");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,296 +0,0 @@
|
|||||||
#include "eeprom.h"
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Record format (4 bytes):
|
|
||||||
* [0] VirtAddress (uint16_t)
|
|
||||||
* [2] Data (uint16_t)
|
|
||||||
*
|
|
||||||
* Page layout:
|
|
||||||
* [0] PageStatus (uint16_t)
|
|
||||||
* [2..] Records...
|
|
||||||
*/
|
|
||||||
|
|
||||||
typedef struct
|
|
||||||
{
|
|
||||||
uint16_t VirtAddress;
|
|
||||||
uint16_t Data;
|
|
||||||
} EE_Record_t;
|
|
||||||
|
|
||||||
/* Active page base address (runtime selected in EE_Init) */
|
|
||||||
static uint32_t EE_ActivePageBase = EE_PAGE0_BASE;
|
|
||||||
|
|
||||||
/* 32 sequential virtual addresses */
|
|
||||||
const uint16_t EE_VirtAddrs[EE_NUM_VIRTUAL_ADDR] =
|
|
||||||
{
|
|
||||||
0x0001, 0x0002, 0x0003, 0x0004,
|
|
||||||
0x0005, 0x0006, 0x0007, 0x0008,
|
|
||||||
0x0009, 0x000A, 0x000B, 0x000C,
|
|
||||||
0x000D, 0x000E, 0x000F, 0x0010,
|
|
||||||
0x0011, 0x0012, 0x0013, 0x0014,
|
|
||||||
0x0015, 0x0016, 0x0017, 0x0018,
|
|
||||||
0x0019, 0x001A, 0x001B, 0x001C,
|
|
||||||
0x001D, 0x001E, 0x001F, 0x0020
|
|
||||||
};
|
|
||||||
/* ========================================================================= */
|
|
||||||
|
|
||||||
/* --- Internal helpers ---------------------------------------------------- */
|
|
||||||
|
|
||||||
static uint16_t EE_GetPageStatus(uint32_t pageBase)
|
|
||||||
{
|
|
||||||
return *(__IO uint16_t *)pageBase;
|
|
||||||
}
|
|
||||||
|
|
||||||
static HAL_StatusTypeDef EE_FlashProgramHalfWord(uint32_t Address, uint16_t Data)
|
|
||||||
{
|
|
||||||
HAL_StatusTypeDef status;
|
|
||||||
|
|
||||||
HAL_FLASH_Unlock();
|
|
||||||
status = HAL_FLASH_Program(FLASH_TYPEPROGRAM_HALFWORD, Address, Data);
|
|
||||||
HAL_FLASH_Lock();
|
|
||||||
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
|
|
||||||
static HAL_StatusTypeDef EE_FlashErasePage(uint32_t PageAddress)
|
|
||||||
{
|
|
||||||
HAL_StatusTypeDef status;
|
|
||||||
FLASH_EraseInitTypeDef EraseInit;
|
|
||||||
uint32_t PageError = 0;
|
|
||||||
|
|
||||||
HAL_FLASH_Unlock();
|
|
||||||
|
|
||||||
EraseInit.TypeErase = FLASH_TYPEERASE_PAGES;
|
|
||||||
EraseInit.PageAddress = PageAddress;
|
|
||||||
EraseInit.NbPages = 1;
|
|
||||||
|
|
||||||
status = HAL_FLASHEx_Erase(&EraseInit, &PageError);
|
|
||||||
|
|
||||||
HAL_FLASH_Lock();
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Find first free record address in given page (returns 0 if full) */
|
|
||||||
static uint32_t EE_FindFreeAddress(uint32_t pageBase)
|
|
||||||
{
|
|
||||||
uint32_t addr = pageBase + 2U; /* Skip status word */
|
|
||||||
uint32_t pageEnd = pageBase + EE_PAGE_SIZE;
|
|
||||||
|
|
||||||
while (addr < (pageEnd - sizeof(EE_Record_t) + 1U))
|
|
||||||
{
|
|
||||||
uint16_t vaddr = *(__IO uint16_t *)addr;
|
|
||||||
|
|
||||||
if (vaddr == 0xFFFFU)
|
|
||||||
{
|
|
||||||
/* Empty slot */
|
|
||||||
return addr;
|
|
||||||
}
|
|
||||||
addr += sizeof(EE_Record_t);
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0U; /* No space */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Find latest value of VirtAddress in a specific page (internal, uses EE_Status) */
|
|
||||||
static EE_Status EE_FindInPage(uint32_t pageBase, uint16_t VirtAddress, uint16_t *Data)
|
|
||||||
{
|
|
||||||
uint32_t pageEnd = pageBase + EE_PAGE_SIZE;
|
|
||||||
uint32_t addr;
|
|
||||||
|
|
||||||
if (Data == NULL)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
/* Start from last possible record and go backwards */
|
|
||||||
/* Start from last possible record and go backwards */
|
|
||||||
for (addr = pageEnd - sizeof(EE_Record_t);
|
|
||||||
addr >= pageBase + 2U; // *** FIX HERE ***
|
|
||||||
addr -= sizeof(EE_Record_t))
|
|
||||||
{
|
|
||||||
uint16_t vaddr = *(__IO uint16_t *)addr;
|
|
||||||
uint16_t value = *(__IO uint16_t *)(addr + 2U);
|
|
||||||
|
|
||||||
if (vaddr == 0xFFFFU)
|
|
||||||
{
|
|
||||||
/* Empty slot, skip */
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (vaddr == VirtAddress)
|
|
||||||
{
|
|
||||||
*Data = value;
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return EE_NOT_FOUND;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* Format both pages: erase and set PAGE0 as VALID */
|
|
||||||
static EE_Status EE_Format(void)
|
|
||||||
{
|
|
||||||
if (EE_FlashErasePage(EE_PAGE0_BASE) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
if (EE_FlashErasePage(EE_PAGE1_BASE) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
if (EE_FlashProgramHalfWord(EE_PAGE0_BASE, EE_PAGE_STATUS_VALID) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* PAGE1 will remain erased (status = 0xFFFF) */
|
|
||||||
EE_ActivePageBase = EE_PAGE0_BASE;
|
|
||||||
|
|
||||||
return EE_STATUS_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Get the base of the other page */
|
|
||||||
static uint32_t EE_GetOtherPageBase(uint32_t pageBase)
|
|
||||||
{
|
|
||||||
return (pageBase == EE_PAGE0_BASE) ? EE_PAGE1_BASE : EE_PAGE0_BASE;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Page transfer (garbage collection + new write) */
|
|
||||||
static EE_Status EE_PageTransfer(uint16_t VirtAddress, uint16_t Data)
|
|
||||||
{
|
|
||||||
uint32_t oldBase = EE_ActivePageBase;
|
|
||||||
uint32_t newBase = EE_GetOtherPageBase(oldBase);
|
|
||||||
uint32_t addr;
|
|
||||||
uint16_t value;
|
|
||||||
EE_Status st;
|
|
||||||
|
|
||||||
/* Erase new page */
|
|
||||||
if (EE_FlashErasePage(newBase) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Mark new page as RECEIVE */
|
|
||||||
if (EE_FlashProgramHalfWord(newBase, EE_PAGE_STATUS_RECEIVE) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Start writing records just after status */
|
|
||||||
addr = newBase + 2U;
|
|
||||||
|
|
||||||
/* For each known virtual variable */
|
|
||||||
for (uint16_t i = 0; i < EE_NUM_VIRTUAL_ADDR; i++)
|
|
||||||
{
|
|
||||||
uint16_t vaddr = EE_VirtAddrs[i];
|
|
||||||
|
|
||||||
if (vaddr == VirtAddress)
|
|
||||||
{
|
|
||||||
/* Use the new data passed into PageTransfer */
|
|
||||||
value = Data;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
/* Read latest value from old active page */
|
|
||||||
st = EE_FindInPage(oldBase, vaddr, &value);
|
|
||||||
if (st != EE_STATUS_OK)
|
|
||||||
{
|
|
||||||
/* Variable never written -> skip */
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Write record to new page */
|
|
||||||
if (EE_FlashProgramHalfWord(addr, vaddr) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
if (EE_FlashProgramHalfWord(addr + 2U, value) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
addr += sizeof(EE_Record_t);
|
|
||||||
if (addr >= (newBase + EE_PAGE_SIZE))
|
|
||||||
return EE_STATUS_NO_SPACE;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Erase old page */
|
|
||||||
if (EE_FlashErasePage(oldBase) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Mark new page as VALID */
|
|
||||||
if (EE_FlashProgramHalfWord(newBase, EE_PAGE_STATUS_VALID) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Update active page */
|
|
||||||
EE_ActivePageBase = newBase;
|
|
||||||
|
|
||||||
return EE_STATUS_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* --- Public API ----------------------------------------------------------- */
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Initialize the EEPROM emulation.
|
|
||||||
* - Checks page statuses and chooses the active page.
|
|
||||||
* - If inconsistent or blank, formats pages.
|
|
||||||
* PUBLIC RETURN TYPE: uint16_t (EE_OK / EE_ERROR / ...)
|
|
||||||
*/
|
|
||||||
uint16_t EE_Init(void)
|
|
||||||
{
|
|
||||||
uint16_t status0 = EE_GetPageStatus(EE_PAGE0_BASE);
|
|
||||||
uint16_t status1 = EE_GetPageStatus(EE_PAGE1_BASE);
|
|
||||||
|
|
||||||
if ((status0 == EE_PAGE_STATUS_ERASED) && (status1 == EE_PAGE_STATUS_ERASED))
|
|
||||||
{
|
|
||||||
/* Fresh device -> format */
|
|
||||||
return (uint16_t)EE_Format();
|
|
||||||
}
|
|
||||||
else if ((status0 == EE_PAGE_STATUS_VALID) && (status1 == EE_PAGE_STATUS_ERASED))
|
|
||||||
{
|
|
||||||
EE_ActivePageBase = EE_PAGE0_BASE;
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
else if ((status1 == EE_PAGE_STATUS_VALID) && (status0 == EE_PAGE_STATUS_ERASED))
|
|
||||||
{
|
|
||||||
EE_ActivePageBase = EE_PAGE1_BASE;
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
/* Any weird or inconsistent state -> reformat */
|
|
||||||
return (uint16_t)EE_Format();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Read a 16-bit variable by its virtual address.
|
|
||||||
* PUBLIC RETURN: EE_OK / EE_NOT_FOUND / EE_ERROR (as uint16_t)
|
|
||||||
*/
|
|
||||||
uint16_t EE_ReadVariable(uint16_t VirtAddress, uint16_t *Data)
|
|
||||||
{
|
|
||||||
EE_Status st;
|
|
||||||
|
|
||||||
if (Data == NULL)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
st = EE_FindInPage(EE_ActivePageBase, VirtAddress, Data);
|
|
||||||
return (uint16_t)st;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Write (append) a 16-bit variable.
|
|
||||||
* - Writes a new record in the active page.
|
|
||||||
* - If the page is full, triggers a page transfer (GC).
|
|
||||||
* PUBLIC RETURN: EE_OK / EE_ERROR / EE_NO_SPACE (as uint16_t)
|
|
||||||
*/
|
|
||||||
uint16_t EE_WriteVariable(uint16_t VirtAddress, uint16_t Data)
|
|
||||||
{
|
|
||||||
uint32_t freeAddr;
|
|
||||||
EE_Status st;
|
|
||||||
|
|
||||||
/* Find free space in active page */
|
|
||||||
freeAddr = EE_FindFreeAddress(EE_ActivePageBase);
|
|
||||||
if (freeAddr != 0U)
|
|
||||||
{
|
|
||||||
/* Write new record */
|
|
||||||
if (EE_FlashProgramHalfWord(freeAddr, VirtAddress) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
if (EE_FlashProgramHalfWord(freeAddr + 2U, Data) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* No space -> page transfer */
|
|
||||||
st = EE_PageTransfer(VirtAddress, Data);
|
|
||||||
return (uint16_t)st;
|
|
||||||
}
|
|
||||||
@@ -1,94 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
//extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
//extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,45 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen(s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,87 +0,0 @@
|
|||||||
/*
|
|
||||||
* eeprom.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 7, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef __EEPROM_H
|
|
||||||
#define __EEPROM_H
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
extern "C" {
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Simple EEPROM emulation for STM32F103C8T6 (medium density).
|
|
||||||
* - Uses 2 Flash pages (1 kB each) at the end of Flash.
|
|
||||||
* - Stores variables as 16-bit values identified by 16-bit "virtual addresses".
|
|
||||||
*
|
|
||||||
* You must define the list of virtual addresses in eeprom.c: EE_VirtAddrs[].
|
|
||||||
*/
|
|
||||||
|
|
||||||
typedef enum
|
|
||||||
{
|
|
||||||
EE_OK = 0,
|
|
||||||
EE_ERROR,
|
|
||||||
EE_NOT_FOUND,
|
|
||||||
EE_NO_SPACE
|
|
||||||
} EE_Status;
|
|
||||||
|
|
||||||
/* Flash parameters for STM32F103C8T6 */
|
|
||||||
#define EE_FLASH_BASE_ADDR 0x08000000U
|
|
||||||
#define EE_PAGE_SIZE 0x400U /* 1 kB pages */
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Here we assume a 64 kB Flash device (STM32F103C8T6):
|
|
||||||
* Flash range: 0x0800 0000 - 0x0800 FFFF
|
|
||||||
* Pages: 0..63 (64 pages)
|
|
||||||
* We use the last 2 pages for EEPROM:
|
|
||||||
* - Page 62: 0x0800 F800
|
|
||||||
* - Page 63: 0x0800 FC00
|
|
||||||
*/
|
|
||||||
#define EE_PAGE0_BASE (EE_FLASH_BASE_ADDR + (62U * EE_PAGE_SIZE))
|
|
||||||
#define EE_PAGE1_BASE (EE_FLASH_BASE_ADDR + (63U * EE_PAGE_SIZE))
|
|
||||||
|
|
||||||
/* Page status markers (stored in the first halfword of each page) */
|
|
||||||
#define EE_PAGE_STATUS_ERASED 0xFFFFU
|
|
||||||
#define EE_PAGE_STATUS_VALID 0xAAAAU
|
|
||||||
#define EE_PAGE_STATUS_RECEIVE 0x5555U
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Configure how many virtual variables you have.
|
|
||||||
* Example: bytes, words, and array elements mapped to 16-bit variables.
|
|
||||||
* Set EE_NUM_VIRTUAL_ADDR and define EE_VirtAddrs[] in eeprom.c.
|
|
||||||
*/
|
|
||||||
/* 32 virtual variables, sequential addresses */
|
|
||||||
#define EE_NUM_VIRTUAL_ADDR 32U
|
|
||||||
#define EEW_ADDR(i) (uint16_t)(0x0001 + (i)) // i = 0..31
|
|
||||||
|
|
||||||
/* Pseudo-array accessor */
|
|
||||||
static inline EE_Status EEW_Read(uint8_t idx, uint16_t *value)
|
|
||||||
{
|
|
||||||
return EE_ReadVariable(EEW_ADDR(idx), value);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline EE_Status EEW_Write(uint8_t idx, uint16_t value)
|
|
||||||
{
|
|
||||||
return EE_WriteVariable(EEW_ADDR(idx), value);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/* Virtual address table (defined in eeprom.c, can be customized) */
|
|
||||||
extern const uint16_t EE_VirtAddrs[EE_NUM_VIRTUAL_ADDR];
|
|
||||||
|
|
||||||
/* Public API */
|
|
||||||
EE_Status EE_Init(void);
|
|
||||||
EE_Status EE_ReadVariable(uint16_t VirtAddress, uint16_t *Data);
|
|
||||||
EE_Status EE_WriteVariable(uint16_t VirtAddress, uint16_t Data);
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#endif /* __EEPROM_H */
|
|
||||||
|
|
||||||
@@ -1,198 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
extern const uint16_t EE_VirtAddrs[];
|
|
||||||
extern uint8_t pulsanti;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t st;
|
|
||||||
uint16_t eeadd;
|
|
||||||
uint8_t i;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\nP=0x%x ",pulsanti);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY); break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
st=EEW_Read(eeadd, &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\nee read error %d",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
st=EEW_Write(eeadd, val);
|
|
||||||
if (st == EE_OK)sprintf((char*)s,"\ndone 0x%02x=0x%04x",eeadd,val);
|
|
||||||
else sprintf((char*)s,"\nee write error %d", st);
|
|
||||||
}else sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
}else sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
}else sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else if(rxbuf[1]=='d'){
|
|
||||||
if(rxidx==2){
|
|
||||||
for(i=0;i<32;i++){
|
|
||||||
if((i%4)==0){
|
|
||||||
sprintf((char*)s,"\n");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
st=EEW_Read(i, &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"0x%02x=0x%04x ",i,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"rderr %d ",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ed");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w|d");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,197 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t st;
|
|
||||||
uint16_t eeadd;
|
|
||||||
uint8_t i;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
st=EEW_Read(EE_VirtAddrse[eadd], &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\nee read error %d",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
st=EEW_Write(EE_VirtAddrse[eadd], val);
|
|
||||||
if (st == EE_OK)sprintf((char*)s,"\ndone 0x%02x=0x%04x",eeadd,val);
|
|
||||||
else sprintf((char*)s,"\nee write error %d", st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
}else sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
}else sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else if(rxbuf[1]=='d'){
|
|
||||||
if(rxidx==2){
|
|
||||||
for(i=0;i<32;i++){
|
|
||||||
if((i%4)==0){
|
|
||||||
sprintf((char*)s,"\n");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
st=EEW_Read(EE_VirtAddrse[i], &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"0x%02x=0x%04x ",i,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"rderr %d ",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ed");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w|d");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,48 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x",__HAL_TIM_GET_COMPARE(timMot1,FWMot1),__HAL_TIM_GET_COMPARE(timMot1,BWMot1),__HAL_TIM_GET_COMPARE(timMot2,FWMot2),__HAL_TIM_GET_COMPARE(timMot2,BWMot2),__HAL_TIM_GET_COMPARE(timMot3,FWMot3),__HAL_TIM_GET_COMPARE(timMot3,BWMot3),__HAL_TIM_GET_COMPARE(timMot4,FWMot4),__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,291 +0,0 @@
|
|||||||
#include "eeprom.h"
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Record format (4 bytes):
|
|
||||||
* [0] VirtAddress (uint16_t)
|
|
||||||
* [2] Data (uint16_t)
|
|
||||||
*
|
|
||||||
* Page layout:
|
|
||||||
* [0] PageStatus (uint16_t)
|
|
||||||
* [2..] Records...
|
|
||||||
*/
|
|
||||||
|
|
||||||
typedef struct
|
|
||||||
{
|
|
||||||
uint16_t VirtAddress;
|
|
||||||
uint16_t Data;
|
|
||||||
} EE_Record_t;
|
|
||||||
|
|
||||||
/* Active page base address (runtime selected in EE_Init) */
|
|
||||||
static uint32_t EE_ActivePageBase = EE_PAGE0_BASE;
|
|
||||||
|
|
||||||
/* 32 sequential virtual addresses */
|
|
||||||
const uint16_t EE_VirtAddrs[EE_NUM_VIRTUAL_ADDR] =
|
|
||||||
{
|
|
||||||
0x0001, 0x0002, 0x0003, 0x0004,
|
|
||||||
0x0005, 0x0006, 0x0007, 0x0008,
|
|
||||||
0x0009, 0x000A, 0x000B, 0x000C,
|
|
||||||
0x000D, 0x000E, 0x000F, 0x0010,
|
|
||||||
0x0011, 0x0012, 0x0013, 0x0014,
|
|
||||||
0x0015, 0x0016, 0x0017, 0x0018,
|
|
||||||
0x0019, 0x001A, 0x001B, 0x001C,
|
|
||||||
0x001D, 0x001E, 0x001F, 0x0020
|
|
||||||
};
|
|
||||||
/* ========================================================================= */
|
|
||||||
|
|
||||||
/* --- Internal helpers ---------------------------------------------------- */
|
|
||||||
|
|
||||||
static uint16_t EE_GetPageStatus(uint32_t pageBase)
|
|
||||||
{
|
|
||||||
return *(__IO uint16_t *)pageBase;
|
|
||||||
}
|
|
||||||
|
|
||||||
static HAL_StatusTypeDef EE_FlashProgramHalfWord(uint32_t Address, uint16_t Data)
|
|
||||||
{
|
|
||||||
HAL_StatusTypeDef status;
|
|
||||||
|
|
||||||
HAL_FLASH_Unlock();
|
|
||||||
status = HAL_FLASH_Program(FLASH_TYPEPROGRAM_HALFWORD, Address, Data);
|
|
||||||
HAL_FLASH_Lock();
|
|
||||||
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
|
|
||||||
static HAL_StatusTypeDef EE_FlashErasePage(uint32_t PageAddress)
|
|
||||||
{
|
|
||||||
HAL_StatusTypeDef status;
|
|
||||||
FLASH_EraseInitTypeDef EraseInit;
|
|
||||||
uint32_t PageError = 0;
|
|
||||||
|
|
||||||
HAL_FLASH_Unlock();
|
|
||||||
|
|
||||||
EraseInit.TypeErase = FLASH_TYPEERASE_PAGES;
|
|
||||||
EraseInit.PageAddress = PageAddress;
|
|
||||||
EraseInit.NbPages = 1;
|
|
||||||
|
|
||||||
status = HAL_FLASHEx_Erase(&EraseInit, &PageError);
|
|
||||||
|
|
||||||
HAL_FLASH_Lock();
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Find first free record address in given page (returns 0 if full) */
|
|
||||||
static uint32_t EE_FindFreeAddress(uint32_t pageBase)
|
|
||||||
{
|
|
||||||
uint32_t addr = pageBase + 2U; /* Skip status word */
|
|
||||||
uint32_t pageEnd = pageBase + EE_PAGE_SIZE;
|
|
||||||
|
|
||||||
while (addr < (pageEnd - sizeof(EE_Record_t) + 1U))
|
|
||||||
{
|
|
||||||
uint16_t vaddr = *(__IO uint16_t *)addr;
|
|
||||||
|
|
||||||
if (vaddr == 0xFFFFU)
|
|
||||||
{
|
|
||||||
/* Empty slot */
|
|
||||||
return addr;
|
|
||||||
}
|
|
||||||
addr += sizeof(EE_Record_t);
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0U; /* No space */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Find latest value of VirtAddress in a specific page (internal, uses EE_Status) */
|
|
||||||
static EE_Status EE_FindInPage(uint32_t pageBase, uint16_t VirtAddress, uint16_t *Data)
|
|
||||||
{
|
|
||||||
uint32_t pageEnd = pageBase + EE_PAGE_SIZE;
|
|
||||||
uint32_t addr;
|
|
||||||
|
|
||||||
if (Data == NULL)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Start from last possible record and go backwards */
|
|
||||||
for (addr = pageEnd - sizeof(EE_Record_t); addr > pageBase + 1U; addr -= sizeof(EE_Record_t))
|
|
||||||
{
|
|
||||||
uint16_t vaddr = *(__IO uint16_t *)addr;
|
|
||||||
uint16_t value = *(__IO uint16_t *)(addr + 2U);
|
|
||||||
|
|
||||||
if (vaddr == 0xFFFFU)
|
|
||||||
{
|
|
||||||
/* Empty slot, skip */
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (vaddr == VirtAddress)
|
|
||||||
{
|
|
||||||
*Data = value;
|
|
||||||
return EE_STATUS_OK;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return EE_STATUS_NOT_FOUND;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Format both pages: erase and set PAGE0 as VALID */
|
|
||||||
static EE_Status EE_Format(void)
|
|
||||||
{
|
|
||||||
if (EE_FlashErasePage(EE_PAGE0_BASE) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
if (EE_FlashErasePage(EE_PAGE1_BASE) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
if (EE_FlashProgramHalfWord(EE_PAGE0_BASE, EE_PAGE_STATUS_VALID) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* PAGE1 will remain erased (status = 0xFFFF) */
|
|
||||||
EE_ActivePageBase = EE_PAGE0_BASE;
|
|
||||||
|
|
||||||
return EE_STATUS_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Get the base of the other page */
|
|
||||||
static uint32_t EE_GetOtherPageBase(uint32_t pageBase)
|
|
||||||
{
|
|
||||||
return (pageBase == EE_PAGE0_BASE) ? EE_PAGE1_BASE : EE_PAGE0_BASE;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Page transfer (garbage collection + new write) */
|
|
||||||
static EE_Status EE_PageTransfer(uint16_t VirtAddress, uint16_t Data)
|
|
||||||
{
|
|
||||||
uint32_t oldBase = EE_ActivePageBase;
|
|
||||||
uint32_t newBase = EE_GetOtherPageBase(oldBase);
|
|
||||||
uint32_t addr;
|
|
||||||
uint16_t value;
|
|
||||||
EE_Status st;
|
|
||||||
|
|
||||||
/* Erase new page */
|
|
||||||
if (EE_FlashErasePage(newBase) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Mark new page as RECEIVE */
|
|
||||||
if (EE_FlashProgramHalfWord(newBase, EE_PAGE_STATUS_RECEIVE) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Start writing records just after status */
|
|
||||||
addr = newBase + 2U;
|
|
||||||
|
|
||||||
/* For each known virtual variable */
|
|
||||||
for (uint16_t i = 0; i < EE_NUM_VIRTUAL_ADDR; i++)
|
|
||||||
{
|
|
||||||
uint16_t vaddr = EE_VirtAddrs[i];
|
|
||||||
|
|
||||||
if (vaddr == VirtAddress)
|
|
||||||
{
|
|
||||||
/* Use the new data passed into PageTransfer */
|
|
||||||
value = Data;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
/* Read latest value from old active page */
|
|
||||||
st = EE_FindInPage(oldBase, vaddr, &value);
|
|
||||||
if (st != EE_STATUS_OK)
|
|
||||||
{
|
|
||||||
/* Variable never written -> skip */
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Write record to new page */
|
|
||||||
if (EE_FlashProgramHalfWord(addr, vaddr) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
if (EE_FlashProgramHalfWord(addr + 2U, value) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
addr += sizeof(EE_Record_t);
|
|
||||||
if (addr >= (newBase + EE_PAGE_SIZE))
|
|
||||||
return EE_STATUS_NO_SPACE;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Erase old page */
|
|
||||||
if (EE_FlashErasePage(oldBase) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Mark new page as VALID */
|
|
||||||
if (EE_FlashProgramHalfWord(newBase, EE_PAGE_STATUS_VALID) != HAL_OK)
|
|
||||||
return EE_STATUS_ERROR;
|
|
||||||
|
|
||||||
/* Update active page */
|
|
||||||
EE_ActivePageBase = newBase;
|
|
||||||
|
|
||||||
return EE_STATUS_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* --- Public API ----------------------------------------------------------- */
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Initialize the EEPROM emulation.
|
|
||||||
* - Checks page statuses and chooses the active page.
|
|
||||||
* - If inconsistent or blank, formats pages.
|
|
||||||
* PUBLIC RETURN TYPE: uint16_t (EE_OK / EE_ERROR / ...)
|
|
||||||
*/
|
|
||||||
uint16_t EE_Init(void)
|
|
||||||
{
|
|
||||||
uint16_t status0 = EE_GetPageStatus(EE_PAGE0_BASE);
|
|
||||||
uint16_t status1 = EE_GetPageStatus(EE_PAGE1_BASE);
|
|
||||||
|
|
||||||
if ((status0 == EE_PAGE_STATUS_ERASED) && (status1 == EE_PAGE_STATUS_ERASED))
|
|
||||||
{
|
|
||||||
/* Fresh device -> format */
|
|
||||||
return (uint16_t)EE_Format();
|
|
||||||
}
|
|
||||||
else if ((status0 == EE_PAGE_STATUS_VALID) && (status1 == EE_PAGE_STATUS_ERASED))
|
|
||||||
{
|
|
||||||
EE_ActivePageBase = EE_PAGE0_BASE;
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
else if ((status1 == EE_PAGE_STATUS_VALID) && (status0 == EE_PAGE_STATUS_ERASED))
|
|
||||||
{
|
|
||||||
EE_ActivePageBase = EE_PAGE1_BASE;
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
/* Any weird or inconsistent state -> reformat */
|
|
||||||
return (uint16_t)EE_Format();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Read a 16-bit variable by its virtual address.
|
|
||||||
* PUBLIC RETURN: EE_OK / EE_NOT_FOUND / EE_ERROR (as uint16_t)
|
|
||||||
*/
|
|
||||||
uint16_t EE_ReadVariable(uint16_t VirtAddress, uint16_t *Data)
|
|
||||||
{
|
|
||||||
EE_Status st;
|
|
||||||
|
|
||||||
if (Data == NULL)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
st = EE_FindInPage(EE_ActivePageBase, VirtAddress, Data);
|
|
||||||
return (uint16_t)st;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Write (append) a 16-bit variable.
|
|
||||||
* - Writes a new record in the active page.
|
|
||||||
* - If the page is full, triggers a page transfer (GC).
|
|
||||||
* PUBLIC RETURN: EE_OK / EE_ERROR / EE_NO_SPACE (as uint16_t)
|
|
||||||
*/
|
|
||||||
uint16_t EE_WriteVariable(uint16_t VirtAddress, uint16_t Data)
|
|
||||||
{
|
|
||||||
uint32_t freeAddr;
|
|
||||||
EE_Status st;
|
|
||||||
|
|
||||||
/* Find free space in active page */
|
|
||||||
freeAddr = EE_FindFreeAddress(EE_ActivePageBase);
|
|
||||||
if (freeAddr != 0U)
|
|
||||||
{
|
|
||||||
/* Write new record */
|
|
||||||
if (EE_FlashProgramHalfWord(freeAddr, VirtAddress) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
if (EE_FlashProgramHalfWord(freeAddr + 2U, Data) != HAL_OK)
|
|
||||||
return EE_ERROR;
|
|
||||||
|
|
||||||
return EE_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* No space -> page transfer */
|
|
||||||
st = EE_PageTransfer(VirtAddress, Data);
|
|
||||||
return (uint16_t)st;
|
|
||||||
}
|
|
||||||
@@ -1,177 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t eeadd;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
EEW_Write(eeadd, val);
|
|
||||||
sprintf((char*)s,"\ndone");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,13 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef INC_PWM_H_
|
|
||||||
#define INC_PWM_H_
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
#endif /* INC_PWM_H_ */
|
|
||||||
@@ -1,30 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef INC_PWM_H_
|
|
||||||
#define INC_PWM_H_
|
|
||||||
#include <stdbool.h>
|
|
||||||
bool IsPwmRunning(TIM_HandleTypeDef *htim, uint32_t Channel);;
|
|
||||||
void StopMot(TIM_HandleTypeDef *htim,uint32_t Channel);
|
|
||||||
|
|
||||||
#define timMot1 &htim2
|
|
||||||
#define FWMot1 TIM_CHANNEL_1
|
|
||||||
#define BWMot1 TIM_CHANNEL_2
|
|
||||||
|
|
||||||
#define timMot2 &htim2
|
|
||||||
#define FWMot2 TIM_CHANNEL_3
|
|
||||||
#define BWMot2 TIM_CHANNEL_4
|
|
||||||
|
|
||||||
#define timMot3 &htim4
|
|
||||||
#define FWMot3 TIM_CHANNEL_1
|
|
||||||
#define BWMot3 TIM_CHANNEL_2
|
|
||||||
|
|
||||||
#define timMot4 &htim4
|
|
||||||
#define FWMot4 TIM_CHANNEL_3
|
|
||||||
#define BWMot4 TIM_CHANNEL_4
|
|
||||||
|
|
||||||
#endif /* INC_PWM_H_ */
|
|
||||||
@@ -1,644 +0,0 @@
|
|||||||
|
|
||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim1;
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim3;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_TIM3_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_TIM1_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_TIM3_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_TIM1_Init();
|
|
||||||
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_4);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_3);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_4);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_4);
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
|
|
||||||
|
|
||||||
CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
void manageCDC(void);
|
|
||||||
while (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
}
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 1;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
TIM_BreakDeadTimeConfigTypeDef sBreakDeadTimeConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 1 */
|
|
||||||
htim1.Instance = TIM1;
|
|
||||||
htim1.Init.Prescaler = 0;
|
|
||||||
htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim1.Init.Period = 17999;
|
|
||||||
htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim1.Init.RepetitionCounter = 0;
|
|
||||||
htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim1, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 2400;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCNPolarity = TIM_OCNPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
sConfigOC.OCIdleState = TIM_OCIDLESTATE_RESET;
|
|
||||||
sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 5500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sBreakDeadTimeConfig.OffStateRunMode = TIM_OSSR_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.OffStateIDLEMode = TIM_OSSI_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.LockLevel = TIM_LOCKLEVEL_OFF;
|
|
||||||
sBreakDeadTimeConfig.DeadTime = 0;
|
|
||||||
sBreakDeadTimeConfig.BreakState = TIM_BREAK_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.BreakPolarity = TIM_BREAKPOLARITY_HIGH;
|
|
||||||
sBreakDeadTimeConfig.AutomaticOutput = TIM_AUTOMATICOUTPUT_DISABLE;
|
|
||||||
if (HAL_TIMEx_ConfigBreakDeadTime(&htim1, &sBreakDeadTimeConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim1);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM3 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM3_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 1 */
|
|
||||||
htim3.Instance = TIM3;
|
|
||||||
htim3.Init.Prescaler = 0;
|
|
||||||
htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim3.Init.Period = 17999;
|
|
||||||
htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim3, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim3, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 9000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 10000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 11000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 12000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM3_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim3);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_13, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : PC13 */
|
|
||||||
GPIO_InitStruct.Pin = GPIO_PIN_13;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,13 +0,0 @@
|
|||||||
/*
|
|
||||||
* eeprom.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 7, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef SRC_EEPROM_H_
|
|
||||||
#define SRC_EEPROM_H_
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
#endif /* SRC_EEPROM_H_ */
|
|
||||||
@@ -1,650 +0,0 @@
|
|||||||
|
|
||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim1;
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim3;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_TIM3_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_TIM1_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_TIM3_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_TIM1_Init();
|
|
||||||
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_3);
|
|
||||||
// HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3);
|
|
||||||
// HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_4);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_3);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_4);
|
|
||||||
// HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_3);
|
|
||||||
// HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_4);
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 1;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
TIM_BreakDeadTimeConfigTypeDef sBreakDeadTimeConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 1 */
|
|
||||||
htim1.Instance = TIM1;
|
|
||||||
htim1.Init.Prescaler = 0;
|
|
||||||
htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim1.Init.Period = 17999;
|
|
||||||
htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim1.Init.RepetitionCounter = 0;
|
|
||||||
htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim1, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 2400;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCNPolarity = TIM_OCNPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
sConfigOC.OCIdleState = TIM_OCIDLESTATE_RESET;
|
|
||||||
sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 5500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sBreakDeadTimeConfig.OffStateRunMode = TIM_OSSR_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.OffStateIDLEMode = TIM_OSSI_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.LockLevel = TIM_LOCKLEVEL_OFF;
|
|
||||||
sBreakDeadTimeConfig.DeadTime = 0;
|
|
||||||
sBreakDeadTimeConfig.BreakState = TIM_BREAK_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.BreakPolarity = TIM_BREAKPOLARITY_HIGH;
|
|
||||||
sBreakDeadTimeConfig.AutomaticOutput = TIM_AUTOMATICOUTPUT_DISABLE;
|
|
||||||
if (HAL_TIMEx_ConfigBreakDeadTime(&htim1, &sBreakDeadTimeConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim1);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM3 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM3_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 1 */
|
|
||||||
htim3.Instance = TIM3;
|
|
||||||
htim3.Init.Prescaler = 0;
|
|
||||||
htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim3.Init.Period = 17999;
|
|
||||||
htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim3, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim3, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 9000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 10000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 11000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 12000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM3_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim3);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_13, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : PC13 */
|
|
||||||
GPIO_InitStruct.Pin = GPIO_PIN_13;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,94 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,553 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
UART_HandleTypeDef huart1;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
TIM_HandleTypeDef htim1;
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim3;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_USART1_UART_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_USART1_UART_Init();
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
//CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
while (CDC_Transmit_FS((uint8_t*)"Start\r\n", 7) == USBD_BUSY);
|
|
||||||
if (EE_Init() != EE_OK){
|
|
||||||
// handle error (optional)
|
|
||||||
}
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 1;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief USART1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_USART1_UART_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 1 */
|
|
||||||
huart1.Instance = USART1;
|
|
||||||
huart1.Init.BaudRate = 115200;
|
|
||||||
huart1.Init.WordLength = UART_WORDLENGTH_8B;
|
|
||||||
huart1.Init.StopBits = UART_STOPBITS_1;
|
|
||||||
huart1.Init.Parity = UART_PARITY_NONE;
|
|
||||||
huart1.Init.Mode = UART_MODE_TX_RX;
|
|
||||||
huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
||||||
huart1.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
||||||
if (HAL_UART_Init(&huart1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN USART1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOB, INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOA, BUZ_Pin|LED1_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : LED2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = LED2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(LED2_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : P1_Pin P2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = P1_Pin|P2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : AIN1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = AIN1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
||||||
HAL_GPIO_Init(AIN1_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : INH1_Pin INH2_Pin INH3_Pin INH4_Pin
|
|
||||||
EXP1_Pin EXP2_Pin EXP3_Pin */
|
|
||||||
GPIO_InitStruct.Pin = INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : CH1_Pin CH2_Pin CH3_Pin CH4_Pin */
|
|
||||||
GPIO_InitStruct.Pin = CH1_Pin|CH2_Pin|CH3_Pin|CH4_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : BUZ_Pin LED1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = BUZ_Pin|LED1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,180 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t eeadd;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]>='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%c%c=%04x",val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]>='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
EEW_Write(eeadd, val);
|
|
||||||
sprintf((char*)s,"\ndone");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%c%c=%04x",val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,45 +0,0 @@
|
|||||||
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen(s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,563 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
UART_HandleTypeDef huart1;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
TIM_HandleTypeDef htim1;
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim3;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
uint8_t pulsanti=0;
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_USART1_UART_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
static uint8_t inidx=0;
|
|
||||||
static uint8_t inbuf[4];
|
|
||||||
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
inidx++;
|
|
||||||
inidx&=0x03;
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
if(HAL_GPIO_ReadPin(P1_GPIO_Port, P1_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP1;else inbuf[inidx]&=(~INP1);
|
|
||||||
if(HAL_GPIO_ReadPin(P2_GPIO_Port, P2_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP2;else inbuf[inidx]&=(~INP2);
|
|
||||||
pulsanti|=(inbuf[0]&inbuf[1]&inbuf[2]&inbuf[3]);
|
|
||||||
pulsanti&=(inbuf[0]|inbuf[1]|inbuf[2]|inbuf[3]);
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_USART1_UART_Init();
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
//CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
while (CDC_Transmit_FS((uint8_t*)"Start\r\n", 7) == USBD_BUSY);
|
|
||||||
if (EE_Init() != EE_OK){
|
|
||||||
for(;;);//errore eeprom
|
|
||||||
}
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 1;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief USART1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_USART1_UART_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 1 */
|
|
||||||
huart1.Instance = USART1;
|
|
||||||
huart1.Init.BaudRate = 115200;
|
|
||||||
huart1.Init.WordLength = UART_WORDLENGTH_8B;
|
|
||||||
huart1.Init.StopBits = UART_STOPBITS_1;
|
|
||||||
huart1.Init.Parity = UART_PARITY_NONE;
|
|
||||||
huart1.Init.Mode = UART_MODE_TX_RX;
|
|
||||||
huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
||||||
huart1.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
||||||
if (HAL_UART_Init(&huart1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN USART1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOB, INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOA, BUZ_Pin|LED1_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : LED2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = LED2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(LED2_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : P1_Pin P2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = P1_Pin|P2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : AIN1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = AIN1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
||||||
HAL_GPIO_Init(AIN1_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : INH1_Pin INH2_Pin INH3_Pin INH4_Pin
|
|
||||||
EXP1_Pin EXP2_Pin EXP3_Pin */
|
|
||||||
GPIO_InitStruct.Pin = INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : CH1_Pin CH2_Pin CH3_Pin CH4_Pin */
|
|
||||||
GPIO_InitStruct.Pin = CH1_Pin|CH2_Pin|CH3_Pin|CH4_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : BUZ_Pin LED1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = BUZ_Pin|LED1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,133 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.h
|
|
||||||
* @brief : Header for main.c file.
|
|
||||||
* This file contains the common defines of the application.
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
|
|
||||||
/* Define to prevent recursive inclusion -------------------------------------*/
|
|
||||||
#ifndef __MAIN_H
|
|
||||||
#define __MAIN_H
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
extern "C" {
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Exported types ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN ET */
|
|
||||||
|
|
||||||
/* USER CODE END ET */
|
|
||||||
|
|
||||||
/* Exported constants --------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN EC */
|
|
||||||
|
|
||||||
/* USER CODE END EC */
|
|
||||||
|
|
||||||
/* Exported macro ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN EM */
|
|
||||||
|
|
||||||
/* USER CODE END EM */
|
|
||||||
|
|
||||||
void HAL_TIM_MspPostInit(TIM_HandleTypeDef *htim);
|
|
||||||
|
|
||||||
/* Exported functions prototypes ---------------------------------------------*/
|
|
||||||
void Error_Handler(void);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN EFP */
|
|
||||||
|
|
||||||
/* USER CODE END EFP */
|
|
||||||
|
|
||||||
/* Private defines -----------------------------------------------------------*/
|
|
||||||
#define LED2_Pin GPIO_PIN_13
|
|
||||||
#define LED2_GPIO_Port GPIOC
|
|
||||||
#define P1_Pin GPIO_PIN_14
|
|
||||||
#define P1_GPIO_Port GPIOC
|
|
||||||
#define P2_Pin GPIO_PIN_15
|
|
||||||
#define P2_GPIO_Port GPIOC
|
|
||||||
#define IN1_Pin GPIO_PIN_0
|
|
||||||
#define IN1_GPIO_Port GPIOA
|
|
||||||
#define IN2_Pin GPIO_PIN_1
|
|
||||||
#define IN2_GPIO_Port GPIOA
|
|
||||||
#define IN3_Pin GPIO_PIN_2
|
|
||||||
#define IN3_GPIO_Port GPIOA
|
|
||||||
#define IN4_Pin GPIO_PIN_3
|
|
||||||
#define IN4_GPIO_Port GPIOA
|
|
||||||
#define AIN1_Pin GPIO_PIN_4
|
|
||||||
#define AIN1_GPIO_Port GPIOA
|
|
||||||
#define AIN2_Pin GPIO_PIN_5
|
|
||||||
#define AIN2_GPIO_Port GPIOA
|
|
||||||
#define AIN3_Pin GPIO_PIN_6
|
|
||||||
#define AIN3_GPIO_Port GPIOA
|
|
||||||
#define AIN4_Pin GPIO_PIN_7
|
|
||||||
#define AIN4_GPIO_Port GPIOA
|
|
||||||
#define ANEM_Pin GPIO_PIN_0
|
|
||||||
#define ANEM_GPIO_Port GPIOB
|
|
||||||
#define INH1_Pin GPIO_PIN_1
|
|
||||||
#define INH1_GPIO_Port GPIOB
|
|
||||||
#define INH2_Pin GPIO_PIN_2
|
|
||||||
#define INH2_GPIO_Port GPIOB
|
|
||||||
#define INH3_Pin GPIO_PIN_10
|
|
||||||
#define INH3_GPIO_Port GPIOB
|
|
||||||
#define INH4_Pin GPIO_PIN_11
|
|
||||||
#define INH4_GPIO_Port GPIOB
|
|
||||||
#define CH1_Pin GPIO_PIN_12
|
|
||||||
#define CH1_GPIO_Port GPIOB
|
|
||||||
#define CH2_Pin GPIO_PIN_13
|
|
||||||
#define CH2_GPIO_Port GPIOB
|
|
||||||
#define CH3_Pin GPIO_PIN_14
|
|
||||||
#define CH3_GPIO_Port GPIOB
|
|
||||||
#define CH4_Pin GPIO_PIN_15
|
|
||||||
#define CH4_GPIO_Port GPIOB
|
|
||||||
#define BUZ_Pin GPIO_PIN_8
|
|
||||||
#define BUZ_GPIO_Port GPIOA
|
|
||||||
#define SWIO_Pin GPIO_PIN_13
|
|
||||||
#define SWIO_GPIO_Port GPIOA
|
|
||||||
#define SWCLK_Pin GPIO_PIN_14
|
|
||||||
#define SWCLK_GPIO_Port GPIOA
|
|
||||||
#define LED1_Pin GPIO_PIN_15
|
|
||||||
#define LED1_GPIO_Port GPIOA
|
|
||||||
#define EXP1_Pin GPIO_PIN_3
|
|
||||||
#define EXP1_GPIO_Port GPIOB
|
|
||||||
#define EXP2_Pin GPIO_PIN_4
|
|
||||||
#define EXP2_GPIO_Port GPIOB
|
|
||||||
#define EXP3_Pin GPIO_PIN_5
|
|
||||||
#define EXP3_GPIO_Port GPIOB
|
|
||||||
#define IN5_Pin GPIO_PIN_6
|
|
||||||
#define IN5_GPIO_Port GPIOB
|
|
||||||
#define IN6_Pin GPIO_PIN_7
|
|
||||||
#define IN6_GPIO_Port GPIOB
|
|
||||||
#define IN7_Pin GPIO_PIN_8
|
|
||||||
#define IN7_GPIO_Port GPIOB
|
|
||||||
#define IN8_Pin GPIO_PIN_9
|
|
||||||
#define IN8_GPIO_Port GPIOB
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Private defines */
|
|
||||||
|
|
||||||
/* USER CODE END Private defines */
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#endif /* __MAIN_H */
|
|
||||||
@@ -1,623 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
#include "adc.h"
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
DMA_HandleTypeDef hdma_adc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
UART_HandleTypeDef huart1;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
extern volatile uint16_t adc_dma_buf[];
|
|
||||||
|
|
||||||
uint8_t pulsanti=0;
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_DMA_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_USART1_UART_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
static uint8_t inidx=0;
|
|
||||||
static uint8_t inbuf[4];
|
|
||||||
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
//**** legge i tasti********************************************************************************
|
|
||||||
inidx++;
|
|
||||||
inidx&=0x03;
|
|
||||||
if(HAL_GPIO_ReadPin(P1_GPIO_Port, P1_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP1;else inbuf[inidx]&=(~INP1);
|
|
||||||
if(HAL_GPIO_ReadPin(P2_GPIO_Port, P2_Pin)==GPIO_PIN_SET)inbuf[inidx]|=INP2;else inbuf[inidx]&=(~INP2);
|
|
||||||
pulsanti|=(inbuf[0]&inbuf[1]&inbuf[2]&inbuf[3]);
|
|
||||||
pulsanti&=(inbuf[0]|inbuf[1]|inbuf[2]|inbuf[3]);
|
|
||||||
//**** legge adc ***********************************************************************************
|
|
||||||
readAdc();
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_DMA_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_USART1_UART_Init();
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
HAL_ADC_Start_DMA(&hadc1, (uint32_t *)adc_dma_buf, ADC_NUM_CHANNELS);
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
//CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
while (CDC_Transmit_FS((uint8_t*)"Start\r\n", 7) == USBD_BUSY);
|
|
||||||
if (EE_Init() != EE_OK){
|
|
||||||
for(;;);//errore eeprom
|
|
||||||
}
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
manageAdc();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_ENABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = ENABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 5;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_28CYCLES_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_5;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_2;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_6;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_3;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_7;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_4;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_8;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief USART1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_USART1_UART_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 1 */
|
|
||||||
huart1.Instance = USART1;
|
|
||||||
huart1.Init.BaudRate = 115200;
|
|
||||||
huart1.Init.WordLength = UART_WORDLENGTH_8B;
|
|
||||||
huart1.Init.StopBits = UART_STOPBITS_1;
|
|
||||||
huart1.Init.Parity = UART_PARITY_NONE;
|
|
||||||
huart1.Init.Mode = UART_MODE_TX_RX;
|
|
||||||
huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
||||||
huart1.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
||||||
if (HAL_UART_Init(&huart1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN USART1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Enable DMA controller clock
|
|
||||||
*/
|
|
||||||
static void MX_DMA_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* DMA controller clock enable */
|
|
||||||
__HAL_RCC_DMA1_CLK_ENABLE();
|
|
||||||
|
|
||||||
/* DMA interrupt init */
|
|
||||||
/* DMA1_Channel1_IRQn interrupt configuration */
|
|
||||||
HAL_NVIC_SetPriority(DMA1_Channel1_IRQn, 0, 0);
|
|
||||||
HAL_NVIC_EnableIRQ(DMA1_Channel1_IRQn);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOB, INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOA, BUZ_Pin|LED1_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : LED2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = LED2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(LED2_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : P1_Pin P2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = P1_Pin|P2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : AIN1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = AIN1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
||||||
HAL_GPIO_Init(AIN1_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : INH1_Pin INH2_Pin INH3_Pin INH4_Pin
|
|
||||||
EXP1_Pin EXP2_Pin EXP3_Pin */
|
|
||||||
GPIO_InitStruct.Pin = INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : CH1_Pin CH2_Pin CH3_Pin CH4_Pin */
|
|
||||||
GPIO_InitStruct.Pin = CH1_Pin|CH2_Pin|CH3_Pin|CH4_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : BUZ_Pin LED1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = BUZ_Pin|LED1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,16 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.c
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
|
|
||||||
bool IsPwmRunning(TIM_HandleTypeDef *htim, uint32_t Channel)
|
|
||||||
{
|
|
||||||
HAL_TIM_ChannelStateTypeDef chState = HAL_TIM_GetChannelState(htim, Channel);
|
|
||||||
|
|
||||||
return (chState == HAL_TIM_CHANNEL_STATE_BUSY);
|
|
||||||
}
|
|
||||||
@@ -1,13 +0,0 @@
|
|||||||
/*
|
|
||||||
* adc.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 8, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef INC_ADC_H_
|
|
||||||
#define INC_ADC_H_
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
#endif /* INC_ADC_H_ */
|
|
||||||
@@ -1,179 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t eeadd;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]>='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%c%c=%04x",val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]>='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
EEW_Write(eeadd, val);
|
|
||||||
sprintf((char*)s,"\ndone");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%c%c=%04x",val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,180 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=10;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t eeadd;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]>='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%c%c=%04x",rxbuf[2],rxbuf[3],val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]>='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
EEW_Write(eeadd, val);
|
|
||||||
sprintf((char*)s,"\ndone");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
EEW_Read(eeadd, &val);
|
|
||||||
sprintf((char*)s,"\nee 0x%c%c=%04x",val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,8 +0,0 @@
|
|||||||
/*
|
|
||||||
* adc.c
|
|
||||||
*
|
|
||||||
* Created on: Dec 8, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
@@ -1,644 +0,0 @@
|
|||||||
|
|
||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim1;
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim3;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_TIM3_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_TIM1_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_TIM3_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_TIM1_Init();
|
|
||||||
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_4);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_3);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_4);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_4);
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
|
|
||||||
|
|
||||||
CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
void manageCDC(void);
|
|
||||||
while (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
unsigned char s[100];
|
|
||||||
sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 1;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
TIM_BreakDeadTimeConfigTypeDef sBreakDeadTimeConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 1 */
|
|
||||||
htim1.Instance = TIM1;
|
|
||||||
htim1.Init.Prescaler = 0;
|
|
||||||
htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim1.Init.Period = 17999;
|
|
||||||
htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim1.Init.RepetitionCounter = 0;
|
|
||||||
htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim1, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 2400;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCNPolarity = TIM_OCNPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
sConfigOC.OCIdleState = TIM_OCIDLESTATE_RESET;
|
|
||||||
sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 5500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sBreakDeadTimeConfig.OffStateRunMode = TIM_OSSR_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.OffStateIDLEMode = TIM_OSSI_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.LockLevel = TIM_LOCKLEVEL_OFF;
|
|
||||||
sBreakDeadTimeConfig.DeadTime = 0;
|
|
||||||
sBreakDeadTimeConfig.BreakState = TIM_BREAK_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.BreakPolarity = TIM_BREAKPOLARITY_HIGH;
|
|
||||||
sBreakDeadTimeConfig.AutomaticOutput = TIM_AUTOMATICOUTPUT_DISABLE;
|
|
||||||
if (HAL_TIMEx_ConfigBreakDeadTime(&htim1, &sBreakDeadTimeConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim1);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM3 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM3_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 1 */
|
|
||||||
htim3.Instance = TIM3;
|
|
||||||
htim3.Init.Prescaler = 0;
|
|
||||||
htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim3.Init.Period = 17999;
|
|
||||||
htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim3, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim3, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 9000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 10000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 11000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 12000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM3_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim3);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_13, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : PC13 */
|
|
||||||
GPIO_InitStruct.Pin = GPIO_PIN_13;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,553 +0,0 @@
|
|||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
UART_HandleTypeDef huart1;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
TIM_HandleTypeDef htim1;
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim3;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_USART1_UART_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_USART1_UART_Init();
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
StopMot(timMot1,FWMot1);
|
|
||||||
StopMot(timMot1,BWMot1);
|
|
||||||
StopMot(timMot2,FWMot2);
|
|
||||||
StopMot(timMot2,BWMot2);
|
|
||||||
StopMot(timMot3,FWMot3);
|
|
||||||
StopMot(timMot3,BWMot3);
|
|
||||||
StopMot(timMot4,FWMot4);
|
|
||||||
StopMot(timMot4,BWMot4);
|
|
||||||
//CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
while (CDC_Transmit_FS((uint8_t*)"Start\r\n", 7) == USBD_BUSY);
|
|
||||||
if (EE_Init() != EE_OK){
|
|
||||||
for(;;);//errore eeprom
|
|
||||||
}
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
manageCDC();
|
|
||||||
// while (CDC_Available()) {
|
|
||||||
// int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
// unsigned char s[100];
|
|
||||||
// sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 1;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief USART1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_USART1_UART_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN USART1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 1 */
|
|
||||||
huart1.Instance = USART1;
|
|
||||||
huart1.Init.BaudRate = 115200;
|
|
||||||
huart1.Init.WordLength = UART_WORDLENGTH_8B;
|
|
||||||
huart1.Init.StopBits = UART_STOPBITS_1;
|
|
||||||
huart1.Init.Parity = UART_PARITY_NONE;
|
|
||||||
huart1.Init.Mode = UART_MODE_TX_RX;
|
|
||||||
huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
||||||
huart1.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
||||||
if (HAL_UART_Init(&huart1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN USART1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END USART1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOB, INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOA, BUZ_Pin|LED1_Pin, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : LED2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = LED2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(LED2_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : P1_Pin P2_Pin */
|
|
||||||
GPIO_InitStruct.Pin = P1_Pin|P2_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : AIN1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = AIN1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
||||||
HAL_GPIO_Init(AIN1_GPIO_Port, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : INH1_Pin INH2_Pin INH3_Pin INH4_Pin
|
|
||||||
EXP1_Pin EXP2_Pin EXP3_Pin */
|
|
||||||
GPIO_InitStruct.Pin = INH1_Pin|INH2_Pin|INH3_Pin|INH4_Pin
|
|
||||||
|EXP1_Pin|EXP2_Pin|EXP3_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : CH1_Pin CH2_Pin CH3_Pin CH4_Pin */
|
|
||||||
GPIO_InitStruct.Pin = CH1_Pin|CH2_Pin|CH3_Pin|CH4_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/*Configure GPIO pins : BUZ_Pin LED1_Pin */
|
|
||||||
GPIO_InitStruct.Pin = BUZ_Pin|LED1_Pin;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,644 +0,0 @@
|
|||||||
|
|
||||||
/* USER CODE BEGIN Header */
|
|
||||||
/**
|
|
||||||
******************************************************************************
|
|
||||||
* @file : main.c
|
|
||||||
* @brief : Main program body
|
|
||||||
******************************************************************************
|
|
||||||
* @attention
|
|
||||||
*
|
|
||||||
* Copyright (c) 2025 STMicroelectronics.
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* This software is licensed under terms that can be found in the LICENSE file
|
|
||||||
* in the root directory of this software component.
|
|
||||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
||||||
*
|
|
||||||
******************************************************************************
|
|
||||||
*/
|
|
||||||
/* USER CODE END Header */
|
|
||||||
/* Includes ------------------------------------------------------------------*/
|
|
||||||
#include "main.h"
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
/* Private includes ----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN Includes */
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
|
|
||||||
/* USER CODE END Includes */
|
|
||||||
|
|
||||||
/* Private typedef -----------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PTD */
|
|
||||||
|
|
||||||
/* USER CODE END PTD */
|
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PD */
|
|
||||||
|
|
||||||
/* USER CODE END PD */
|
|
||||||
|
|
||||||
/* Private macro -------------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN PM */
|
|
||||||
|
|
||||||
/* USER CODE END PM */
|
|
||||||
|
|
||||||
/* Private variables ---------------------------------------------------------*/
|
|
||||||
ADC_HandleTypeDef hadc1;
|
|
||||||
|
|
||||||
TIM_HandleTypeDef htim1;
|
|
||||||
TIM_HandleTypeDef htim2;
|
|
||||||
TIM_HandleTypeDef htim3;
|
|
||||||
TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
/* USER CODE BEGIN PV */
|
|
||||||
|
|
||||||
/* USER CODE END PV */
|
|
||||||
|
|
||||||
/* Private function prototypes -----------------------------------------------*/
|
|
||||||
void SystemClock_Config(void);
|
|
||||||
static void MX_GPIO_Init(void);
|
|
||||||
static void MX_TIM2_Init(void);
|
|
||||||
static void MX_TIM4_Init(void);
|
|
||||||
static void MX_TIM3_Init(void);
|
|
||||||
static void MX_ADC1_Init(void);
|
|
||||||
static void MX_TIM1_Init(void);
|
|
||||||
/* USER CODE BEGIN PFP */
|
|
||||||
|
|
||||||
/* USER CODE END PFP */
|
|
||||||
|
|
||||||
/* Private user code ---------------------------------------------------------*/
|
|
||||||
/* USER CODE BEGIN 0 */
|
|
||||||
void HAL_SYSTICK_Callback(void){
|
|
||||||
static unsigned char c10ms = 0;
|
|
||||||
|
|
||||||
static uint8_t c100ms = 0;
|
|
||||||
static uint8_t c1s = 0;
|
|
||||||
if (++c10ms >= 10) { // 10 ms
|
|
||||||
c10ms = 0;
|
|
||||||
if (++c100ms >= 10) { // 10 ms
|
|
||||||
c100ms = 0; //flag_10ms = 1; // set a flag; do real work in main loop
|
|
||||||
if (++c1s >= 10) { // 10 ms
|
|
||||||
c1s = 0;
|
|
||||||
HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief The application entry point.
|
|
||||||
* @retval int
|
|
||||||
*/
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
|
||||||
|
|
||||||
/* MCU Configuration--------------------------------------------------------*/
|
|
||||||
|
|
||||||
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
||||||
HAL_Init();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN Init */
|
|
||||||
|
|
||||||
/* USER CODE END Init */
|
|
||||||
|
|
||||||
/* Configure the system clock */
|
|
||||||
SystemClock_Config();
|
|
||||||
|
|
||||||
/* USER CODE BEGIN SysInit */
|
|
||||||
|
|
||||||
/* USER CODE END SysInit */
|
|
||||||
|
|
||||||
/* Initialize all configured peripherals */
|
|
||||||
MX_GPIO_Init();
|
|
||||||
MX_USB_DEVICE_Init();
|
|
||||||
MX_TIM2_Init();
|
|
||||||
MX_TIM4_Init();
|
|
||||||
MX_TIM3_Init();
|
|
||||||
MX_ADC1_Init();
|
|
||||||
MX_TIM1_Init();
|
|
||||||
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_4);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_3);
|
|
||||||
// HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_4);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_1);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_2);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_3);
|
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_4);
|
|
||||||
/* USER CODE BEGIN 2 */
|
|
||||||
|
|
||||||
|
|
||||||
CDC_Transmit_FS((uint8_t*)"Start\r\n", 7);
|
|
||||||
/* USER CODE END 2 */
|
|
||||||
|
|
||||||
/* Infinite loop */
|
|
||||||
/* USER CODE BEGIN WHILE */
|
|
||||||
while (1){
|
|
||||||
void manageCDC(void);
|
|
||||||
while (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
//if (c < 0) break;
|
|
||||||
|
|
||||||
// uint8_t out = (uint8_t)c;
|
|
||||||
// if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
|
|
||||||
unsigned char s[100];
|
|
||||||
sprintf((char*)s,"\nc=%03d",c);
|
|
||||||
// while (CDC_Transmit_FS(s, 6) == USBD_BUSY) {
|
|
||||||
// // tiny spin or yield
|
|
||||||
// }
|
|
||||||
}
|
|
||||||
|
|
||||||
//HAL_Delay(1000);
|
|
||||||
// CDC_Transmit_FS((uint8_t*)"Ping\r\n", 6);
|
|
||||||
/* USER CODE END WHILE */
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 3 */
|
|
||||||
}
|
|
||||||
/* USER CODE END 3 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief System Clock Configuration
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void SystemClock_Config(void)
|
|
||||||
{
|
|
||||||
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
||||||
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
||||||
RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
|
|
||||||
|
|
||||||
/** Initializes the RCC Oscillators according to the specified parameters
|
|
||||||
* in the RCC_OscInitTypeDef structure.
|
|
||||||
*/
|
|
||||||
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
||||||
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
||||||
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
|
|
||||||
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
||||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
||||||
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
|
|
||||||
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Initializes the CPU, AHB and APB buses clocks
|
|
||||||
*/
|
|
||||||
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
||||||
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
||||||
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
||||||
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
||||||
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
|
|
||||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
||||||
|
|
||||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC|RCC_PERIPHCLK_USB;
|
|
||||||
PeriphClkInit.AdcClockSelection = RCC_ADCPCLK2_DIV6;
|
|
||||||
PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL_DIV1_5;
|
|
||||||
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ADC1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_ADC1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
|
||||||
|
|
||||||
/** Common config
|
|
||||||
*/
|
|
||||||
hadc1.Instance = ADC1;
|
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
|
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
|
||||||
hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
|
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
|
||||||
hadc1.Init.NbrOfConversion = 1;
|
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** Configure Regular Channel
|
|
||||||
*/
|
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;
|
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM1 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM1_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
TIM_BreakDeadTimeConfigTypeDef sBreakDeadTimeConfig = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM1_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 1 */
|
|
||||||
htim1.Instance = TIM1;
|
|
||||||
htim1.Init.Prescaler = 0;
|
|
||||||
htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim1.Init.Period = 17999;
|
|
||||||
htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim1.Init.RepetitionCounter = 0;
|
|
||||||
htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim1, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 2400;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCNPolarity = TIM_OCNPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
sConfigOC.OCIdleState = TIM_OCIDLESTATE_RESET;
|
|
||||||
sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 5500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6500;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sBreakDeadTimeConfig.OffStateRunMode = TIM_OSSR_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.OffStateIDLEMode = TIM_OSSI_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.LockLevel = TIM_LOCKLEVEL_OFF;
|
|
||||||
sBreakDeadTimeConfig.DeadTime = 0;
|
|
||||||
sBreakDeadTimeConfig.BreakState = TIM_BREAK_DISABLE;
|
|
||||||
sBreakDeadTimeConfig.BreakPolarity = TIM_BREAKPOLARITY_HIGH;
|
|
||||||
sBreakDeadTimeConfig.AutomaticOutput = TIM_AUTOMATICOUTPUT_DISABLE;
|
|
||||||
if (HAL_TIMEx_ConfigBreakDeadTime(&htim1, &sBreakDeadTimeConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM1_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM1_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim1);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM2 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM2_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM2_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 1 */
|
|
||||||
htim2.Instance = TIM2;
|
|
||||||
htim2.Init.Prescaler = 0;
|
|
||||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim2.Init.Period = 17999;
|
|
||||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 1000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 2000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 3000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 4000;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM2_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM2_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim2);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM3 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM3_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM3_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 1 */
|
|
||||||
htim3.Instance = TIM3;
|
|
||||||
htim3.Init.Prescaler = 0;
|
|
||||||
htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim3.Init.Period = 17999;
|
|
||||||
htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim3, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim3, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 9000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 10000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 11000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 12000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM3_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM3_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim3);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief TIM4 Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_TIM4_Init(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 0 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 0 */
|
|
||||||
|
|
||||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
||||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
||||||
TIM_OC_InitTypeDef sConfigOC = {0};
|
|
||||||
|
|
||||||
/* USER CODE BEGIN TIM4_Init 1 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 1 */
|
|
||||||
htim4.Instance = TIM4;
|
|
||||||
htim4.Init.Prescaler = 0;
|
|
||||||
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
||||||
htim4.Init.Period = 17999;
|
|
||||||
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
||||||
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
||||||
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
||||||
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
||||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
||||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
||||||
sConfigOC.Pulse = 5000;
|
|
||||||
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
||||||
sConfigOC.OCFastMode = TIM_OCFAST_ENABLE;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 6000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_2) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 7000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_3) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
sConfigOC.Pulse = 8000;
|
|
||||||
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
|
|
||||||
{
|
|
||||||
Error_Handler();
|
|
||||||
}
|
|
||||||
/* USER CODE BEGIN TIM4_Init 2 */
|
|
||||||
|
|
||||||
/* USER CODE END TIM4_Init 2 */
|
|
||||||
HAL_TIM_MspPostInit(&htim4);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief GPIO Initialization Function
|
|
||||||
* @param None
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
static void MX_GPIO_Init(void)
|
|
||||||
{
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_1 */
|
|
||||||
|
|
||||||
/* GPIO Ports Clock Enable */
|
|
||||||
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
||||||
|
|
||||||
/*Configure GPIO pin Output Level */
|
|
||||||
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_13, GPIO_PIN_RESET);
|
|
||||||
|
|
||||||
/*Configure GPIO pin : PC13 */
|
|
||||||
GPIO_InitStruct.Pin = GPIO_PIN_13;
|
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
||||||
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
||||||
|
|
||||||
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
||||||
|
|
||||||
/* USER CODE END MX_GPIO_Init_2 */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* USER CODE BEGIN 4 */
|
|
||||||
|
|
||||||
/* USER CODE END 4 */
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief This function is executed in case of error occurrence.
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void Error_Handler(void)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN Error_Handler_Debug */
|
|
||||||
/* User can add his own implementation to report the HAL error return state */
|
|
||||||
__disable_irq();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/* USER CODE END Error_Handler_Debug */
|
|
||||||
}
|
|
||||||
#ifdef USE_FULL_ASSERT
|
|
||||||
/**
|
|
||||||
* @brief Reports the name of the source file and the source line number
|
|
||||||
* where the assert_param error has occurred.
|
|
||||||
* @param file: pointer to the source file name
|
|
||||||
* @param line: assert_param error line source number
|
|
||||||
* @retval None
|
|
||||||
*/
|
|
||||||
void assert_failed(uint8_t *file, uint32_t line)
|
|
||||||
{
|
|
||||||
/* USER CODE BEGIN 6 */
|
|
||||||
/* User can add his own implementation to report the file name and line number,
|
|
||||||
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
||||||
/* USER CODE END 6 */
|
|
||||||
}
|
|
||||||
#endif /* USE_FULL_ASSERT */
|
|
||||||
@@ -1,201 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t eeadd;
|
|
||||||
uint8_t i;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if (EEW_Read(eeadd, &val) == EE_OK){
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\nee read error");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
EEW_Write(eeadd, val);
|
|
||||||
sprintf((char*)s,"\ndone 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='d'){
|
|
||||||
if(rxidx==2){
|
|
||||||
for(i=0;i<32;i++){
|
|
||||||
if((i%4)==0){
|
|
||||||
sprintf((char*)s,"\n");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
if (EEW_Read(i, &val) == EE_OK){
|
|
||||||
sprintf((char*)s,"0x%02x=0x%04x ",i,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"rderr ");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ed");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w|d");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,196 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t st;
|
|
||||||
uint16_t eeadd;
|
|
||||||
uint8_t i;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
st=EEW_Read(EE_VirtAddrse[eadd], &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\nee read error %d",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
st=EEW_Write(EE_VirtAddrse[eadd], val);
|
|
||||||
if (st == EE_OK)sprintf((char*)s,"\ndone 0x%02x=0x%04x",eeadd,val);
|
|
||||||
else sprintf((char*)s,"\nee write error %d", st);
|
|
||||||
}else sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
}else sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
}else sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else if(rxbuf[1]=='d'){
|
|
||||||
if(rxidx==2){
|
|
||||||
for(i=0;i<32;i++){
|
|
||||||
if((i%4)==0){
|
|
||||||
sprintf((char*)s,"\n");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
st=EEW_Read(EE_VirtAddrse[i], &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"0x%02x=0x%04x ",i,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"rderr %d ",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ed");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w|d");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,48 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,198 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "eeprom.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
extern const uint16_t EE_VirtAddrs[];
|
|
||||||
extern uint8_t pulsanti;
|
|
||||||
|
|
||||||
bool toHex(char c1,char c2,char c3,char c4,uint16_t* retval){
|
|
||||||
if((c1>='0')&&(c1<='9')){
|
|
||||||
c1-='0';
|
|
||||||
}else if((c1>='a')&&(c1<='f')){
|
|
||||||
c1=(c1-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c2>='0')&&(c2<='9')){
|
|
||||||
c2-='0';
|
|
||||||
}else if((c2>='a')&&(c2<='f')){
|
|
||||||
c2=(c2-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c3>='0')&&(c3<='9')){
|
|
||||||
c3-='0';
|
|
||||||
}else if((c3>='a')&&(c3<='f')){
|
|
||||||
c3=(c3-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
if((c4>='0')&&(c4<='9')){
|
|
||||||
c4-='0';
|
|
||||||
}else if((c4>='a')&&(c4<='f')){
|
|
||||||
c4=(c4-'a')+10;
|
|
||||||
}else return false;
|
|
||||||
|
|
||||||
*retval=c1;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c2;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c3;
|
|
||||||
*retval*=16;
|
|
||||||
*retval+=c4;
|
|
||||||
return true;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
uint16_t st;
|
|
||||||
uint16_t eeadd;
|
|
||||||
uint8_t i;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int rx = CDC_ReadByte();
|
|
||||||
if (rx < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=rx;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((rx==0x0d)||(rx==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 'e':
|
|
||||||
if(rxidx>1){
|
|
||||||
if(rxbuf[1]=='r'){
|
|
||||||
if(rxidx==4){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
st=EEW_Read(eeadd, &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"\nee 0x%02x=0x%04x",eeadd,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\nee read error %d",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa hex values");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else if(rxbuf[1]=='w'){
|
|
||||||
if(rxidx==8){
|
|
||||||
if(toHex('0','0',rxbuf[2],rxbuf[3],&eeadd)){
|
|
||||||
if(toHex(rxbuf[4],rxbuf[5],rxbuf[6],rxbuf[7],&val)){
|
|
||||||
st=EEW_Write(eeadd, val);
|
|
||||||
if (st == EE_OK)sprintf((char*)s,"\ndone 0x%02x=0x%04x",eeadd,val);
|
|
||||||
else sprintf((char*)s,"\nee write error %d", st);
|
|
||||||
}else sprintf((char*)s,"\n?ewaavvvv hex values");
|
|
||||||
}else sprintf((char*)s,"\n?ewaa hex values");
|
|
||||||
}else sprintf((char*)s,"\n?ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else if(rxbuf[1]=='d'){
|
|
||||||
if(rxidx==2){
|
|
||||||
for(i=0;i<32;i++){
|
|
||||||
if((i%4)==0){
|
|
||||||
sprintf((char*)s,"\n");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
st=EEW_Read(i, &val);
|
|
||||||
if (st == EE_OK){
|
|
||||||
sprintf((char*)s,"0x%02x=0x%04x ",i,val);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"rderr %d ",st);
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?ed");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?er|w|d");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?eraa | ewaavvvv");
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,44 +0,0 @@
|
|||||||
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,73 +0,0 @@
|
|||||||
/*
|
|
||||||
* eeprom.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 7, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef __EEPROM_H
|
|
||||||
#define __EEPROM_H
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
extern "C" {
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Simple EEPROM emulation for STM32F103C8T6 (medium density).
|
|
||||||
* - Uses 2 Flash pages (1 kB each) at the end of Flash.
|
|
||||||
* - Stores variables as 16-bit values identified by 16-bit "virtual addresses".
|
|
||||||
*
|
|
||||||
* You must define the list of virtual addresses in eeprom.c: EE_VirtAddrs[].
|
|
||||||
*/
|
|
||||||
|
|
||||||
typedef enum
|
|
||||||
{
|
|
||||||
EE_OK = 0,
|
|
||||||
EE_ERROR,
|
|
||||||
EE_NOT_FOUND,
|
|
||||||
EE_NO_SPACE
|
|
||||||
} EE_Status;
|
|
||||||
|
|
||||||
/* Flash parameters for STM32F103C8T6 */
|
|
||||||
#define EE_FLASH_BASE_ADDR 0x08000000U
|
|
||||||
#define EE_PAGE_SIZE 0x400U /* 1 kB pages */
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Here we assume a 64 kB Flash device (STM32F103C8T6):
|
|
||||||
* Flash range: 0x0800 0000 - 0x0800 FFFF
|
|
||||||
* Pages: 0..63 (64 pages)
|
|
||||||
* We use the last 2 pages for EEPROM:
|
|
||||||
* - Page 62: 0x0800 F800
|
|
||||||
* - Page 63: 0x0800 FC00
|
|
||||||
*/
|
|
||||||
#define EE_PAGE0_BASE (EE_FLASH_BASE_ADDR + (62U * EE_PAGE_SIZE))
|
|
||||||
#define EE_PAGE1_BASE (EE_FLASH_BASE_ADDR + (63U * EE_PAGE_SIZE))
|
|
||||||
|
|
||||||
/* Page status markers (stored in the first halfword of each page) */
|
|
||||||
#define EE_PAGE_STATUS_ERASED 0xFFFFU
|
|
||||||
#define EE_PAGE_STATUS_VALID 0xAAAAU
|
|
||||||
#define EE_PAGE_STATUS_RECEIVE 0x5555U
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Configure how many virtual variables you have.
|
|
||||||
* Example: bytes, words, and array elements mapped to 16-bit variables.
|
|
||||||
* Set EE_NUM_VIRTUAL_ADDR and define EE_VirtAddrs[] in eeprom.c.
|
|
||||||
*/
|
|
||||||
#define EE_NUM_VIRTUAL_ADDR 16U
|
|
||||||
|
|
||||||
/* Virtual address table (defined in eeprom.c, can be customized) */
|
|
||||||
extern const uint16_t EE_VirtAddrs[EE_NUM_VIRTUAL_ADDR];
|
|
||||||
|
|
||||||
/* Public API */
|
|
||||||
EE_Status EE_Init(void);
|
|
||||||
EE_Status EE_ReadVariable(uint16_t VirtAddress, uint16_t *Data);
|
|
||||||
EE_Status EE_WriteVariable(uint16_t VirtAddress, uint16_t Data);
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#endif /* __EEPROM_H */
|
|
||||||
|
|
||||||
@@ -1,78 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,60 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.c
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
bool IsPwmRunning(TIM_HandleTypeDef *htim, uint32_t Channel)
|
|
||||||
{
|
|
||||||
HAL_TIM_ChannelStateTypeDef chState = HAL_TIM_GetChannelState(htim, Channel);
|
|
||||||
|
|
||||||
return (chState == HAL_TIM_CHANNEL_STATE_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
void StopMot(TIM_HandleTypeDef *htim,uint32_t Channel){
|
|
||||||
HAL_TIM_PWM_Stop(htim, Channel);
|
|
||||||
}
|
|
||||||
|
|
||||||
void StartMot(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval){
|
|
||||||
__HAL_TIM_SET_COMPARE(htim, Channel, pwmval);
|
|
||||||
HAL_TIM_PWM_Start(htim, Channel);
|
|
||||||
}
|
|
||||||
|
|
||||||
void SetMotPwm(TIM_HandleTypeDef *htim,uint32_t Channel,uint16_t pwmval){
|
|
||||||
__HAL_TIM_SET_COMPARE(htim, Channel, pwmval);
|
|
||||||
}
|
|
||||||
|
|
||||||
void SetMot(uint8_t mot,uint8_t dir,uint16_t pwmval){
|
|
||||||
TIM_HandleTypeDef *htim;
|
|
||||||
switch(mot){
|
|
||||||
case 1:
|
|
||||||
if(dir==FW){
|
|
||||||
if(IsPwmRunning(timMot1, FWMot1)){
|
|
||||||
else{
|
|
||||||
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
break;
|
|
||||||
case 3:
|
|
||||||
break;
|
|
||||||
case 4:
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,94 +0,0 @@
|
|||||||
#include <string.h>
|
|
||||||
#include "usb_device.h"
|
|
||||||
|
|
||||||
#include "usbd_cdc_if.h"
|
|
||||||
#include "cdc_int.h"
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
extern TIM_HandleTypeDef htim1;
|
|
||||||
extern TIM_HandleTypeDef htim2;
|
|
||||||
extern TIM_HandleTypeDef htim3;
|
|
||||||
extern TIM_HandleTypeDef htim4;
|
|
||||||
|
|
||||||
void manageCDC(void){
|
|
||||||
static uint8_t rxbuf[100];
|
|
||||||
static uint8_t rxidx=0;
|
|
||||||
unsigned char s[100];
|
|
||||||
uint8_t mot,dir,dm,m,c,d,u;
|
|
||||||
uint16_t val;
|
|
||||||
|
|
||||||
if (CDC_Available()) {
|
|
||||||
int c = CDC_ReadByte();
|
|
||||||
if (c < 0) return;
|
|
||||||
//uint8_t out = (uint8_t)c;
|
|
||||||
//if (out >= 'a' && out <= 'z') out -= 32; // to upper
|
|
||||||
rxbuf[rxidx]=c;
|
|
||||||
while (CDC_Transmit_FS(&rxbuf[rxidx], 1) == USBD_BUSY);//echo
|
|
||||||
if((c==0x0d)||(c==0x0a)){
|
|
||||||
if(rxidx){
|
|
||||||
switch(rxbuf[0]){
|
|
||||||
case 'i':
|
|
||||||
sprintf((char*)s,"\ninfo");
|
|
||||||
while (CDC_Transmit_FS(s, 5) == USBD_BUSY);
|
|
||||||
sprintf((char*)s,"\npwm %d%d%d%d%d%d%d%d",IsPwmRunning(timMot1,FWMot1),IsPwmRunning(timMot1,BWMot1),IsPwmRunning(timMot2,FWMot2),IsPwmRunning(timMot2,BWMot2),IsPwmRunning(timMot3,FWMot3),IsPwmRunning(timMot3,BWMot3),IsPwmRunning(timMot4,FWMot4),IsPwmRunning(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
__HAL_TIM_GET_COMPARE(&htim3, TIM_CHANNEL_1);
|
|
||||||
sprintf((char*)s,"\n0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx",(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,FWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot1,BWMot1),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,FWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot2,BWMot2),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,FWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot3,BWMot3),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,FWMot4),(uint32_t)__HAL_TIM_GET_COMPARE(timMot4,BWMot4));
|
|
||||||
while (CDC_Transmit_FS(s, strlen((char*)s)) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
case 'm':
|
|
||||||
if(rxidx==8){
|
|
||||||
if((rxbuf[1]>='1')&&(rxbuf[1]<='4')){
|
|
||||||
mot=rxbuf[1]-='0';
|
|
||||||
if(rxbuf[2]=='f'){
|
|
||||||
dir=FW;
|
|
||||||
}else if(rxbuf[2]=='b'){
|
|
||||||
dir=BW;
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv s=f|b");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 16) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(((rxbuf[3]>='0')&&(rxbuf[3]<='9'))&&((rxbuf[4]>='0')&&(rxbuf[4]<='9'))&&((rxbuf[5]>='0')&&(rxbuf[5]<='9'))&&((rxbuf[6]>='0')&&(rxbuf[6]<='9'))&&((rxbuf[7]>='0')&&(rxbuf[7]<='9'))){
|
|
||||||
dm=rxbuf[3]-='0';
|
|
||||||
m=rxbuf[4]-='0';
|
|
||||||
c=rxbuf[5]-='0';
|
|
||||||
d=rxbuf[6]-='0';
|
|
||||||
u=rxbuf[7]-='0';
|
|
||||||
val=dm;
|
|
||||||
val*=10;
|
|
||||||
val+=m;
|
|
||||||
val*=10;
|
|
||||||
val+=c;
|
|
||||||
val*=10;
|
|
||||||
val+=d;
|
|
||||||
val*=10;
|
|
||||||
val+=u;
|
|
||||||
SetMot(mot,dir,val);
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 00000>=vvvvv<=99999");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv 1>=m<=4");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 19) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
sprintf((char*)s,"\n?mnsvvvvv");//m nmotore senso valore
|
|
||||||
while (CDC_Transmit_FS(s, 10) == USBD_BUSY);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
sprintf((char*)s,"\n?");
|
|
||||||
while (CDC_Transmit_FS(s, 2) == USBD_BUSY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rxidx=0;
|
|
||||||
}else rxidx++;
|
|
||||||
// tiny spin or yield
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
@@ -1,17 +0,0 @@
|
|||||||
/*
|
|
||||||
* pwm.c
|
|
||||||
*
|
|
||||||
* Created on: Dec 6, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
#include "stm32f1xx_hal.h"
|
|
||||||
#include "pwm.h"
|
|
||||||
|
|
||||||
bool IsPwmRunning(TIM_HandleTypeDef *htim, uint32_t Channel)
|
|
||||||
{
|
|
||||||
HAL_TIM_ChannelStateTypeDef chState = HAL_TIM_GetChannelState(htim, Channel);
|
|
||||||
|
|
||||||
return (chState == HAL_TIM_CHANNEL_STATE_BUSY);
|
|
||||||
}
|
|
||||||
@@ -1,13 +0,0 @@
|
|||||||
/*
|
|
||||||
* adc.h
|
|
||||||
*
|
|
||||||
* Created on: Dec 8, 2025
|
|
||||||
* Author: user
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef INC_ADC_H_
|
|
||||||
#define INC_ADC_H_
|
|
||||||
|
|
||||||
void manageAdc(void);
|
|
||||||
|
|
||||||
#endif /* INC_ADC_H_ */
|
|
||||||
Some files were not shown because too many files have changed in this diff Show More
Reference in New Issue
Block a user