[add] added new hal level led/can
This commit is contained in:
1 parent
1c2d945a6d
commit
33d3feede4
35 files changed
+443
-3000
No files matched your search
@@ -82,6 +82,10 @@
|
||||
"version": "1.0.1+st.2",
|
||||
"platform": "all",
|
||||
"selected_by": [
|
||||
{
|
||||
"name": "gnu-tools-for-stm32-14_3_1-description",
|
||||
"version": "1.0.1+st.2"
|
||||
},
|
||||
{
|
||||
"name": "gnu-tools-for-stm32-14_3_1-description",
|
||||
"version": ">=0.0.1"
|
||||
|
||||
@@ -15,6 +15,10 @@
|
||||
{
|
||||
"name": "st-arm-clangd",
|
||||
"version": "21.1.0+st.2"
|
||||
},
|
||||
{
|
||||
"name": "gnu-tools-for-stm32-14_3_1-description",
|
||||
"version": "1.0.1+st.2"
|
||||
}
|
||||
]
|
||||
}
|
||||
Vendored
+1
@@ -8,6 +8,7 @@
|
||||
],
|
||||
"stm32cube-ide-clangd.path": "cube",
|
||||
"stm32cube-ide-clangd.arguments": [
|
||||
"--compile-commands-dir=${workspaceFolder}/build/Debug",
|
||||
"starm-clangd",
|
||||
"--query-driver=${env:CUBE_BUNDLE_PATH}/gnu-tools-for-stm32/14.3.1+st.2/bin/arm-none-eabi-gcc*",
|
||||
"--query-driver=${env:CUBE_BUNDLE_PATH}/gnu-tools-for-stm32/14.3.1+st.2/bin/arm-none-eabi-g++*"
|
||||
|
||||
+22
-8
@@ -48,19 +48,33 @@ target_link_directories(${CMAKE_PROJECT_NAME} PRIVATE
|
||||
# Add sources to executable
|
||||
target_sources(${CMAKE_PROJECT_NAME} PRIVATE
|
||||
# Add user sources here
|
||||
Modules/Sensors/j901p.c
|
||||
Modules/Sensors/j901p_hal.c
|
||||
Modules/Devices/mf4010v2.c
|
||||
Bsp/can/bsp_can.c
|
||||
modules/sensor/imu/j901p.c
|
||||
modules/sensor/imu/j901p_hal.c
|
||||
modules/device/motor/mf4010v2.c
|
||||
modules/device/led/led.c
|
||||
bsp/stm32f4/can/bsp_can.c
|
||||
bsp/stm32f4/led/bsp_led.c
|
||||
hal/stm32f4/led/hal_led_stm32f4.c
|
||||
hal/stm32f4/can/hal_can_stm32f4.c
|
||||
app/app.c
|
||||
interfaces/led/led_if.c
|
||||
interfaces/can/can_if.c
|
||||
|
||||
)
|
||||
|
||||
# Add include paths
|
||||
target_include_directories(${CMAKE_PROJECT_NAME} PRIVATE
|
||||
# Add user defined include paths
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/Modules/Sensors
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/Modules/Devices
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/Bsp/can
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/Core/Inc
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/modules/device/led
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/modules/device/motor
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/modules/sensor/imu
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/bsp/stm32f4/can
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/bsp/stm32f4/led
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/app
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/hal/stm32f4/led
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/hal/stm32f4/can
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/interfaces/led
|
||||
${CMAKE_CURRENT_SOURCE_DIR}/interfaces/can
|
||||
)
|
||||
|
||||
# Add project symbols (macros)
|
||||
|
||||
@@ -1,385 +0,0 @@
|
||||
/* USER CODE BEGIN Header */
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file can.c
|
||||
* @brief This file provides code for the configuration
|
||||
* of the CAN instances.
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2026 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 "can.h"
|
||||
|
||||
/* USER CODE BEGIN 0 */
|
||||
#include <string.h>
|
||||
#include <stdio.h>
|
||||
#include "cmsis_os.h"
|
||||
|
||||
/* USER CODE END 0 */
|
||||
|
||||
CAN_HandleTypeDef hcan2;
|
||||
|
||||
/* CAN2 init function */
|
||||
void MX_CAN2_Init(void)
|
||||
{
|
||||
|
||||
/* USER CODE BEGIN CAN2_Init 0 */
|
||||
|
||||
/* USER CODE END CAN2_Init 0 */
|
||||
|
||||
/* USER CODE BEGIN CAN2_Init 1 */
|
||||
|
||||
/* USER CODE END CAN2_Init 1 */
|
||||
hcan2.Instance = CAN2;
|
||||
hcan2.Init.Prescaler = 6;
|
||||
hcan2.Init.Mode = CAN_MODE_NORMAL;
|
||||
hcan2.Init.SyncJumpWidth = CAN_SJW_1TQ;
|
||||
hcan2.Init.TimeSeg1 = CAN_BS1_2TQ;
|
||||
hcan2.Init.TimeSeg2 = CAN_BS2_4TQ;
|
||||
hcan2.Init.TimeTriggeredMode = DISABLE;
|
||||
hcan2.Init.AutoBusOff = DISABLE;
|
||||
hcan2.Init.AutoWakeUp = DISABLE;
|
||||
hcan2.Init.AutoRetransmission = ENABLE;
|
||||
hcan2.Init.ReceiveFifoLocked = DISABLE;
|
||||
hcan2.Init.TransmitFifoPriority = DISABLE;
|
||||
if (HAL_CAN_Init(&hcan2) != HAL_OK)
|
||||
{
|
||||
Error_Handler();
|
||||
}
|
||||
/* USER CODE BEGIN CAN2_Init 2 */
|
||||
CAN_ConfigFilter(&hcan2, 0, 0x0000, 0x0000);
|
||||
/* USER CODE END CAN2_Init 2 */
|
||||
|
||||
}
|
||||
|
||||
void HAL_CAN_MspInit(CAN_HandleTypeDef* canHandle)
|
||||
{
|
||||
|
||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
||||
if(canHandle->Instance==CAN2)
|
||||
{
|
||||
/* USER CODE BEGIN CAN2_MspInit 0 */
|
||||
|
||||
/* USER CODE END CAN2_MspInit 0 */
|
||||
/* CAN2 clock enable */
|
||||
__HAL_RCC_CAN2_CLK_ENABLE();
|
||||
__HAL_RCC_CAN1_CLK_ENABLE();
|
||||
|
||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
||||
/**CAN2 GPIO Configuration
|
||||
PB12 ------> CAN2_RX
|
||||
PB13 ------> CAN2_TX
|
||||
*/
|
||||
GPIO_InitStruct.Pin = GPIO_PIN_12|GPIO_PIN_13;
|
||||
GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
|
||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
||||
GPIO_InitStruct.Alternate = GPIO_AF9_CAN2;
|
||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
||||
|
||||
/* USER CODE BEGIN CAN2_MspInit 1 */
|
||||
|
||||
/* USER CODE END CAN2_MspInit 1 */
|
||||
}
|
||||
}
|
||||
|
||||
void HAL_CAN_MspDeInit(CAN_HandleTypeDef* canHandle)
|
||||
{
|
||||
|
||||
if(canHandle->Instance==CAN2)
|
||||
{
|
||||
/* USER CODE BEGIN CAN2_MspDeInit 0 */
|
||||
|
||||
/* USER CODE END CAN2_MspDeInit 0 */
|
||||
/* Peripheral clock disable */
|
||||
__HAL_RCC_CAN2_CLK_DISABLE();
|
||||
__HAL_RCC_CAN1_CLK_DISABLE();
|
||||
|
||||
/**CAN2 GPIO Configuration
|
||||
PB12 ------> CAN2_RX
|
||||
PB13 ------> CAN2_TX
|
||||
*/
|
||||
HAL_GPIO_DeInit(GPIOB, GPIO_PIN_12|GPIO_PIN_13);
|
||||
|
||||
/* USER CODE BEGIN CAN2_MspDeInit 1 */
|
||||
|
||||
/* USER CODE END CAN2_MspDeInit 1 */
|
||||
}
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN 1 */
|
||||
|
||||
/**
|
||||
* @brief 启动 CAN 外设
|
||||
*/
|
||||
HAL_StatusTypeDef CAN_Start(CAN_HandleTypeDef* hcan)
|
||||
{
|
||||
return HAL_CAN_Start(hcan);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief 配置 CAN 滤波器
|
||||
* @param hcan: CAN 句柄指针
|
||||
* @param filter_id: 滤波器编号 (0-13)
|
||||
* @param id: 要接收的 ID
|
||||
* @param mask: 掩码
|
||||
*/
|
||||
void CAN_ConfigFilter(CAN_HandleTypeDef* hcan, uint8_t filter_id, uint16_t id, uint16_t mask)
|
||||
{
|
||||
CAN_FilterTypeDef sFilterConfig;
|
||||
|
||||
sFilterConfig.FilterBank = filter_id;
|
||||
sFilterConfig.FilterMode = CAN_FILTERMODE_IDMASK;
|
||||
sFilterConfig.FilterScale = CAN_FILTERSCALE_16BIT;
|
||||
sFilterConfig.FilterIdHigh = id;
|
||||
sFilterConfig.FilterIdLow = 0x0000;
|
||||
sFilterConfig.FilterMaskIdHigh = mask;
|
||||
sFilterConfig.FilterMaskIdLow = 0x0000;
|
||||
sFilterConfig.FilterFIFOAssignment = CAN_RX_FIFO0;
|
||||
sFilterConfig.FilterActivation = ENABLE;
|
||||
|
||||
if (HAL_CAN_ConfigFilter(hcan, &sFilterConfig) != HAL_OK)
|
||||
{
|
||||
Error_Handler();
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
/**
|
||||
* @brief 发送 CAN 帧
|
||||
* @param hcan: CAN 句柄指针
|
||||
* @param id: 标准 ID (0x000-0x7FF)
|
||||
* @param data: 数据指针
|
||||
* @param len: 数据长度 (0-8)
|
||||
* @param timeout: 超时时间 (ms)
|
||||
* @retval HAL 状态
|
||||
*/
|
||||
HAL_StatusTypeDef CAN_SendFrame(CAN_HandleTypeDef* hcan, uint16_t id, const uint8_t* data, uint8_t len, uint32_t timeout)
|
||||
{
|
||||
CAN_TxHeaderTypeDef TxHeader;
|
||||
uint32_t TxMailbox;
|
||||
|
||||
if (data == NULL || len > 8)
|
||||
{
|
||||
return HAL_ERROR;
|
||||
}
|
||||
|
||||
TxHeader.StdId = 0x0000 | id;
|
||||
TxHeader.ExtId = 0x0000;
|
||||
TxHeader.IDE = CAN_ID_STD;
|
||||
TxHeader.RTR = CAN_RTR_DATA;
|
||||
TxHeader.DLC = len;
|
||||
TxHeader.TransmitGlobalTime = DISABLE;
|
||||
printf("Sending CAN frame: ID=0x%03X, Data=", id);
|
||||
for (uint8_t i = 0; i < len; i++)
|
||||
{
|
||||
printf("%02X ", data[i]);
|
||||
}
|
||||
printf("\r\n");
|
||||
// 等待邮箱可用
|
||||
if (HAL_CAN_GetTxMailboxesFreeLevel(hcan) == 0)
|
||||
{
|
||||
// 等待直到有邮箱可用
|
||||
while (HAL_CAN_GetTxMailboxesFreeLevel(hcan) == 0)
|
||||
{
|
||||
if (timeout > 0)
|
||||
{
|
||||
osDelay(1);
|
||||
timeout--;
|
||||
if (timeout == 0)
|
||||
{
|
||||
return HAL_TIMEOUT;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
// 添加发送消息
|
||||
printf("Adding CAN message to mailbox...\r\n");
|
||||
if (HAL_CAN_AddTxMessage(hcan, &TxHeader, data, &TxMailbox) != HAL_OK)
|
||||
{
|
||||
return HAL_ERROR;
|
||||
}
|
||||
printf("Message added to mailbox %lu, waiting for transmission...\r\n", TxMailbox);
|
||||
// 等待发送完成
|
||||
while (HAL_CAN_IsTxMessagePending(hcan, TxMailbox))
|
||||
{
|
||||
if (timeout > 0)
|
||||
{
|
||||
osDelay(1);
|
||||
timeout--;
|
||||
if (timeout == 0)
|
||||
{
|
||||
// 超时,打印诊断信息
|
||||
printf("TX timeout! ESR=0x%08lX TSR=0x%08lX\r\n",
|
||||
hcan->Instance->ESR, hcan->Instance->TSR);
|
||||
printf(" TEC=%lu REC=%lu LEC=%lu\r\n",
|
||||
(hcan->Instance->ESR >> 16) & 0xFF,
|
||||
(hcan->Instance->ESR >> 24) & 0xFF,
|
||||
(hcan->Instance->ESR >> 4) & 0x07);
|
||||
printf(" TME=0x%lX BOFF=%lu EPVF=%lu EWGF=%lu\r\n",
|
||||
(hcan->Instance->TSR >> 26) & 0x7,
|
||||
(hcan->Instance->ESR >> 2) & 1,
|
||||
(hcan->Instance->ESR >> 1) & 1,
|
||||
hcan->Instance->ESR & 1);
|
||||
return HAL_TIMEOUT;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return HAL_OK;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief 接收 CAN 帧
|
||||
* @param hcan: CAN 句柄指针
|
||||
* @param id: 接收到的 ID (输出)
|
||||
* @param data: 数据缓冲区 (输出)
|
||||
* @param len: 数据长度 (输出)
|
||||
* @param timeout: 超时时间 (ms)
|
||||
* @retval HAL 状态
|
||||
*/
|
||||
HAL_StatusTypeDef CAN_ReceiveFrame(CAN_HandleTypeDef* hcan, uint16_t* id, uint8_t* data, uint8_t* len, uint32_t timeout)
|
||||
{
|
||||
CAN_RxHeaderTypeDef RxHeader;
|
||||
uint32_t start_tick;
|
||||
|
||||
if (id == NULL || data == NULL || len == NULL)
|
||||
{
|
||||
return HAL_ERROR;
|
||||
}
|
||||
|
||||
start_tick = HAL_GetTick();
|
||||
|
||||
// 等待消息到达
|
||||
while (HAL_CAN_GetRxFifoFillLevel(hcan, CAN_RX_FIFO0) == 0)
|
||||
{
|
||||
if (timeout > 0)
|
||||
{
|
||||
if ((HAL_GetTick() - start_tick) >= timeout)
|
||||
{
|
||||
return HAL_TIMEOUT;
|
||||
}
|
||||
}
|
||||
// 短暂延时避免死循环
|
||||
osDelay(1);
|
||||
}
|
||||
|
||||
// 接收消息
|
||||
if (HAL_CAN_GetRxMessage(hcan, CAN_RX_FIFO0, &RxHeader, data) != HAL_OK)
|
||||
{
|
||||
return HAL_ERROR;
|
||||
}
|
||||
|
||||
*id = RxHeader.StdId;
|
||||
*len = RxHeader.DLC;
|
||||
|
||||
return HAL_OK;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief 检查是否有接收到的消息
|
||||
* @param hcan: CAN 句柄指针
|
||||
* @retval 1: 有消息,0: 无消息
|
||||
*/
|
||||
uint8_t CAN_HasMessage(CAN_HandleTypeDef* hcan)
|
||||
{
|
||||
return HAL_CAN_GetRxFifoFillLevel(hcan, CAN_RX_FIFO0) > 0 ? 1 : 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief 获取 CAN 错误码
|
||||
* @param hcan: CAN 句柄指针
|
||||
* @retval CAN 错误码
|
||||
*/
|
||||
uint32_t CAN_GetErrorCode(CAN_HandleTypeDef* hcan)
|
||||
{
|
||||
return HAL_CAN_GetError(hcan);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief 获取 CAN 状态
|
||||
* @param hcan: CAN 句柄指针
|
||||
* @retval CAN 状态
|
||||
*/
|
||||
uint32_t CAN_GetState(CAN_HandleTypeDef* hcan)
|
||||
{
|
||||
return HAL_CAN_GetState(hcan);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief 打印 CAN 详细调试信息
|
||||
* @param hcan: CAN 句柄指针
|
||||
* @param huart: 用于输出的串口句柄
|
||||
*/
|
||||
void CAN_PrintDebugInfo(CAN_HandleTypeDef* hcan, UART_HandleTypeDef *huart)
|
||||
{
|
||||
char buf[80];
|
||||
int len;
|
||||
|
||||
len = snprintf(buf, sizeof(buf), "=== CAN Debug Info ===\r\n");
|
||||
HAL_UART_Transmit(huart, (uint8_t*)buf, len, 50);
|
||||
|
||||
len = snprintf(buf, sizeof(buf), "State: %d, Error: 0x%08lX\r\n",
|
||||
(int)HAL_CAN_GetState(hcan), HAL_CAN_GetError(hcan));
|
||||
HAL_UART_Transmit(huart, (uint8_t*)buf, len, 50);
|
||||
|
||||
uint32_t esr = hcan->Instance->ESR;
|
||||
len = snprintf(buf, sizeof(buf), "ESR: 0x%08lX\r\n", esr);
|
||||
HAL_UART_Transmit(huart, (uint8_t*)buf, len, 50);
|
||||
|
||||
uint32_t lec = (esr >> 4) & 0x07;
|
||||
const char* lec_str[] = {"No Error", "Stuff Error", "Form Error",
|
||||
"Ack Error", "Bit1 Error", "Bit0 Error",
|
||||
"CRC Error", "No Change"};
|
||||
len = snprintf(buf, sizeof(buf), " LEC: %ld (%s)\r\n", lec, lec_str[lec]);
|
||||
HAL_UART_Transmit(huart, (uint8_t*)buf, len, 50);
|
||||
|
||||
len = snprintf(buf, sizeof(buf), " TEC: %ld, REC: %ld\r\n",
|
||||
(esr >> 16) & 0xFF, (esr >> 24) & 0xFF);
|
||||
HAL_UART_Transmit(huart, (uint8_t*)buf, len, 50);
|
||||
|
||||
len = snprintf(buf, sizeof(buf), " BOFF: %ld, EPVF: %ld, EWGF: %ld\r\n",
|
||||
(esr >> 2) & 1, (esr >> 1) & 1, esr & 1);
|
||||
HAL_UART_Transmit(huart, (uint8_t*)buf, len, 50);
|
||||
|
||||
uint32_t tsr = hcan->Instance->TSR;
|
||||
len = snprintf(buf, sizeof(buf), "TSR: 0x%08lX\r\n", tsr);
|
||||
HAL_UART_Transmit(huart, (uint8_t*)buf, len, 50);
|
||||
|
||||
len = snprintf(buf, sizeof(buf), " TME: 0x%lX, LOW: 0x%lX, CODE: %ld\r\n",
|
||||
(tsr >> 26) & 0x7, (tsr >> 29) & 0x7, (tsr >> 24) & 0x3);
|
||||
HAL_UART_Transmit(huart, (uint8_t*)buf, len, 50);
|
||||
|
||||
len = snprintf(buf, sizeof(buf), " Free mailboxes: %ld\r\n",
|
||||
HAL_CAN_GetTxMailboxesFreeLevel(hcan));
|
||||
HAL_UART_Transmit(huart, (uint8_t*)buf, len, 50);
|
||||
|
||||
len = snprintf(buf, sizeof(buf), "RFR0: 0x%08lX, FIFO0: %ld\r\n",
|
||||
hcan->Instance->RF0R, HAL_CAN_GetRxFifoFillLevel(hcan, CAN_RX_FIFO0));
|
||||
HAL_UART_Transmit(huart, (uint8_t*)buf, len, 50);
|
||||
|
||||
len = snprintf(buf, sizeof(buf), "RFR1: 0x%08lX, FIFO1: %ld\r\n",
|
||||
hcan->Instance->RF1R, HAL_CAN_GetRxFifoFillLevel(hcan, CAN_RX_FIFO1));
|
||||
HAL_UART_Transmit(huart, (uint8_t*)buf, len, 50);
|
||||
|
||||
len = snprintf(buf, sizeof(buf), "BTR: 0x%08lX (BRP=%ld, BS1=%ld, BS2=%ld, SJW=%ld)\r\n",
|
||||
hcan->Instance->BTR,
|
||||
(hcan->Instance->BTR >> 0) & 0x1FF,
|
||||
(hcan->Instance->BTR >> 16) & 0x0F,
|
||||
(hcan->Instance->BTR >> 20) & 0x07,
|
||||
(hcan->Instance->BTR >> 24) & 0x03);
|
||||
HAL_UART_Transmit(huart, (uint8_t*)buf, len, 50);
|
||||
}
|
||||
|
||||
/* USER CODE END 1 */
|
||||
@@ -1,338 +0,0 @@
|
||||
/* USER CODE BEGIN Header */
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file freertos.c
|
||||
* @brief FreeRTOS configuration file
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2026 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 "FreeRTOS.h"
|
||||
#include "task.h"
|
||||
#include "main.h"
|
||||
#include "cmsis_os.h"
|
||||
|
||||
/* Private includes ----------------------------------------------------------*/
|
||||
/* USER CODE BEGIN Includes */
|
||||
#include <stddef.h>
|
||||
#include <stdint.h>
|
||||
#include <stdio.h>
|
||||
#include "usart.h"
|
||||
#include "can.h"
|
||||
#include "j901p.h"
|
||||
#include "j901p_hal.h"
|
||||
#include "mf4010v2.h"
|
||||
#include "mf4010v2_hal.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 ---------------------------------------------------------*/
|
||||
/* USER CODE BEGIN Variables */
|
||||
volatile uint8_t s_cDataUpdate;
|
||||
void CopeSensorData(uint32_t uiReg, uint32_t uiRegNum);
|
||||
|
||||
// 传感器数据结构(用于任务间通信)
|
||||
typedef struct {
|
||||
int16_t acc[3]; // 加速度计原始数据
|
||||
int16_t gyro[3]; // 陀螺仪原始数据
|
||||
int16_t angle[3]; // 角度数据
|
||||
uint8_t valid; // 数据有效标志
|
||||
} SensorData_TypeDef;
|
||||
|
||||
SensorData_TypeDef sensorData = {{0}, {0}, {0}, 0};
|
||||
|
||||
// 电机实例
|
||||
mf4010v2_t motor1; // z轴电机
|
||||
mf4010v2_t motor2; // xy轴电机
|
||||
/* USER CODE END Variables */
|
||||
/* Definitions for monitorTask */
|
||||
osThreadId_t monitorTaskHandle;
|
||||
const osThreadAttr_t monitorTask_attributes = {
|
||||
.name = "monitorTask",
|
||||
.stack_size = 256 * 4,
|
||||
.priority = (osPriority_t) osPriorityLow,
|
||||
};
|
||||
/* Definitions for controlTask */
|
||||
osThreadId_t controlTaskHandle;
|
||||
const osThreadAttr_t controlTask_attributes = {
|
||||
.name = "controlTask",
|
||||
.stack_size = 256 * 4,
|
||||
.priority = (osPriority_t) osPriorityNormal,
|
||||
};
|
||||
/* Definitions for sensorTask */
|
||||
osThreadId_t sensorTaskHandle;
|
||||
const osThreadAttr_t sensorTask_attributes = {
|
||||
.name = "sensorTask",
|
||||
.stack_size = 256 * 4,
|
||||
.priority = (osPriority_t) osPriorityHigh,
|
||||
};
|
||||
|
||||
/* Private function prototypes -----------------------------------------------*/
|
||||
/* USER CODE BEGIN FunctionPrototypes */
|
||||
|
||||
/* USER CODE END FunctionPrototypes */
|
||||
|
||||
void StartMonitorTask(void *argument);
|
||||
void StartControlTask(void *argument);
|
||||
void StartSensorTask(void *argument);
|
||||
|
||||
void MX_FREERTOS_Init(void); /* (MISRA C 2004 rule 8.1) */
|
||||
|
||||
/**
|
||||
* @brief FreeRTOS initialization
|
||||
* @param None
|
||||
* @retval None
|
||||
*/
|
||||
void MX_FREERTOS_Init(void) {
|
||||
/* USER CODE BEGIN Init */
|
||||
|
||||
/* USER CODE END Init */
|
||||
|
||||
/* USER CODE BEGIN RTOS_MUTEX */
|
||||
/* add mutexes, ... */
|
||||
/* USER CODE END RTOS_MUTEX */
|
||||
|
||||
/* USER CODE BEGIN RTOS_SEMAPHORES */
|
||||
/* add semaphores, ... */
|
||||
/* USER CODE END RTOS_SEMAPHORES */
|
||||
|
||||
/* USER CODE BEGIN RTOS_TIMERS */
|
||||
/* start timers, add new ones, ... */
|
||||
/* USER CODE END RTOS_TIMERS */
|
||||
|
||||
/* USER CODE BEGIN RTOS_QUEUES */
|
||||
/* add queues, ... */
|
||||
/* USER CODE END RTOS_QUEUES */
|
||||
|
||||
/* Create the thread(s) */
|
||||
/* creation of monitorTask */
|
||||
monitorTaskHandle = osThreadNew(StartMonitorTask, NULL, &monitorTask_attributes);
|
||||
|
||||
/* creation of controlTask */
|
||||
controlTaskHandle = osThreadNew(StartControlTask, NULL, &controlTask_attributes);
|
||||
|
||||
/* creation of sensorTask */
|
||||
sensorTaskHandle = osThreadNew(StartSensorTask, NULL, &sensorTask_attributes);
|
||||
|
||||
/* USER CODE BEGIN RTOS_THREADS */
|
||||
/* add threads, ... */
|
||||
/* USER CODE END RTOS_THREADS */
|
||||
|
||||
/* USER CODE BEGIN RTOS_EVENTS */
|
||||
/* add events, ... */
|
||||
/* USER CODE END RTOS_EVENTS */
|
||||
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN Header_StartMonitorTask */
|
||||
/**
|
||||
* @brief Function implementing the monitorTask thread.
|
||||
* @param argument: Not used
|
||||
* @retval None
|
||||
*/
|
||||
/* USER CODE END Header_StartMonitorTask */
|
||||
void StartMonitorTask(void *argument)
|
||||
{
|
||||
/* USER CODE BEGIN StartMonitorTask */
|
||||
argument = argument;
|
||||
// 等待传感器数据初始化
|
||||
osDelay(500);
|
||||
|
||||
const uint8_t monitor_start[] = "Monitor task started\r\n";
|
||||
HAL_UART_Transmit(&huart1, monitor_start, sizeof(monitor_start)-1, 100);
|
||||
|
||||
for(;;)
|
||||
{
|
||||
// 等待有效数据
|
||||
if(sensorData.valid)
|
||||
{
|
||||
// 输出加速度
|
||||
const uint8_t acc_msg[] = "ACC: ";
|
||||
HAL_UART_Transmit(&huart1, acc_msg, sizeof(acc_msg)-1, 50);
|
||||
|
||||
for(int i=0; i<3; i++)
|
||||
{
|
||||
int32_t acc_scaled = (sensorData.acc[i] * 16 * 1000) / 32768;
|
||||
int32_t acc_int = acc_scaled / 1000;
|
||||
int32_t acc_frac = acc_scaled % 1000;
|
||||
if(acc_frac < 0) acc_frac = -acc_frac;
|
||||
|
||||
char acc_str[20];
|
||||
int acc_len = snprintf(acc_str, sizeof(acc_str), "%ld.%03ld ", acc_int, acc_frac);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)acc_str, acc_len, 50);
|
||||
}
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)"\r\n", 2, 50);
|
||||
|
||||
// 输出角速度
|
||||
const uint8_t gyro_msg[] = "GYRO: ";
|
||||
HAL_UART_Transmit(&huart1, gyro_msg, sizeof(gyro_msg)-1, 50);
|
||||
|
||||
for(int i=0; i<3; i++)
|
||||
{
|
||||
int32_t gyro_scaled = (sensorData.gyro[i] * 2000 * 1000) / 32768;
|
||||
int32_t gyro_int = gyro_scaled / 1000;
|
||||
int32_t gyro_frac = gyro_scaled % 1000;
|
||||
if(gyro_frac < 0) gyro_frac = -gyro_frac;
|
||||
|
||||
char gyro_str[20];
|
||||
int gyro_len = snprintf(gyro_str, sizeof(gyro_str), "%ld.%03ld ", gyro_int, gyro_frac);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)gyro_str, gyro_len, 50);
|
||||
}
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)"\r\n", 2, 50);
|
||||
|
||||
// 输出角度
|
||||
const uint8_t angle_msg[] = "ANGLE: ";
|
||||
HAL_UART_Transmit(&huart1, angle_msg, sizeof(angle_msg)-1, 50);
|
||||
|
||||
for(int i=0; i<3; i++)
|
||||
{
|
||||
int32_t angle_scaled = (sensorData.angle[i] * 180 * 1000) / 32768;
|
||||
int32_t angle_int = angle_scaled / 1000;
|
||||
int32_t angle_frac = angle_scaled % 1000;
|
||||
if(angle_frac < 0) angle_frac = -angle_frac;
|
||||
|
||||
char angle_str[20];
|
||||
int angle_len = snprintf(angle_str, sizeof(angle_str), "%ld.%03ld ", angle_int, angle_frac);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)angle_str, angle_len, 50);
|
||||
}
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)"\r\n", 2, 50);
|
||||
|
||||
sensorData.valid = 0; // 清除标志,等待下次更新
|
||||
}
|
||||
|
||||
osDelay(200); // 200ms 输出间隔
|
||||
}
|
||||
/* USER CODE END StartMonitorTask */
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN Header_StartControlTask */
|
||||
/**
|
||||
* @brief Function implementing the controlTask thread.
|
||||
* @param argument: Not used
|
||||
* @retval None
|
||||
*/
|
||||
/* USER CODE END Header_StartControlTask */
|
||||
void StartControlTask(void *argument)
|
||||
{
|
||||
/* USER CODE BEGIN StartControlTask */
|
||||
argument = argument;
|
||||
|
||||
osDelay(500);
|
||||
|
||||
// 初始化电机
|
||||
const uint8_t motor_init[] = "Initializing motor...\r\n";
|
||||
HAL_UART_Transmit(&huart1, motor_init, sizeof(motor_init)-1, 100);
|
||||
size_t len;
|
||||
mf4010_status_t status;
|
||||
status = mf4010v2_init(&motor1, 0x141);
|
||||
if(status != MF4010_OK) {
|
||||
char err_code[32];
|
||||
len = snprintf(err_code, sizeof(err_code), "Motor1 init: %d\r\n", status);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)err_code, len, 50);
|
||||
}
|
||||
status = mf4010v2_init(&motor2, 0x142);
|
||||
if(status != MF4010_OK) {
|
||||
char err_code[32];
|
||||
len = snprintf(err_code, sizeof(err_code), "Motor2 init: %d\r\n", status);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)err_code, len, 50);
|
||||
}
|
||||
|
||||
|
||||
osDelay(200);
|
||||
|
||||
// 测试发送电机启动命令
|
||||
const uint8_t cmd[] = COMMAND_MOTOR_CLOSE;
|
||||
status = mf4010v2_send_command(&motor2, cmd, 1000);
|
||||
if (status != MF4010_OK) {
|
||||
char err_code[32];
|
||||
len = snprintf(err_code, sizeof(err_code), "Motor2 command: %d\r\n", status);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)err_code, len, 50);
|
||||
}
|
||||
status = mf4010v2_send_command(&motor1, cmd, 1000);
|
||||
if (status != MF4010_OK) {
|
||||
char err_code[32];
|
||||
len = snprintf(err_code, sizeof(err_code), "Motor1 command: %d\r\n", status);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)err_code, len, 50);
|
||||
}
|
||||
for (;;) {
|
||||
osDelay(1);
|
||||
}
|
||||
|
||||
/* USER CODE END StartControlTask */
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN Header_StartSensorTask */
|
||||
/**
|
||||
* @brief Function implementing the sensorTask thread.
|
||||
* @param argument: Not used
|
||||
* @retval None
|
||||
*/
|
||||
/* USER CODE END Header_StartSensorTask */
|
||||
void StartSensorTask(void *argument)
|
||||
{
|
||||
/* USER CODE BEGIN StartSensorTask */
|
||||
argument = argument;
|
||||
// 初始化传感器
|
||||
WitRegisterCallBack(CopeSensorData);
|
||||
WitDelayMsRegister(J901P_Delay);
|
||||
J901P_HAL_Init(0x50);
|
||||
|
||||
WitReadReg(AX, 12);
|
||||
osDelay(100);
|
||||
|
||||
for(;;)
|
||||
{
|
||||
if(s_cDataUpdate)
|
||||
{
|
||||
WitReadReg(AX, 12);
|
||||
osDelay(50);
|
||||
|
||||
// 复制数据到共享结构
|
||||
for(int i=0; i<3; i++) {
|
||||
sensorData.acc[i] = sReg[AX+i];
|
||||
sensorData.gyro[i] = sReg[GX+i];
|
||||
sensorData.angle[i] = sReg[Roll+i];
|
||||
}
|
||||
sensorData.valid = 1; // 标记数据有效
|
||||
|
||||
s_cDataUpdate = 0;
|
||||
osDelay(200);
|
||||
}
|
||||
else
|
||||
{
|
||||
WitReadReg(AX, 12);
|
||||
osDelay(100);
|
||||
}
|
||||
}
|
||||
/* USER CODE END StartSensorTask */
|
||||
}
|
||||
|
||||
/* Private application code --------------------------------------------------*/
|
||||
/* USER CODE BEGIN Application */
|
||||
/* USER CODE END Application */
|
||||
|
||||
@@ -1,68 +0,0 @@
|
||||
/* USER CODE BEGIN Header */
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file gpio.c
|
||||
* @brief This file provides code for the configuration
|
||||
* of all used GPIO pins.
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2026 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 "gpio.h"
|
||||
|
||||
/* USER CODE BEGIN 0 */
|
||||
|
||||
/* USER CODE END 0 */
|
||||
|
||||
/*----------------------------------------------------------------------------*/
|
||||
/* Configure GPIO */
|
||||
/*----------------------------------------------------------------------------*/
|
||||
/* USER CODE BEGIN 1 */
|
||||
|
||||
/* USER CODE END 1 */
|
||||
|
||||
/** Configure pins as
|
||||
* Analog
|
||||
* Input
|
||||
* Output
|
||||
* EVENT_OUT
|
||||
* EXTI
|
||||
PD0 ------> CAN1_RX
|
||||
PD1 ------> CAN1_TX
|
||||
*/
|
||||
void MX_GPIO_Init(void)
|
||||
{
|
||||
|
||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
||||
|
||||
/* GPIO Ports Clock Enable */
|
||||
__HAL_RCC_GPIOF_CLK_ENABLE();
|
||||
__HAL_RCC_GPIOH_CLK_ENABLE();
|
||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
||||
__HAL_RCC_GPIOD_CLK_ENABLE();
|
||||
|
||||
/*Configure GPIO pins : PD0 PD1 */
|
||||
GPIO_InitStruct.Pin = GPIO_PIN_0|GPIO_PIN_1;
|
||||
GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
|
||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
||||
GPIO_InitStruct.Alternate = GPIO_AF9_CAN1;
|
||||
HAL_GPIO_Init(GPIOD, &GPIO_InitStruct);
|
||||
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN 2 */
|
||||
|
||||
/* USER CODE END 2 */
|
||||
@@ -1,122 +0,0 @@
|
||||
/* USER CODE BEGIN Header */
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file i2c.c
|
||||
* @brief This file provides code for the configuration
|
||||
* of the I2C instances.
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2026 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 "i2c.h"
|
||||
|
||||
/* USER CODE BEGIN 0 */
|
||||
|
||||
/* USER CODE END 0 */
|
||||
|
||||
I2C_HandleTypeDef hi2c2;
|
||||
|
||||
/* I2C2 init function */
|
||||
void MX_I2C2_Init(void)
|
||||
{
|
||||
|
||||
/* USER CODE BEGIN I2C2_Init 0 */
|
||||
|
||||
/* USER CODE END I2C2_Init 0 */
|
||||
|
||||
/* USER CODE BEGIN I2C2_Init 1 */
|
||||
|
||||
/* USER CODE END I2C2_Init 1 */
|
||||
hi2c2.Instance = I2C2;
|
||||
hi2c2.Init.ClockSpeed = 400000;
|
||||
hi2c2.Init.DutyCycle = I2C_DUTYCYCLE_2;
|
||||
hi2c2.Init.OwnAddress1 = 0;
|
||||
hi2c2.Init.AddressingMode = I2C_ADDRESSINGMODE_7BIT;
|
||||
hi2c2.Init.DualAddressMode = I2C_DUALADDRESS_DISABLE;
|
||||
hi2c2.Init.OwnAddress2 = 0;
|
||||
hi2c2.Init.GeneralCallMode = I2C_GENERALCALL_DISABLE;
|
||||
hi2c2.Init.NoStretchMode = I2C_NOSTRETCH_DISABLE;
|
||||
if (HAL_I2C_Init(&hi2c2) != HAL_OK)
|
||||
{
|
||||
Error_Handler();
|
||||
}
|
||||
/* USER CODE BEGIN I2C2_Init 2 */
|
||||
|
||||
/* USER CODE END I2C2_Init 2 */
|
||||
|
||||
}
|
||||
|
||||
void HAL_I2C_MspInit(I2C_HandleTypeDef* i2cHandle)
|
||||
{
|
||||
|
||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
||||
if(i2cHandle->Instance==I2C2)
|
||||
{
|
||||
/* USER CODE BEGIN I2C2_MspInit 0 */
|
||||
|
||||
/* USER CODE END I2C2_MspInit 0 */
|
||||
|
||||
__HAL_RCC_GPIOF_CLK_ENABLE();
|
||||
/**I2C2 GPIO Configuration
|
||||
PF0 ------> I2C2_SDA
|
||||
PF1 ------> I2C2_SCL
|
||||
*/
|
||||
GPIO_InitStruct.Pin = GPIO_PIN_0|GPIO_PIN_1;
|
||||
GPIO_InitStruct.Mode = GPIO_MODE_AF_OD;
|
||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
||||
GPIO_InitStruct.Alternate = GPIO_AF4_I2C2;
|
||||
HAL_GPIO_Init(GPIOF, &GPIO_InitStruct);
|
||||
|
||||
/* I2C2 clock enable */
|
||||
__HAL_RCC_I2C2_CLK_ENABLE();
|
||||
|
||||
/* I2C2 interrupt Init */
|
||||
HAL_NVIC_SetPriority(I2C2_EV_IRQn, 5, 0);
|
||||
HAL_NVIC_EnableIRQ(I2C2_EV_IRQn);
|
||||
/* USER CODE BEGIN I2C2_MspInit 1 */
|
||||
|
||||
/* USER CODE END I2C2_MspInit 1 */
|
||||
}
|
||||
}
|
||||
|
||||
void HAL_I2C_MspDeInit(I2C_HandleTypeDef* i2cHandle)
|
||||
{
|
||||
|
||||
if(i2cHandle->Instance==I2C2)
|
||||
{
|
||||
/* USER CODE BEGIN I2C2_MspDeInit 0 */
|
||||
|
||||
/* USER CODE END I2C2_MspDeInit 0 */
|
||||
/* Peripheral clock disable */
|
||||
__HAL_RCC_I2C2_CLK_DISABLE();
|
||||
|
||||
/**I2C2 GPIO Configuration
|
||||
PF0 ------> I2C2_SDA
|
||||
PF1 ------> I2C2_SCL
|
||||
*/
|
||||
HAL_GPIO_DeInit(GPIOF, GPIO_PIN_0);
|
||||
|
||||
HAL_GPIO_DeInit(GPIOF, GPIO_PIN_1);
|
||||
|
||||
/* I2C2 interrupt Deinit */
|
||||
HAL_NVIC_DisableIRQ(I2C2_EV_IRQn);
|
||||
/* USER CODE BEGIN I2C2_MspDeInit 1 */
|
||||
|
||||
/* USER CODE END I2C2_MspDeInit 1 */
|
||||
}
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN 1 */
|
||||
|
||||
/* USER CODE END 1 */
|
||||
@@ -1,249 +0,0 @@
|
||||
/* USER CODE BEGIN Header */
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file : main.c
|
||||
* @brief : Main program body
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2026 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 "cmsis_os.h"
|
||||
#include "can.h"
|
||||
#include "i2c.h"
|
||||
#include "usart.h"
|
||||
#include "gpio.h"
|
||||
|
||||
/* Private includes ----------------------------------------------------------*/
|
||||
/* USER CODE BEGIN Includes */
|
||||
#include "j901p.h"
|
||||
#include "j901p_hal.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 ---------------------------------------------------------*/
|
||||
|
||||
/* USER CODE BEGIN PV */
|
||||
volatile uint8_t s_cDataUpdate = 0;
|
||||
/* USER CODE END PV */
|
||||
|
||||
/* Private function prototypes -----------------------------------------------*/
|
||||
void SystemClock_Config(void);
|
||||
void MX_FREERTOS_Init(void);
|
||||
/* USER CODE BEGIN PFP */
|
||||
int __io_putchar(int ch)
|
||||
{
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)&ch, 1, 50);
|
||||
return ch;
|
||||
}
|
||||
/* USER CODE END PFP */
|
||||
|
||||
/* Private user code ---------------------------------------------------------*/
|
||||
/* USER CODE BEGIN 0 */
|
||||
|
||||
void CopeSensorData(uint32_t uiReg, uint32_t uiRegNum);
|
||||
|
||||
void CopeSensorData(uint32_t uiReg, uint32_t uiRegNum)
|
||||
{
|
||||
for(uint32_t i = 0; i < uiRegNum; i++)
|
||||
{
|
||||
switch(uiReg + i)
|
||||
{
|
||||
case AZ: s_cDataUpdate |= 0x01; break;
|
||||
case GZ: s_cDataUpdate |= 0x02; break;
|
||||
case Yaw: s_cDataUpdate |= 0x04; break;
|
||||
default: break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* 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_I2C2_Init();
|
||||
MX_USART1_UART_Init();
|
||||
MX_CAN1_Init();
|
||||
MX_CAN2_Init();
|
||||
/* USER CODE BEGIN 2 */
|
||||
|
||||
const uint8_t start_msg[] = "System starting...\r\n";
|
||||
HAL_UART_Transmit(&huart1, start_msg, sizeof(start_msg) - 1, 100);
|
||||
|
||||
/* USER CODE END 2 */
|
||||
|
||||
/* Init scheduler */
|
||||
osKernelInitialize();
|
||||
|
||||
/* Call init function for freertos objects (in cmsis_os2.c) */
|
||||
MX_FREERTOS_Init();
|
||||
|
||||
/* Start scheduler */
|
||||
osKernelStart();
|
||||
|
||||
/* We should never get here as control is now taken by the scheduler */
|
||||
|
||||
/* Infinite loop */
|
||||
/* USER CODE BEGIN WHILE */
|
||||
while (1)
|
||||
{
|
||||
/* 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};
|
||||
|
||||
/** Configure the main internal regulator output voltage
|
||||
*/
|
||||
__HAL_RCC_PWR_CLK_ENABLE();
|
||||
__HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE1);
|
||||
|
||||
/** 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.PLL.PLLState = RCC_PLL_ON;
|
||||
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
||||
RCC_OscInitStruct.PLL.PLLM = 4;
|
||||
RCC_OscInitStruct.PLL.PLLN = 168;
|
||||
RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV2;
|
||||
RCC_OscInitStruct.PLL.PLLQ = 4;
|
||||
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_DIV4;
|
||||
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV2;
|
||||
|
||||
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_5) != HAL_OK)
|
||||
{
|
||||
Error_Handler();
|
||||
}
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN 4 */
|
||||
|
||||
/* USER CODE END 4 */
|
||||
|
||||
/**
|
||||
* @brief Period elapsed callback in non blocking mode
|
||||
* @note This function is called when TIM1 interrupt took place, inside
|
||||
* HAL_TIM_IRQHandler(). It makes a direct call to HAL_IncTick() to increment
|
||||
* a global variable "uwTick" used as application time base.
|
||||
* @param htim : TIM handle
|
||||
* @retval None
|
||||
*/
|
||||
void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim)
|
||||
{
|
||||
/* USER CODE BEGIN Callback 0 */
|
||||
|
||||
/* USER CODE END Callback 0 */
|
||||
if (htim->Instance == TIM1)
|
||||
{
|
||||
HAL_IncTick();
|
||||
}
|
||||
/* USER CODE BEGIN Callback 1 */
|
||||
|
||||
/* USER CODE END Callback 1 */
|
||||
}
|
||||
|
||||
/**
|
||||
* @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,84 +0,0 @@
|
||||
/* USER CODE BEGIN Header */
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file stm32f4xx_hal_msp.c
|
||||
* @brief This file provides code for the MSP Initialization
|
||||
* and de-Initialization codes.
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2026 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"
|
||||
/* USER CODE BEGIN Includes */
|
||||
|
||||
/* USER CODE END Includes */
|
||||
|
||||
/* Private typedef -----------------------------------------------------------*/
|
||||
/* USER CODE BEGIN TD */
|
||||
|
||||
/* USER CODE END TD */
|
||||
|
||||
/* Private define ------------------------------------------------------------*/
|
||||
/* USER CODE BEGIN Define */
|
||||
|
||||
/* USER CODE END Define */
|
||||
|
||||
/* Private macro -------------------------------------------------------------*/
|
||||
/* USER CODE BEGIN Macro */
|
||||
|
||||
/* USER CODE END Macro */
|
||||
|
||||
/* Private variables ---------------------------------------------------------*/
|
||||
/* USER CODE BEGIN PV */
|
||||
|
||||
/* USER CODE END PV */
|
||||
|
||||
/* Private function prototypes -----------------------------------------------*/
|
||||
/* USER CODE BEGIN PFP */
|
||||
|
||||
/* USER CODE END PFP */
|
||||
|
||||
/* External functions --------------------------------------------------------*/
|
||||
/* USER CODE BEGIN ExternalFunctions */
|
||||
|
||||
/* USER CODE END ExternalFunctions */
|
||||
|
||||
/* USER CODE BEGIN 0 */
|
||||
|
||||
/* USER CODE END 0 */
|
||||
/**
|
||||
* Initializes the Global MSP.
|
||||
*/
|
||||
void HAL_MspInit(void)
|
||||
{
|
||||
|
||||
/* USER CODE BEGIN MspInit 0 */
|
||||
|
||||
/* USER CODE END MspInit 0 */
|
||||
|
||||
__HAL_RCC_SYSCFG_CLK_ENABLE();
|
||||
__HAL_RCC_PWR_CLK_ENABLE();
|
||||
|
||||
/* System interrupt init*/
|
||||
/* PendSV_IRQn interrupt configuration */
|
||||
HAL_NVIC_SetPriority(PendSV_IRQn, 15, 0);
|
||||
|
||||
/* USER CODE BEGIN MspInit 1 */
|
||||
|
||||
/* USER CODE END MspInit 1 */
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN 1 */
|
||||
|
||||
/* USER CODE END 1 */
|
||||
@@ -1,128 +0,0 @@
|
||||
/* USER CODE BEGIN Header */
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file stm32f4xx_hal_timebase_tim.c
|
||||
* @brief HAL time base based on the hardware TIM.
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2026 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 "stm32f4xx_hal.h"
|
||||
#include "stm32f4xx_hal_tim.h"
|
||||
|
||||
/* Private typedef -----------------------------------------------------------*/
|
||||
/* Private define ------------------------------------------------------------*/
|
||||
/* Private macro -------------------------------------------------------------*/
|
||||
/* Private variables ---------------------------------------------------------*/
|
||||
TIM_HandleTypeDef htim1;
|
||||
/* Private function prototypes -----------------------------------------------*/
|
||||
/* Private functions ---------------------------------------------------------*/
|
||||
|
||||
/**
|
||||
* @brief This function configures the TIM1 as a time base source.
|
||||
* The time source is configured to have 1ms time base with a dedicated
|
||||
* Tick interrupt priority.
|
||||
* @note This function is called automatically at the beginning of program after
|
||||
* reset by HAL_Init() or at any time when clock is configured, by HAL_RCC_ClockConfig().
|
||||
* @param TickPriority: Tick interrupt priority.
|
||||
* @retval HAL status
|
||||
*/
|
||||
HAL_StatusTypeDef HAL_InitTick(uint32_t TickPriority)
|
||||
{
|
||||
RCC_ClkInitTypeDef clkconfig;
|
||||
uint32_t uwTimclock = 0U;
|
||||
|
||||
uint32_t uwPrescalerValue = 0U;
|
||||
uint32_t pFLatency;
|
||||
|
||||
HAL_StatusTypeDef status;
|
||||
|
||||
/* Enable TIM1 clock */
|
||||
__HAL_RCC_TIM1_CLK_ENABLE();
|
||||
|
||||
/* Get clock configuration */
|
||||
HAL_RCC_GetClockConfig(&clkconfig, &pFLatency);
|
||||
|
||||
/* Compute TIM1 clock */
|
||||
uwTimclock = 2*HAL_RCC_GetPCLK2Freq();
|
||||
|
||||
/* Compute the prescaler value to have TIM1 counter clock equal to 1MHz */
|
||||
uwPrescalerValue = (uint32_t) ((uwTimclock / 1000000U) - 1U);
|
||||
|
||||
/* Initialize TIM1 */
|
||||
htim1.Instance = TIM1;
|
||||
|
||||
/* Initialize TIMx peripheral as follow:
|
||||
* Period = [(TIM1CLK/1000) - 1]. to have a (1/1000) s time base.
|
||||
* Prescaler = (uwTimclock/1000000 - 1) to have a 1MHz counter clock.
|
||||
* ClockDivision = 0
|
||||
* Counter direction = Up
|
||||
*/
|
||||
htim1.Init.Period = (1000000U / 1000U) - 1U;
|
||||
htim1.Init.Prescaler = uwPrescalerValue;
|
||||
htim1.Init.ClockDivision = 0;
|
||||
htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
|
||||
htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
||||
|
||||
status = HAL_TIM_Base_Init(&htim1);
|
||||
if (status == HAL_OK)
|
||||
{
|
||||
/* Start the TIM time Base generation in interrupt mode */
|
||||
status = HAL_TIM_Base_Start_IT(&htim1);
|
||||
if (status == HAL_OK)
|
||||
{
|
||||
/* Enable the TIM1 global Interrupt */
|
||||
HAL_NVIC_EnableIRQ(TIM1_UP_TIM10_IRQn);
|
||||
/* Configure the SysTick IRQ priority */
|
||||
if (TickPriority < (1UL << __NVIC_PRIO_BITS))
|
||||
{
|
||||
/* Configure the TIM IRQ priority */
|
||||
HAL_NVIC_SetPriority(TIM1_UP_TIM10_IRQn, TickPriority, 0U);
|
||||
uwTickPrio = TickPriority;
|
||||
}
|
||||
else
|
||||
{
|
||||
status = HAL_ERROR;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* Return function status */
|
||||
return status;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Suspend Tick increment.
|
||||
* @note Disable the tick increment by disabling TIM1 update interrupt.
|
||||
* @param None
|
||||
* @retval None
|
||||
*/
|
||||
void HAL_SuspendTick(void)
|
||||
{
|
||||
/* Disable TIM1 update Interrupt */
|
||||
__HAL_TIM_DISABLE_IT(&htim1, TIM_IT_UPDATE);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Resume Tick increment.
|
||||
* @note Enable the tick increment by Enabling TIM1 update interrupt.
|
||||
* @param None
|
||||
* @retval None
|
||||
*/
|
||||
void HAL_ResumeTick(void)
|
||||
{
|
||||
/* Enable TIM1 Update interrupt */
|
||||
__HAL_TIM_ENABLE_IT(&htim1, TIM_IT_UPDATE);
|
||||
}
|
||||
|
||||
@@ -1,193 +0,0 @@
|
||||
/* USER CODE BEGIN Header */
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file stm32f4xx_it.c
|
||||
* @brief Interrupt Service Routines.
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2026 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 "stm32f4xx_it.h"
|
||||
/* Private includes ----------------------------------------------------------*/
|
||||
/* USER CODE BEGIN Includes */
|
||||
/* USER CODE END Includes */
|
||||
|
||||
/* Private typedef -----------------------------------------------------------*/
|
||||
/* USER CODE BEGIN TD */
|
||||
|
||||
/* USER CODE END TD */
|
||||
|
||||
/* Private define ------------------------------------------------------------*/
|
||||
/* USER CODE BEGIN PD */
|
||||
|
||||
/* USER CODE END PD */
|
||||
|
||||
/* Private macro -------------------------------------------------------------*/
|
||||
/* USER CODE BEGIN PM */
|
||||
|
||||
/* USER CODE END PM */
|
||||
|
||||
/* Private variables ---------------------------------------------------------*/
|
||||
/* USER CODE BEGIN PV */
|
||||
|
||||
/* USER CODE END PV */
|
||||
|
||||
/* Private function prototypes -----------------------------------------------*/
|
||||
/* USER CODE BEGIN PFP */
|
||||
|
||||
/* USER CODE END PFP */
|
||||
|
||||
/* Private user code ---------------------------------------------------------*/
|
||||
/* USER CODE BEGIN 0 */
|
||||
|
||||
/* USER CODE END 0 */
|
||||
|
||||
/* External variables --------------------------------------------------------*/
|
||||
extern I2C_HandleTypeDef hi2c2;
|
||||
extern TIM_HandleTypeDef htim1;
|
||||
|
||||
/* USER CODE BEGIN EV */
|
||||
|
||||
/* USER CODE END EV */
|
||||
|
||||
/******************************************************************************/
|
||||
/* Cortex-M4 Processor Interruption and Exception Handlers */
|
||||
/******************************************************************************/
|
||||
/**
|
||||
* @brief This function handles Non maskable interrupt.
|
||||
*/
|
||||
void NMI_Handler(void)
|
||||
{
|
||||
/* USER CODE BEGIN NonMaskableInt_IRQn 0 */
|
||||
|
||||
/* USER CODE END NonMaskableInt_IRQn 0 */
|
||||
/* USER CODE BEGIN NonMaskableInt_IRQn 1 */
|
||||
while (1)
|
||||
{
|
||||
}
|
||||
/* USER CODE END NonMaskableInt_IRQn 1 */
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles Hard fault interrupt.
|
||||
*/
|
||||
void HardFault_Handler(void)
|
||||
{
|
||||
/* USER CODE BEGIN HardFault_IRQn 0 */
|
||||
|
||||
/* USER CODE END HardFault_IRQn 0 */
|
||||
while (1)
|
||||
{
|
||||
/* USER CODE BEGIN W1_HardFault_IRQn 0 */
|
||||
/* USER CODE END W1_HardFault_IRQn 0 */
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles Memory management fault.
|
||||
*/
|
||||
void MemManage_Handler(void)
|
||||
{
|
||||
/* USER CODE BEGIN MemoryManagement_IRQn 0 */
|
||||
|
||||
/* USER CODE END MemoryManagement_IRQn 0 */
|
||||
while (1)
|
||||
{
|
||||
/* USER CODE BEGIN W1_MemoryManagement_IRQn 0 */
|
||||
/* USER CODE END W1_MemoryManagement_IRQn 0 */
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles Pre-fetch fault, memory access fault.
|
||||
*/
|
||||
void BusFault_Handler(void)
|
||||
{
|
||||
/* USER CODE BEGIN BusFault_IRQn 0 */
|
||||
|
||||
/* USER CODE END BusFault_IRQn 0 */
|
||||
while (1)
|
||||
{
|
||||
/* USER CODE BEGIN W1_BusFault_IRQn 0 */
|
||||
/* USER CODE END W1_BusFault_IRQn 0 */
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles Undefined instruction or illegal state.
|
||||
*/
|
||||
void UsageFault_Handler(void)
|
||||
{
|
||||
/* USER CODE BEGIN UsageFault_IRQn 0 */
|
||||
|
||||
/* USER CODE END UsageFault_IRQn 0 */
|
||||
while (1)
|
||||
{
|
||||
/* USER CODE BEGIN W1_UsageFault_IRQn 0 */
|
||||
/* USER CODE END W1_UsageFault_IRQn 0 */
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles Debug monitor.
|
||||
*/
|
||||
void DebugMon_Handler(void)
|
||||
{
|
||||
/* USER CODE BEGIN DebugMonitor_IRQn 0 */
|
||||
|
||||
/* USER CODE END DebugMonitor_IRQn 0 */
|
||||
/* USER CODE BEGIN DebugMonitor_IRQn 1 */
|
||||
|
||||
/* USER CODE END DebugMonitor_IRQn 1 */
|
||||
}
|
||||
|
||||
/******************************************************************************/
|
||||
/* STM32F4xx Peripheral Interrupt Handlers */
|
||||
/* Add here the Interrupt Handlers for the used peripherals. */
|
||||
/* For the available peripheral interrupt handler names, */
|
||||
/* please refer to the startup file (startup_stm32f4xx.s). */
|
||||
/******************************************************************************/
|
||||
|
||||
/**
|
||||
* @brief This function handles TIM1 update interrupt and TIM10 global interrupt.
|
||||
*/
|
||||
void TIM1_UP_TIM10_IRQHandler(void)
|
||||
{
|
||||
/* USER CODE BEGIN TIM1_UP_TIM10_IRQn 0 */
|
||||
|
||||
/* USER CODE END TIM1_UP_TIM10_IRQn 0 */
|
||||
HAL_TIM_IRQHandler(&htim1);
|
||||
/* USER CODE BEGIN TIM1_UP_TIM10_IRQn 1 */
|
||||
|
||||
/* USER CODE END TIM1_UP_TIM10_IRQn 1 */
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles I2C2 event interrupt.
|
||||
*/
|
||||
void I2C2_EV_IRQHandler(void)
|
||||
{
|
||||
/* USER CODE BEGIN I2C2_EV_IRQn 0 */
|
||||
|
||||
/* USER CODE END I2C2_EV_IRQn 0 */
|
||||
HAL_I2C_EV_IRQHandler(&hi2c2);
|
||||
/* USER CODE BEGIN I2C2_EV_IRQn 1 */
|
||||
|
||||
/* USER CODE END I2C2_EV_IRQn 1 */
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN 1 */
|
||||
|
||||
/* USER CODE END 1 */
|
||||
@@ -1,176 +0,0 @@
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file syscalls.c
|
||||
* @author Auto-generated by STM32CubeMX
|
||||
* @brief Minimal System calls file
|
||||
*
|
||||
* For more information about which c-functions
|
||||
* need which of these lowlevel functions
|
||||
* please consult the Newlib libc-manual
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2020-2024 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.
|
||||
*
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
/* Includes */
|
||||
#include <sys/stat.h>
|
||||
#include <stdlib.h>
|
||||
#include <errno.h>
|
||||
#include <stdio.h>
|
||||
#include <signal.h>
|
||||
#include <time.h>
|
||||
#include <sys/time.h>
|
||||
#include <sys/times.h>
|
||||
|
||||
|
||||
/* Variables */
|
||||
extern int __io_putchar(int ch) __attribute__((weak));
|
||||
extern int __io_getchar(void) __attribute__((weak));
|
||||
|
||||
|
||||
char *__env[1] = { 0 };
|
||||
char **environ = __env;
|
||||
|
||||
|
||||
/* Functions */
|
||||
void initialise_monitor_handles()
|
||||
{
|
||||
}
|
||||
|
||||
int _getpid(void)
|
||||
{
|
||||
return 1;
|
||||
}
|
||||
|
||||
int _kill(int pid, int sig)
|
||||
{
|
||||
(void)pid;
|
||||
(void)sig;
|
||||
errno = EINVAL;
|
||||
return -1;
|
||||
}
|
||||
|
||||
void _exit (int status)
|
||||
{
|
||||
_kill(status, -1);
|
||||
while (1) {} /* Make sure we hang here */
|
||||
}
|
||||
|
||||
__attribute__((weak)) int _read(int file, char *ptr, int len)
|
||||
{
|
||||
(void)file;
|
||||
int DataIdx;
|
||||
|
||||
for (DataIdx = 0; DataIdx < len; DataIdx++)
|
||||
{
|
||||
*ptr++ = __io_getchar();
|
||||
}
|
||||
|
||||
return len;
|
||||
}
|
||||
|
||||
__attribute__((weak)) int _write(int file, char *ptr, int len)
|
||||
{
|
||||
(void)file;
|
||||
int DataIdx;
|
||||
|
||||
for (DataIdx = 0; DataIdx < len; DataIdx++)
|
||||
{
|
||||
__io_putchar(*ptr++);
|
||||
}
|
||||
return len;
|
||||
}
|
||||
|
||||
int _close(int file)
|
||||
{
|
||||
(void)file;
|
||||
return -1;
|
||||
}
|
||||
|
||||
|
||||
int _fstat(int file, struct stat *st)
|
||||
{
|
||||
(void)file;
|
||||
st->st_mode = S_IFCHR;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int _isatty(int file)
|
||||
{
|
||||
(void)file;
|
||||
return 1;
|
||||
}
|
||||
|
||||
int _lseek(int file, int ptr, int dir)
|
||||
{
|
||||
(void)file;
|
||||
(void)ptr;
|
||||
(void)dir;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int _open(char *path, int flags, ...)
|
||||
{
|
||||
(void)path;
|
||||
(void)flags;
|
||||
/* Pretend like we always fail */
|
||||
return -1;
|
||||
}
|
||||
|
||||
int _wait(int *status)
|
||||
{
|
||||
(void)status;
|
||||
errno = ECHILD;
|
||||
return -1;
|
||||
}
|
||||
|
||||
int _unlink(char *name)
|
||||
{
|
||||
(void)name;
|
||||
errno = ENOENT;
|
||||
return -1;
|
||||
}
|
||||
|
||||
int _times(struct tms *buf)
|
||||
{
|
||||
(void)buf;
|
||||
return -1;
|
||||
}
|
||||
|
||||
int _stat(char *file, struct stat *st)
|
||||
{
|
||||
(void)file;
|
||||
st->st_mode = S_IFCHR;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int _link(char *old, char *new)
|
||||
{
|
||||
(void)old;
|
||||
(void)new;
|
||||
errno = EMLINK;
|
||||
return -1;
|
||||
}
|
||||
|
||||
int _fork(void)
|
||||
{
|
||||
errno = EAGAIN;
|
||||
return -1;
|
||||
}
|
||||
|
||||
int _execve(char *name, char **argv, char **env)
|
||||
{
|
||||
(void)name;
|
||||
(void)argv;
|
||||
(void)env;
|
||||
errno = ENOMEM;
|
||||
return -1;
|
||||
}
|
||||
@@ -1,79 +0,0 @@
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file sysmem.c
|
||||
* @author Generated by STM32CubeMX
|
||||
* @brief System Memory calls file
|
||||
*
|
||||
* For more information about which C functions
|
||||
* need which of these lowlevel functions
|
||||
* please consult the newlib libc manual
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2024 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.
|
||||
*
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
/* Includes */
|
||||
#include <errno.h>
|
||||
#include <stdint.h>
|
||||
|
||||
/**
|
||||
* Pointer to the current high watermark of the heap usage
|
||||
*/
|
||||
static uint8_t *__sbrk_heap_end = NULL;
|
||||
|
||||
/**
|
||||
* @brief _sbrk() allocates memory to the newlib heap and is used by malloc
|
||||
* and others from the C library
|
||||
*
|
||||
* @verbatim
|
||||
* ############################################################################
|
||||
* # .data # .bss # newlib heap # MSP stack #
|
||||
* # # # # Reserved by _Min_Stack_Size #
|
||||
* ############################################################################
|
||||
* ^-- RAM start ^-- _end _estack, RAM end --^
|
||||
* @endverbatim
|
||||
*
|
||||
* This implementation starts allocating at the '_end' linker symbol
|
||||
* The '_Min_Stack_Size' linker symbol reserves a memory for the MSP stack
|
||||
* The implementation considers '_estack' linker symbol to be RAM end
|
||||
* NOTE: If the MSP stack, at any point during execution, grows larger than the
|
||||
* reserved size, please increase the '_Min_Stack_Size'.
|
||||
*
|
||||
* @param incr Memory size
|
||||
* @return Pointer to allocated memory
|
||||
*/
|
||||
void *_sbrk(ptrdiff_t incr)
|
||||
{
|
||||
extern uint8_t _end; /* Symbol defined in the linker script */
|
||||
extern uint8_t _estack; /* Symbol defined in the linker script */
|
||||
extern uint32_t _Min_Stack_Size; /* Symbol defined in the linker script */
|
||||
const uint32_t stack_limit = (uint32_t)&_estack - (uint32_t)&_Min_Stack_Size;
|
||||
const uint8_t *max_heap = (uint8_t *)stack_limit;
|
||||
uint8_t *prev_heap_end;
|
||||
|
||||
/* Initialize heap end at first call */
|
||||
if (NULL == __sbrk_heap_end)
|
||||
{
|
||||
__sbrk_heap_end = &_end;
|
||||
}
|
||||
|
||||
/* Protect heap from growing into the reserved MSP stack */
|
||||
if (__sbrk_heap_end + incr > max_heap)
|
||||
{
|
||||
errno = ENOMEM;
|
||||
return (void *)-1;
|
||||
}
|
||||
|
||||
prev_heap_end = __sbrk_heap_end;
|
||||
__sbrk_heap_end += incr;
|
||||
|
||||
return (void *)prev_heap_end;
|
||||
}
|
||||
@@ -1,747 +0,0 @@
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file system_stm32f4xx.c
|
||||
* @author MCD Application Team
|
||||
* @brief CMSIS Cortex-M4 Device Peripheral Access Layer System Source File.
|
||||
*
|
||||
* This file provides two functions and one global variable to be called from
|
||||
* user application:
|
||||
* - SystemInit(): This function is called at startup just after reset and
|
||||
* before branch to main program. This call is made inside
|
||||
* the "startup_stm32f4xx.s" file.
|
||||
*
|
||||
* - SystemCoreClock variable: Contains the core clock (HCLK), it can be used
|
||||
* by the user application to setup the SysTick
|
||||
* timer or configure other parameters.
|
||||
*
|
||||
* - SystemCoreClockUpdate(): Updates the variable SystemCoreClock and must
|
||||
* be called whenever the core clock is changed
|
||||
* during program execution.
|
||||
*
|
||||
*
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2017 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.
|
||||
*
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
/** @addtogroup CMSIS
|
||||
* @{
|
||||
*/
|
||||
|
||||
/** @addtogroup stm32f4xx_system
|
||||
* @{
|
||||
*/
|
||||
|
||||
/** @addtogroup STM32F4xx_System_Private_Includes
|
||||
* @{
|
||||
*/
|
||||
|
||||
|
||||
#include "stm32f4xx.h"
|
||||
|
||||
#if !defined (HSE_VALUE)
|
||||
#define HSE_VALUE ((uint32_t)25000000) /*!< Default value of the External oscillator in Hz */
|
||||
#endif /* HSE_VALUE */
|
||||
|
||||
#if !defined (HSI_VALUE)
|
||||
#define HSI_VALUE ((uint32_t)16000000) /*!< Value of the Internal oscillator in Hz*/
|
||||
#endif /* HSI_VALUE */
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/** @addtogroup STM32F4xx_System_Private_TypesDefinitions
|
||||
* @{
|
||||
*/
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/** @addtogroup STM32F4xx_System_Private_Defines
|
||||
* @{
|
||||
*/
|
||||
|
||||
/************************* Miscellaneous Configuration ************************/
|
||||
/*!< Uncomment the following line if you need to use external SRAM or SDRAM as data memory */
|
||||
#if defined(STM32F405xx) || defined(STM32F415xx) || defined(STM32F407xx) || defined(STM32F417xx)\
|
||||
|| defined(STM32F427xx) || defined(STM32F437xx) || defined(STM32F429xx) || defined(STM32F439xx)\
|
||||
|| defined(STM32F469xx) || defined(STM32F479xx) || defined(STM32F412Zx) || defined(STM32F412Vx)
|
||||
/* #define DATA_IN_ExtSRAM */
|
||||
#endif /* STM32F40xxx || STM32F41xxx || STM32F42xxx || STM32F43xxx || STM32F469xx || STM32F479xx ||\
|
||||
STM32F412Zx || STM32F412Vx */
|
||||
|
||||
#if defined(STM32F427xx) || defined(STM32F437xx) || defined(STM32F429xx) || defined(STM32F439xx)\
|
||||
|| defined(STM32F446xx) || defined(STM32F469xx) || defined(STM32F479xx)
|
||||
/* #define DATA_IN_ExtSDRAM */
|
||||
#endif /* STM32F427xx || STM32F437xx || STM32F429xx || STM32F439xx || STM32F446xx || STM32F469xx ||\
|
||||
STM32F479xx */
|
||||
|
||||
/* Note: Following vector table addresses must be defined in line with linker
|
||||
configuration. */
|
||||
/*!< Uncomment the following line if you need to relocate the vector table
|
||||
anywhere in Flash or Sram, else the vector table is kept at the automatic
|
||||
remap of boot address selected */
|
||||
/* #define USER_VECT_TAB_ADDRESS */
|
||||
|
||||
#if defined(USER_VECT_TAB_ADDRESS)
|
||||
/*!< Uncomment the following line if you need to relocate your vector Table
|
||||
in Sram else user remap will be done in Flash. */
|
||||
/* #define VECT_TAB_SRAM */
|
||||
#if defined(VECT_TAB_SRAM)
|
||||
#define VECT_TAB_BASE_ADDRESS SRAM_BASE /*!< Vector Table base address field.
|
||||
This value must be a multiple of 0x200. */
|
||||
#else
|
||||
#define VECT_TAB_BASE_ADDRESS FLASH_BASE /*!< Vector Table base address field.
|
||||
This value must be a multiple of 0x200. */
|
||||
#endif /* VECT_TAB_SRAM */
|
||||
#if !defined(VECT_TAB_OFFSET)
|
||||
#define VECT_TAB_OFFSET 0x00000000U /*!< Vector Table offset field.
|
||||
This value must be a multiple of 0x200. */
|
||||
#endif /* VECT_TAB_OFFSET */
|
||||
#endif /* USER_VECT_TAB_ADDRESS */
|
||||
/******************************************************************************/
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/** @addtogroup STM32F4xx_System_Private_Macros
|
||||
* @{
|
||||
*/
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/** @addtogroup STM32F4xx_System_Private_Variables
|
||||
* @{
|
||||
*/
|
||||
/* This variable is updated in three ways:
|
||||
1) by calling CMSIS function SystemCoreClockUpdate()
|
||||
2) by calling HAL API function HAL_RCC_GetHCLKFreq()
|
||||
3) each time HAL_RCC_ClockConfig() is called to configure the system clock frequency
|
||||
Note: If you use this function to configure the system clock; then there
|
||||
is no need to call the 2 first functions listed above, since SystemCoreClock
|
||||
variable is updated automatically.
|
||||
*/
|
||||
uint32_t SystemCoreClock = 16000000;
|
||||
const uint8_t AHBPrescTable[16] = {0, 0, 0, 0, 0, 0, 0, 0, 1, 2, 3, 4, 6, 7, 8, 9};
|
||||
const uint8_t APBPrescTable[8] = {0, 0, 0, 0, 1, 2, 3, 4};
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/** @addtogroup STM32F4xx_System_Private_FunctionPrototypes
|
||||
* @{
|
||||
*/
|
||||
|
||||
#if defined (DATA_IN_ExtSRAM) || defined (DATA_IN_ExtSDRAM)
|
||||
static void SystemInit_ExtMemCtl(void);
|
||||
#endif /* DATA_IN_ExtSRAM || DATA_IN_ExtSDRAM */
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/** @addtogroup STM32F4xx_System_Private_Functions
|
||||
* @{
|
||||
*/
|
||||
|
||||
/**
|
||||
* @brief Setup the microcontroller system
|
||||
* Initialize the FPU setting, vector table location and External memory
|
||||
* configuration.
|
||||
* @param None
|
||||
* @retval None
|
||||
*/
|
||||
void SystemInit(void)
|
||||
{
|
||||
/* FPU settings ------------------------------------------------------------*/
|
||||
#if (__FPU_PRESENT == 1) && (__FPU_USED == 1)
|
||||
SCB->CPACR |= ((3UL << 10*2)|(3UL << 11*2)); /* set CP10 and CP11 Full Access */
|
||||
#endif
|
||||
|
||||
#if defined (DATA_IN_ExtSRAM) || defined (DATA_IN_ExtSDRAM)
|
||||
SystemInit_ExtMemCtl();
|
||||
#endif /* DATA_IN_ExtSRAM || DATA_IN_ExtSDRAM */
|
||||
|
||||
/* Configure the Vector Table location -------------------------------------*/
|
||||
#if defined(USER_VECT_TAB_ADDRESS)
|
||||
SCB->VTOR = VECT_TAB_BASE_ADDRESS | VECT_TAB_OFFSET; /* Vector Table Relocation in Internal SRAM */
|
||||
#endif /* USER_VECT_TAB_ADDRESS */
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Update SystemCoreClock variable according to Clock Register Values.
|
||||
* The SystemCoreClock variable contains the core clock (HCLK), it can
|
||||
* be used by the user application to setup the SysTick timer or configure
|
||||
* other parameters.
|
||||
*
|
||||
* @note Each time the core clock (HCLK) changes, this function must be called
|
||||
* to update SystemCoreClock variable value. Otherwise, any configuration
|
||||
* based on this variable will be incorrect.
|
||||
*
|
||||
* @note - The system frequency computed by this function is not the real
|
||||
* frequency in the chip. It is calculated based on the predefined
|
||||
* constant and the selected clock source:
|
||||
*
|
||||
* - If SYSCLK source is HSI, SystemCoreClock will contain the HSI_VALUE(*)
|
||||
*
|
||||
* - If SYSCLK source is HSE, SystemCoreClock will contain the HSE_VALUE(**)
|
||||
*
|
||||
* - If SYSCLK source is PLL, SystemCoreClock will contain the HSE_VALUE(**)
|
||||
* or HSI_VALUE(*) multiplied/divided by the PLL factors.
|
||||
*
|
||||
* (*) HSI_VALUE is a constant defined in stm32f4xx_hal_conf.h file (default value
|
||||
* 16 MHz) but the real value may vary depending on the variations
|
||||
* in voltage and temperature.
|
||||
*
|
||||
* (**) HSE_VALUE is a constant defined in stm32f4xx_hal_conf.h file (its value
|
||||
* depends on the application requirements), user has to ensure that HSE_VALUE
|
||||
* is same as the real frequency of the crystal used. Otherwise, this function
|
||||
* may have wrong result.
|
||||
*
|
||||
* - The result of this function could be not correct when using fractional
|
||||
* value for HSE crystal.
|
||||
*
|
||||
* @param None
|
||||
* @retval None
|
||||
*/
|
||||
void SystemCoreClockUpdate(void)
|
||||
{
|
||||
uint32_t tmp, pllvco, pllp, pllsource, pllm;
|
||||
|
||||
/* Get SYSCLK source -------------------------------------------------------*/
|
||||
tmp = RCC->CFGR & RCC_CFGR_SWS;
|
||||
|
||||
switch (tmp)
|
||||
{
|
||||
case 0x00: /* HSI used as system clock source */
|
||||
SystemCoreClock = HSI_VALUE;
|
||||
break;
|
||||
case 0x04: /* HSE used as system clock source */
|
||||
SystemCoreClock = HSE_VALUE;
|
||||
break;
|
||||
case 0x08: /* PLL used as system clock source */
|
||||
|
||||
/* PLL_VCO = (HSE_VALUE or HSI_VALUE / PLL_M) * PLL_N
|
||||
SYSCLK = PLL_VCO / PLL_P
|
||||
*/
|
||||
pllsource = (RCC->PLLCFGR & RCC_PLLCFGR_PLLSRC) >> 22;
|
||||
pllm = RCC->PLLCFGR & RCC_PLLCFGR_PLLM;
|
||||
|
||||
if (pllsource != 0)
|
||||
{
|
||||
/* HSE used as PLL clock source */
|
||||
pllvco = (HSE_VALUE / pllm) * ((RCC->PLLCFGR & RCC_PLLCFGR_PLLN) >> 6);
|
||||
}
|
||||
else
|
||||
{
|
||||
/* HSI used as PLL clock source */
|
||||
pllvco = (HSI_VALUE / pllm) * ((RCC->PLLCFGR & RCC_PLLCFGR_PLLN) >> 6);
|
||||
}
|
||||
|
||||
pllp = (((RCC->PLLCFGR & RCC_PLLCFGR_PLLP) >>16) + 1 ) *2;
|
||||
SystemCoreClock = pllvco/pllp;
|
||||
break;
|
||||
default:
|
||||
SystemCoreClock = HSI_VALUE;
|
||||
break;
|
||||
}
|
||||
/* Compute HCLK frequency --------------------------------------------------*/
|
||||
/* Get HCLK prescaler */
|
||||
tmp = AHBPrescTable[((RCC->CFGR & RCC_CFGR_HPRE) >> 4)];
|
||||
/* HCLK frequency */
|
||||
SystemCoreClock >>= tmp;
|
||||
}
|
||||
|
||||
#if defined (DATA_IN_ExtSRAM) && defined (DATA_IN_ExtSDRAM)
|
||||
#if defined(STM32F427xx) || defined(STM32F437xx) || defined(STM32F429xx) || defined(STM32F439xx)\
|
||||
|| defined(STM32F469xx) || defined(STM32F479xx)
|
||||
/**
|
||||
* @brief Setup the external memory controller.
|
||||
* Called in startup_stm32f4xx.s before jump to main.
|
||||
* This function configures the external memories (SRAM/SDRAM)
|
||||
* This SRAM/SDRAM will be used as program data memory (including heap and stack).
|
||||
* @param None
|
||||
* @retval None
|
||||
*/
|
||||
void SystemInit_ExtMemCtl(void)
|
||||
{
|
||||
__IO uint32_t tmp = 0x00;
|
||||
|
||||
register uint32_t tmpreg = 0, timeout = 0xFFFF;
|
||||
register __IO uint32_t index;
|
||||
|
||||
/* Enable GPIOC, GPIOD, GPIOE, GPIOF, GPIOG, GPIOH and GPIOI interface clock */
|
||||
RCC->AHB1ENR |= 0x000001F8;
|
||||
|
||||
/* Delay after an RCC peripheral clock enabling */
|
||||
tmp = READ_BIT(RCC->AHB1ENR, RCC_AHB1ENR_GPIOCEN);
|
||||
|
||||
/* Connect PDx pins to FMC Alternate function */
|
||||
GPIOD->AFR[0] = 0x00CCC0CC;
|
||||
GPIOD->AFR[1] = 0xCCCCCCCC;
|
||||
/* Configure PDx pins in Alternate function mode */
|
||||
GPIOD->MODER = 0xAAAA0A8A;
|
||||
/* Configure PDx pins speed to 100 MHz */
|
||||
GPIOD->OSPEEDR = 0xFFFF0FCF;
|
||||
/* Configure PDx pins Output type to push-pull */
|
||||
GPIOD->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PDx pins */
|
||||
GPIOD->PUPDR = 0x00000000;
|
||||
|
||||
/* Connect PEx pins to FMC Alternate function */
|
||||
GPIOE->AFR[0] = 0xC00CC0CC;
|
||||
GPIOE->AFR[1] = 0xCCCCCCCC;
|
||||
/* Configure PEx pins in Alternate function mode */
|
||||
GPIOE->MODER = 0xAAAA828A;
|
||||
/* Configure PEx pins speed to 100 MHz */
|
||||
GPIOE->OSPEEDR = 0xFFFFC3CF;
|
||||
/* Configure PEx pins Output type to push-pull */
|
||||
GPIOE->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PEx pins */
|
||||
GPIOE->PUPDR = 0x00000000;
|
||||
|
||||
/* Connect PFx pins to FMC Alternate function */
|
||||
GPIOF->AFR[0] = 0xCCCCCCCC;
|
||||
GPIOF->AFR[1] = 0xCCCCCCCC;
|
||||
/* Configure PFx pins in Alternate function mode */
|
||||
GPIOF->MODER = 0xAA800AAA;
|
||||
/* Configure PFx pins speed to 50 MHz */
|
||||
GPIOF->OSPEEDR = 0xAA800AAA;
|
||||
/* Configure PFx pins Output type to push-pull */
|
||||
GPIOF->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PFx pins */
|
||||
GPIOF->PUPDR = 0x00000000;
|
||||
|
||||
/* Connect PGx pins to FMC Alternate function */
|
||||
GPIOG->AFR[0] = 0xCCCCCCCC;
|
||||
GPIOG->AFR[1] = 0xCCCCCCCC;
|
||||
/* Configure PGx pins in Alternate function mode */
|
||||
GPIOG->MODER = 0xAAAAAAAA;
|
||||
/* Configure PGx pins speed to 50 MHz */
|
||||
GPIOG->OSPEEDR = 0xAAAAAAAA;
|
||||
/* Configure PGx pins Output type to push-pull */
|
||||
GPIOG->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PGx pins */
|
||||
GPIOG->PUPDR = 0x00000000;
|
||||
|
||||
/* Connect PHx pins to FMC Alternate function */
|
||||
GPIOH->AFR[0] = 0x00C0CC00;
|
||||
GPIOH->AFR[1] = 0xCCCCCCCC;
|
||||
/* Configure PHx pins in Alternate function mode */
|
||||
GPIOH->MODER = 0xAAAA08A0;
|
||||
/* Configure PHx pins speed to 50 MHz */
|
||||
GPIOH->OSPEEDR = 0xAAAA08A0;
|
||||
/* Configure PHx pins Output type to push-pull */
|
||||
GPIOH->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PHx pins */
|
||||
GPIOH->PUPDR = 0x00000000;
|
||||
|
||||
/* Connect PIx pins to FMC Alternate function */
|
||||
GPIOI->AFR[0] = 0xCCCCCCCC;
|
||||
GPIOI->AFR[1] = 0x00000CC0;
|
||||
/* Configure PIx pins in Alternate function mode */
|
||||
GPIOI->MODER = 0x0028AAAA;
|
||||
/* Configure PIx pins speed to 50 MHz */
|
||||
GPIOI->OSPEEDR = 0x0028AAAA;
|
||||
/* Configure PIx pins Output type to push-pull */
|
||||
GPIOI->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PIx pins */
|
||||
GPIOI->PUPDR = 0x00000000;
|
||||
|
||||
/*-- FMC Configuration -------------------------------------------------------*/
|
||||
/* Enable the FMC interface clock */
|
||||
RCC->AHB3ENR |= 0x00000001;
|
||||
/* Delay after an RCC peripheral clock enabling */
|
||||
tmp = READ_BIT(RCC->AHB3ENR, RCC_AHB3ENR_FMCEN);
|
||||
|
||||
FMC_Bank5_6->SDCR[0] = 0x000019E4;
|
||||
FMC_Bank5_6->SDTR[0] = 0x01115351;
|
||||
|
||||
/* SDRAM initialization sequence */
|
||||
/* Clock enable command */
|
||||
FMC_Bank5_6->SDCMR = 0x00000011;
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
while((tmpreg != 0) && (timeout-- > 0))
|
||||
{
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
}
|
||||
|
||||
/* Delay */
|
||||
for (index = 0; index<1000; index++);
|
||||
|
||||
/* PALL command */
|
||||
FMC_Bank5_6->SDCMR = 0x00000012;
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
timeout = 0xFFFF;
|
||||
while((tmpreg != 0) && (timeout-- > 0))
|
||||
{
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
}
|
||||
|
||||
/* Auto refresh command */
|
||||
FMC_Bank5_6->SDCMR = 0x00000073;
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
timeout = 0xFFFF;
|
||||
while((tmpreg != 0) && (timeout-- > 0))
|
||||
{
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
}
|
||||
|
||||
/* MRD register program */
|
||||
FMC_Bank5_6->SDCMR = 0x00046014;
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
timeout = 0xFFFF;
|
||||
while((tmpreg != 0) && (timeout-- > 0))
|
||||
{
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
}
|
||||
|
||||
/* Set refresh count */
|
||||
tmpreg = FMC_Bank5_6->SDRTR;
|
||||
FMC_Bank5_6->SDRTR = (tmpreg | (0x0000027C<<1));
|
||||
|
||||
/* Disable write protection */
|
||||
tmpreg = FMC_Bank5_6->SDCR[0];
|
||||
FMC_Bank5_6->SDCR[0] = (tmpreg & 0xFFFFFDFF);
|
||||
|
||||
#if defined(STM32F427xx) || defined(STM32F437xx) || defined(STM32F429xx) || defined(STM32F439xx)
|
||||
/* Configure and enable Bank1_SRAM2 */
|
||||
FMC_Bank1->BTCR[2] = 0x00001011;
|
||||
FMC_Bank1->BTCR[3] = 0x00000201;
|
||||
FMC_Bank1E->BWTR[2] = 0x0fffffff;
|
||||
#endif /* STM32F427xx || STM32F437xx || STM32F429xx || STM32F439xx */
|
||||
#if defined(STM32F469xx) || defined(STM32F479xx)
|
||||
/* Configure and enable Bank1_SRAM2 */
|
||||
FMC_Bank1->BTCR[2] = 0x00001091;
|
||||
FMC_Bank1->BTCR[3] = 0x00110212;
|
||||
FMC_Bank1E->BWTR[2] = 0x0fffffff;
|
||||
#endif /* STM32F469xx || STM32F479xx */
|
||||
|
||||
(void)(tmp);
|
||||
}
|
||||
#endif /* STM32F427xx || STM32F437xx || STM32F429xx || STM32F439xx || STM32F469xx || STM32F479xx */
|
||||
#elif defined (DATA_IN_ExtSRAM) || defined (DATA_IN_ExtSDRAM)
|
||||
/**
|
||||
* @brief Setup the external memory controller.
|
||||
* Called in startup_stm32f4xx.s before jump to main.
|
||||
* This function configures the external memories (SRAM/SDRAM)
|
||||
* This SRAM/SDRAM will be used as program data memory (including heap and stack).
|
||||
* @param None
|
||||
* @retval None
|
||||
*/
|
||||
void SystemInit_ExtMemCtl(void)
|
||||
{
|
||||
__IO uint32_t tmp = 0x00;
|
||||
#if defined(STM32F427xx) || defined(STM32F437xx) || defined(STM32F429xx) || defined(STM32F439xx)\
|
||||
|| defined(STM32F446xx) || defined(STM32F469xx) || defined(STM32F479xx)
|
||||
#if defined (DATA_IN_ExtSDRAM)
|
||||
register uint32_t tmpreg = 0, timeout = 0xFFFF;
|
||||
register __IO uint32_t index;
|
||||
|
||||
#if defined(STM32F446xx)
|
||||
/* Enable GPIOA, GPIOC, GPIOD, GPIOE, GPIOF, GPIOG interface
|
||||
clock */
|
||||
RCC->AHB1ENR |= 0x0000007D;
|
||||
#else
|
||||
/* Enable GPIOC, GPIOD, GPIOE, GPIOF, GPIOG, GPIOH and GPIOI interface
|
||||
clock */
|
||||
RCC->AHB1ENR |= 0x000001F8;
|
||||
#endif /* STM32F446xx */
|
||||
/* Delay after an RCC peripheral clock enabling */
|
||||
tmp = READ_BIT(RCC->AHB1ENR, RCC_AHB1ENR_GPIOCEN);
|
||||
|
||||
#if defined(STM32F446xx)
|
||||
/* Connect PAx pins to FMC Alternate function */
|
||||
GPIOA->AFR[0] |= 0xC0000000;
|
||||
GPIOA->AFR[1] |= 0x00000000;
|
||||
/* Configure PDx pins in Alternate function mode */
|
||||
GPIOA->MODER |= 0x00008000;
|
||||
/* Configure PDx pins speed to 50 MHz */
|
||||
GPIOA->OSPEEDR |= 0x00008000;
|
||||
/* Configure PDx pins Output type to push-pull */
|
||||
GPIOA->OTYPER |= 0x00000000;
|
||||
/* No pull-up, pull-down for PDx pins */
|
||||
GPIOA->PUPDR |= 0x00000000;
|
||||
|
||||
/* Connect PCx pins to FMC Alternate function */
|
||||
GPIOC->AFR[0] |= 0x00CC0000;
|
||||
GPIOC->AFR[1] |= 0x00000000;
|
||||
/* Configure PDx pins in Alternate function mode */
|
||||
GPIOC->MODER |= 0x00000A00;
|
||||
/* Configure PDx pins speed to 50 MHz */
|
||||
GPIOC->OSPEEDR |= 0x00000A00;
|
||||
/* Configure PDx pins Output type to push-pull */
|
||||
GPIOC->OTYPER |= 0x00000000;
|
||||
/* No pull-up, pull-down for PDx pins */
|
||||
GPIOC->PUPDR |= 0x00000000;
|
||||
#endif /* STM32F446xx */
|
||||
|
||||
/* Connect PDx pins to FMC Alternate function */
|
||||
GPIOD->AFR[0] = 0x000000CC;
|
||||
GPIOD->AFR[1] = 0xCC000CCC;
|
||||
/* Configure PDx pins in Alternate function mode */
|
||||
GPIOD->MODER = 0xA02A000A;
|
||||
/* Configure PDx pins speed to 50 MHz */
|
||||
GPIOD->OSPEEDR = 0xA02A000A;
|
||||
/* Configure PDx pins Output type to push-pull */
|
||||
GPIOD->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PDx pins */
|
||||
GPIOD->PUPDR = 0x00000000;
|
||||
|
||||
/* Connect PEx pins to FMC Alternate function */
|
||||
GPIOE->AFR[0] = 0xC00000CC;
|
||||
GPIOE->AFR[1] = 0xCCCCCCCC;
|
||||
/* Configure PEx pins in Alternate function mode */
|
||||
GPIOE->MODER = 0xAAAA800A;
|
||||
/* Configure PEx pins speed to 50 MHz */
|
||||
GPIOE->OSPEEDR = 0xAAAA800A;
|
||||
/* Configure PEx pins Output type to push-pull */
|
||||
GPIOE->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PEx pins */
|
||||
GPIOE->PUPDR = 0x00000000;
|
||||
|
||||
/* Connect PFx pins to FMC Alternate function */
|
||||
GPIOF->AFR[0] = 0xCCCCCCCC;
|
||||
GPIOF->AFR[1] = 0xCCCCCCCC;
|
||||
/* Configure PFx pins in Alternate function mode */
|
||||
GPIOF->MODER = 0xAA800AAA;
|
||||
/* Configure PFx pins speed to 50 MHz */
|
||||
GPIOF->OSPEEDR = 0xAA800AAA;
|
||||
/* Configure PFx pins Output type to push-pull */
|
||||
GPIOF->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PFx pins */
|
||||
GPIOF->PUPDR = 0x00000000;
|
||||
|
||||
/* Connect PGx pins to FMC Alternate function */
|
||||
GPIOG->AFR[0] = 0xCCCCCCCC;
|
||||
GPIOG->AFR[1] = 0xCCCCCCCC;
|
||||
/* Configure PGx pins in Alternate function mode */
|
||||
GPIOG->MODER = 0xAAAAAAAA;
|
||||
/* Configure PGx pins speed to 50 MHz */
|
||||
GPIOG->OSPEEDR = 0xAAAAAAAA;
|
||||
/* Configure PGx pins Output type to push-pull */
|
||||
GPIOG->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PGx pins */
|
||||
GPIOG->PUPDR = 0x00000000;
|
||||
|
||||
#if defined(STM32F427xx) || defined(STM32F437xx) || defined(STM32F429xx) || defined(STM32F439xx)\
|
||||
|| defined(STM32F469xx) || defined(STM32F479xx)
|
||||
/* Connect PHx pins to FMC Alternate function */
|
||||
GPIOH->AFR[0] = 0x00C0CC00;
|
||||
GPIOH->AFR[1] = 0xCCCCCCCC;
|
||||
/* Configure PHx pins in Alternate function mode */
|
||||
GPIOH->MODER = 0xAAAA08A0;
|
||||
/* Configure PHx pins speed to 50 MHz */
|
||||
GPIOH->OSPEEDR = 0xAAAA08A0;
|
||||
/* Configure PHx pins Output type to push-pull */
|
||||
GPIOH->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PHx pins */
|
||||
GPIOH->PUPDR = 0x00000000;
|
||||
|
||||
/* Connect PIx pins to FMC Alternate function */
|
||||
GPIOI->AFR[0] = 0xCCCCCCCC;
|
||||
GPIOI->AFR[1] = 0x00000CC0;
|
||||
/* Configure PIx pins in Alternate function mode */
|
||||
GPIOI->MODER = 0x0028AAAA;
|
||||
/* Configure PIx pins speed to 50 MHz */
|
||||
GPIOI->OSPEEDR = 0x0028AAAA;
|
||||
/* Configure PIx pins Output type to push-pull */
|
||||
GPIOI->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PIx pins */
|
||||
GPIOI->PUPDR = 0x00000000;
|
||||
#endif /* STM32F427xx || STM32F437xx || STM32F429xx || STM32F439xx || STM32F469xx || STM32F479xx */
|
||||
|
||||
/*-- FMC Configuration -------------------------------------------------------*/
|
||||
/* Enable the FMC interface clock */
|
||||
RCC->AHB3ENR |= 0x00000001;
|
||||
/* Delay after an RCC peripheral clock enabling */
|
||||
tmp = READ_BIT(RCC->AHB3ENR, RCC_AHB3ENR_FMCEN);
|
||||
|
||||
/* Configure and enable SDRAM bank1 */
|
||||
#if defined(STM32F446xx)
|
||||
FMC_Bank5_6->SDCR[0] = 0x00001954;
|
||||
#else
|
||||
FMC_Bank5_6->SDCR[0] = 0x000019E4;
|
||||
#endif /* STM32F446xx */
|
||||
FMC_Bank5_6->SDTR[0] = 0x01115351;
|
||||
|
||||
/* SDRAM initialization sequence */
|
||||
/* Clock enable command */
|
||||
FMC_Bank5_6->SDCMR = 0x00000011;
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
while((tmpreg != 0) && (timeout-- > 0))
|
||||
{
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
}
|
||||
|
||||
/* Delay */
|
||||
for (index = 0; index<1000; index++);
|
||||
|
||||
/* PALL command */
|
||||
FMC_Bank5_6->SDCMR = 0x00000012;
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
timeout = 0xFFFF;
|
||||
while((tmpreg != 0) && (timeout-- > 0))
|
||||
{
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
}
|
||||
|
||||
/* Auto refresh command */
|
||||
#if defined(STM32F446xx)
|
||||
FMC_Bank5_6->SDCMR = 0x000000F3;
|
||||
#else
|
||||
FMC_Bank5_6->SDCMR = 0x00000073;
|
||||
#endif /* STM32F446xx */
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
timeout = 0xFFFF;
|
||||
while((tmpreg != 0) && (timeout-- > 0))
|
||||
{
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
}
|
||||
|
||||
/* MRD register program */
|
||||
#if defined(STM32F446xx)
|
||||
FMC_Bank5_6->SDCMR = 0x00044014;
|
||||
#else
|
||||
FMC_Bank5_6->SDCMR = 0x00046014;
|
||||
#endif /* STM32F446xx */
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
timeout = 0xFFFF;
|
||||
while((tmpreg != 0) && (timeout-- > 0))
|
||||
{
|
||||
tmpreg = FMC_Bank5_6->SDSR & 0x00000020;
|
||||
}
|
||||
|
||||
/* Set refresh count */
|
||||
tmpreg = FMC_Bank5_6->SDRTR;
|
||||
#if defined(STM32F446xx)
|
||||
FMC_Bank5_6->SDRTR = (tmpreg | (0x0000050C<<1));
|
||||
#else
|
||||
FMC_Bank5_6->SDRTR = (tmpreg | (0x0000027C<<1));
|
||||
#endif /* STM32F446xx */
|
||||
|
||||
/* Disable write protection */
|
||||
tmpreg = FMC_Bank5_6->SDCR[0];
|
||||
FMC_Bank5_6->SDCR[0] = (tmpreg & 0xFFFFFDFF);
|
||||
#endif /* DATA_IN_ExtSDRAM */
|
||||
#endif /* STM32F427xx || STM32F437xx || STM32F429xx || STM32F439xx || STM32F446xx || STM32F469xx || STM32F479xx */
|
||||
|
||||
#if defined(STM32F405xx) || defined(STM32F415xx) || defined(STM32F407xx) || defined(STM32F417xx)\
|
||||
|| defined(STM32F427xx) || defined(STM32F437xx) || defined(STM32F429xx) || defined(STM32F439xx)\
|
||||
|| defined(STM32F469xx) || defined(STM32F479xx) || defined(STM32F412Zx) || defined(STM32F412Vx)
|
||||
|
||||
#if defined(DATA_IN_ExtSRAM)
|
||||
/*-- GPIOs Configuration -----------------------------------------------------*/
|
||||
/* Enable GPIOD, GPIOE, GPIOF and GPIOG interface clock */
|
||||
RCC->AHB1ENR |= 0x00000078;
|
||||
/* Delay after an RCC peripheral clock enabling */
|
||||
tmp = READ_BIT(RCC->AHB1ENR, RCC_AHB1ENR_GPIODEN);
|
||||
|
||||
/* Connect PDx pins to FMC Alternate function */
|
||||
GPIOD->AFR[0] = 0x00CCC0CC;
|
||||
GPIOD->AFR[1] = 0xCCCCCCCC;
|
||||
/* Configure PDx pins in Alternate function mode */
|
||||
GPIOD->MODER = 0xAAAA0A8A;
|
||||
/* Configure PDx pins speed to 100 MHz */
|
||||
GPIOD->OSPEEDR = 0xFFFF0FCF;
|
||||
/* Configure PDx pins Output type to push-pull */
|
||||
GPIOD->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PDx pins */
|
||||
GPIOD->PUPDR = 0x00000000;
|
||||
|
||||
/* Connect PEx pins to FMC Alternate function */
|
||||
GPIOE->AFR[0] = 0xC00CC0CC;
|
||||
GPIOE->AFR[1] = 0xCCCCCCCC;
|
||||
/* Configure PEx pins in Alternate function mode */
|
||||
GPIOE->MODER = 0xAAAA828A;
|
||||
/* Configure PEx pins speed to 100 MHz */
|
||||
GPIOE->OSPEEDR = 0xFFFFC3CF;
|
||||
/* Configure PEx pins Output type to push-pull */
|
||||
GPIOE->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PEx pins */
|
||||
GPIOE->PUPDR = 0x00000000;
|
||||
|
||||
/* Connect PFx pins to FMC Alternate function */
|
||||
GPIOF->AFR[0] = 0x00CCCCCC;
|
||||
GPIOF->AFR[1] = 0xCCCC0000;
|
||||
/* Configure PFx pins in Alternate function mode */
|
||||
GPIOF->MODER = 0xAA000AAA;
|
||||
/* Configure PFx pins speed to 100 MHz */
|
||||
GPIOF->OSPEEDR = 0xFF000FFF;
|
||||
/* Configure PFx pins Output type to push-pull */
|
||||
GPIOF->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PFx pins */
|
||||
GPIOF->PUPDR = 0x00000000;
|
||||
|
||||
/* Connect PGx pins to FMC Alternate function */
|
||||
GPIOG->AFR[0] = 0x00CCCCCC;
|
||||
GPIOG->AFR[1] = 0x000000C0;
|
||||
/* Configure PGx pins in Alternate function mode */
|
||||
GPIOG->MODER = 0x00085AAA;
|
||||
/* Configure PGx pins speed to 100 MHz */
|
||||
GPIOG->OSPEEDR = 0x000CAFFF;
|
||||
/* Configure PGx pins Output type to push-pull */
|
||||
GPIOG->OTYPER = 0x00000000;
|
||||
/* No pull-up, pull-down for PGx pins */
|
||||
GPIOG->PUPDR = 0x00000000;
|
||||
|
||||
/*-- FMC/FSMC Configuration --------------------------------------------------*/
|
||||
/* Enable the FMC/FSMC interface clock */
|
||||
RCC->AHB3ENR |= 0x00000001;
|
||||
|
||||
#if defined(STM32F427xx) || defined(STM32F437xx) || defined(STM32F429xx) || defined(STM32F439xx)
|
||||
/* Delay after an RCC peripheral clock enabling */
|
||||
tmp = READ_BIT(RCC->AHB3ENR, RCC_AHB3ENR_FMCEN);
|
||||
/* Configure and enable Bank1_SRAM2 */
|
||||
FMC_Bank1->BTCR[2] = 0x00001011;
|
||||
FMC_Bank1->BTCR[3] = 0x00000201;
|
||||
FMC_Bank1E->BWTR[2] = 0x0fffffff;
|
||||
#endif /* STM32F427xx || STM32F437xx || STM32F429xx || STM32F439xx */
|
||||
#if defined(STM32F469xx) || defined(STM32F479xx)
|
||||
/* Delay after an RCC peripheral clock enabling */
|
||||
tmp = READ_BIT(RCC->AHB3ENR, RCC_AHB3ENR_FMCEN);
|
||||
/* Configure and enable Bank1_SRAM2 */
|
||||
FMC_Bank1->BTCR[2] = 0x00001091;
|
||||
FMC_Bank1->BTCR[3] = 0x00110212;
|
||||
FMC_Bank1E->BWTR[2] = 0x0fffffff;
|
||||
#endif /* STM32F469xx || STM32F479xx */
|
||||
#if defined(STM32F405xx) || defined(STM32F415xx) || defined(STM32F407xx)|| defined(STM32F417xx)\
|
||||
|| defined(STM32F412Zx) || defined(STM32F412Vx)
|
||||
/* Delay after an RCC peripheral clock enabling */
|
||||
tmp = READ_BIT(RCC->AHB3ENR, RCC_AHB3ENR_FSMCEN);
|
||||
/* Configure and enable Bank1_SRAM2 */
|
||||
FSMC_Bank1->BTCR[2] = 0x00001011;
|
||||
FSMC_Bank1->BTCR[3] = 0x00000201;
|
||||
FSMC_Bank1E->BWTR[2] = 0x0FFFFFFF;
|
||||
#endif /* STM32F405xx || STM32F415xx || STM32F407xx || STM32F417xx || STM32F412Zx || STM32F412Vx */
|
||||
|
||||
#endif /* DATA_IN_ExtSRAM */
|
||||
#endif /* STM32F405xx || STM32F415xx || STM32F407xx || STM32F417xx || STM32F427xx || STM32F437xx ||\
|
||||
STM32F429xx || STM32F439xx || STM32F469xx || STM32F479xx || STM32F412Zx || STM32F412Vx */
|
||||
(void)(tmp);
|
||||
}
|
||||
#endif /* DATA_IN_ExtSRAM && DATA_IN_ExtSDRAM */
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
@@ -1,114 +0,0 @@
|
||||
/* USER CODE BEGIN Header */
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file usart.c
|
||||
* @brief This file provides code for the configuration
|
||||
* of the USART instances.
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2026 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 "usart.h"
|
||||
|
||||
/* USER CODE BEGIN 0 */
|
||||
|
||||
/* USER CODE END 0 */
|
||||
|
||||
UART_HandleTypeDef huart1;
|
||||
|
||||
/* USART1 init function */
|
||||
|
||||
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 */
|
||||
|
||||
}
|
||||
|
||||
void HAL_UART_MspInit(UART_HandleTypeDef* uartHandle)
|
||||
{
|
||||
|
||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
||||
if(uartHandle->Instance==USART1)
|
||||
{
|
||||
/* USER CODE BEGIN USART1_MspInit 0 */
|
||||
|
||||
/* USER CODE END USART1_MspInit 0 */
|
||||
/* USART1 clock enable */
|
||||
__HAL_RCC_USART1_CLK_ENABLE();
|
||||
|
||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
||||
/**USART1 GPIO Configuration
|
||||
PA9 ------> USART1_TX
|
||||
PA10 ------> USART1_RX
|
||||
*/
|
||||
GPIO_InitStruct.Pin = GPIO_PIN_9|GPIO_PIN_10;
|
||||
GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
|
||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
||||
GPIO_InitStruct.Alternate = GPIO_AF7_USART1;
|
||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
||||
|
||||
/* USER CODE BEGIN USART1_MspInit 1 */
|
||||
|
||||
/* USER CODE END USART1_MspInit 1 */
|
||||
}
|
||||
}
|
||||
|
||||
void HAL_UART_MspDeInit(UART_HandleTypeDef* uartHandle)
|
||||
{
|
||||
|
||||
if(uartHandle->Instance==USART1)
|
||||
{
|
||||
/* USER CODE BEGIN USART1_MspDeInit 0 */
|
||||
|
||||
/* USER CODE END USART1_MspDeInit 0 */
|
||||
/* Peripheral clock disable */
|
||||
__HAL_RCC_USART1_CLK_DISABLE();
|
||||
|
||||
/**USART1 GPIO Configuration
|
||||
PA9 ------> USART1_TX
|
||||
PA10 ------> USART1_RX
|
||||
*/
|
||||
HAL_GPIO_DeInit(GPIOA, GPIO_PIN_9|GPIO_PIN_10);
|
||||
|
||||
/* USER CODE BEGIN USART1_MspDeInit 1 */
|
||||
|
||||
/* USER CODE END USART1_MspDeInit 1 */
|
||||
}
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN 1 */
|
||||
|
||||
/* USER CODE END 1 */
|
||||
+4
-211
@@ -33,7 +33,6 @@
|
||||
#include "j901p.h"
|
||||
#include "j901p_hal.h"
|
||||
#include "mf4010v2.h"
|
||||
#include "mf4010v2_hal.h"
|
||||
/* USER CODE END Includes */
|
||||
|
||||
/* Private typedef -----------------------------------------------------------*/
|
||||
@@ -53,22 +52,7 @@
|
||||
|
||||
/* Private variables ---------------------------------------------------------*/
|
||||
/* USER CODE BEGIN Variables */
|
||||
extern volatile uint8_t s_cDataUpdate;
|
||||
void CopeSensorData(uint32_t uiReg, uint32_t uiRegNum);
|
||||
|
||||
// 传感器数据结构(用于任务间通信)
|
||||
typedef struct {
|
||||
int16_t acc[3]; // 加速度计原始数据
|
||||
int16_t gyro[3]; // 陀螺仪原始数据
|
||||
int16_t angle[3]; // 角度数据
|
||||
uint8_t valid; // 数据有效标志
|
||||
} SensorData_TypeDef;
|
||||
|
||||
SensorData_TypeDef sensorData = {{0}, {0}, {0}, 0};
|
||||
|
||||
// 电机实例
|
||||
mf4010v2_t motor1; // z轴电机
|
||||
mf4010v2_t motor2; // xy轴电机
|
||||
/* USER CODE END Variables */
|
||||
/* Definitions for monitorTask */
|
||||
osThreadId_t monitorTaskHandle;
|
||||
@@ -131,13 +115,13 @@ void MX_FREERTOS_Init(void) {
|
||||
|
||||
/* Create the thread(s) */
|
||||
/* creation of monitorTask */
|
||||
// monitorTaskHandle = osThreadNew(StartMonitorTask, NULL, &monitorTask_attributes);
|
||||
monitorTaskHandle = osThreadNew(StartMonitorTask, NULL, &monitorTask_attributes);
|
||||
|
||||
/* creation of controlTask */
|
||||
controlTaskHandle = osThreadNew(StartControlTask, NULL, &controlTask_attributes);
|
||||
|
||||
/* creation of sensorTask */
|
||||
// sensorTaskHandle = osThreadNew(StartSensorTask, NULL, &sensorTask_attributes);
|
||||
sensorTaskHandle = osThreadNew(StartSensorTask, NULL, &sensorTask_attributes);
|
||||
|
||||
/* USER CODE BEGIN RTOS_THREADS */
|
||||
/* add threads, ... */
|
||||
@@ -159,74 +143,7 @@ void MX_FREERTOS_Init(void) {
|
||||
void StartMonitorTask(void *argument)
|
||||
{
|
||||
/* USER CODE BEGIN StartMonitorTask */
|
||||
argument = argument;
|
||||
// 等待传感器数据初始化
|
||||
osDelay(500);
|
||||
|
||||
const uint8_t monitor_start[] = "Monitor task started\r\n";
|
||||
HAL_UART_Transmit(&huart1, monitor_start, sizeof(monitor_start)-1, 100);
|
||||
|
||||
for(;;)
|
||||
{
|
||||
// 等待有效数据
|
||||
if(sensorData.valid)
|
||||
{
|
||||
// 输出加速度
|
||||
const uint8_t acc_msg[] = "ACC: ";
|
||||
HAL_UART_Transmit(&huart1, acc_msg, sizeof(acc_msg)-1, 50);
|
||||
|
||||
for(int i=0; i<3; i++)
|
||||
{
|
||||
int32_t acc_scaled = (sensorData.acc[i] * 16 * 1000) / 32768;
|
||||
int32_t acc_int = acc_scaled / 1000;
|
||||
int32_t acc_frac = acc_scaled % 1000;
|
||||
if(acc_frac < 0) acc_frac = -acc_frac;
|
||||
|
||||
char acc_str[20];
|
||||
int acc_len = snprintf(acc_str, sizeof(acc_str), "%ld.%03ld ", acc_int, acc_frac);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)acc_str, acc_len, 50);
|
||||
}
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)"\r\n", 2, 50);
|
||||
|
||||
// 输出角速度
|
||||
const uint8_t gyro_msg[] = "GYRO: ";
|
||||
HAL_UART_Transmit(&huart1, gyro_msg, sizeof(gyro_msg)-1, 50);
|
||||
|
||||
for(int i=0; i<3; i++)
|
||||
{
|
||||
int32_t gyro_scaled = (sensorData.gyro[i] * 2000 * 1000) / 32768;
|
||||
int32_t gyro_int = gyro_scaled / 1000;
|
||||
int32_t gyro_frac = gyro_scaled % 1000;
|
||||
if(gyro_frac < 0) gyro_frac = -gyro_frac;
|
||||
|
||||
char gyro_str[20];
|
||||
int gyro_len = snprintf(gyro_str, sizeof(gyro_str), "%ld.%03ld ", gyro_int, gyro_frac);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)gyro_str, gyro_len, 50);
|
||||
}
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)"\r\n", 2, 50);
|
||||
|
||||
// 输出角度
|
||||
const uint8_t angle_msg[] = "ANGLE: ";
|
||||
HAL_UART_Transmit(&huart1, angle_msg, sizeof(angle_msg)-1, 50);
|
||||
|
||||
for(int i=0; i<3; i++)
|
||||
{
|
||||
int32_t angle_scaled = (sensorData.angle[i] * 180 * 1000) / 32768;
|
||||
int32_t angle_int = angle_scaled / 1000;
|
||||
int32_t angle_frac = angle_scaled % 1000;
|
||||
if(angle_frac < 0) angle_frac = -angle_frac;
|
||||
|
||||
char angle_str[20];
|
||||
int angle_len = snprintf(angle_str, sizeof(angle_str), "%ld.%03ld ", angle_int, angle_frac);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)angle_str, angle_len, 50);
|
||||
}
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)"\r\n", 2, 50);
|
||||
|
||||
sensorData.valid = 0; // 清除标志,等待下次更新
|
||||
}
|
||||
|
||||
osDelay(200); // 200ms 输出间隔
|
||||
}
|
||||
/* USER CODE END StartMonitorTask */
|
||||
}
|
||||
|
||||
@@ -246,99 +163,7 @@ void StartMonitorTask(void *argument)
|
||||
void StartControlTask(void *argument)
|
||||
{
|
||||
/* USER CODE BEGIN StartControlTask */
|
||||
argument = argument;
|
||||
|
||||
osDelay(500);
|
||||
|
||||
/* ==========================================================================
|
||||
* 步骤 1: 打印 CAN 初始状态和调试信息
|
||||
* ========================================================================== */
|
||||
const uint8_t init_msg[] = "\r\n========== CAN/Motor Initialization ==========\r\n";
|
||||
HAL_UART_Transmit(&huart1, init_msg, sizeof(init_msg)-1, 100);
|
||||
|
||||
/* 打印 CAN 详细调试信息 */
|
||||
CAN_PrintDebugInfo(&hcan2, &huart1);
|
||||
|
||||
/* ==========================================================================
|
||||
* 步骤 2: 初始化电机结构体
|
||||
* ========================================================================== */
|
||||
const uint8_t motor_init_msg[] = "\r\nInitializing motor (ID=0x141)...\r\n";
|
||||
HAL_UART_Transmit(&huart1, motor_init_msg, sizeof(motor_init_msg)-1, 100);
|
||||
|
||||
mf4010_status_t status;
|
||||
char log_buf[128];
|
||||
int log_len;
|
||||
|
||||
status = mf4010v2_init(&motor2, 0x141);
|
||||
if(status != MF4010_OK) {
|
||||
log_len = snprintf(log_buf, sizeof(log_buf), "Error: Motor init failed with status %d\r\n", status);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)log_buf, log_len, 100);
|
||||
} else {
|
||||
const uint8_t ok_msg[] = "Motor structure initialized OK\r\n";
|
||||
HAL_UART_Transmit(&huart1, ok_msg, sizeof(ok_msg)-1, 100);
|
||||
}
|
||||
|
||||
osDelay(100);
|
||||
|
||||
/* ==========================================================================
|
||||
* 步骤 3: 发送电机测试命令(关闭电机)
|
||||
* ========================================================================== */
|
||||
const uint8_t cmd_msg[] = "\r\nSending MOTOR_CLOSE command...\r\n";
|
||||
HAL_UART_Transmit(&huart1, cmd_msg, sizeof(cmd_msg)-1, 100);
|
||||
|
||||
const uint8_t cmd[] = COMMAND_MOTOR_CLOSE;
|
||||
status = mf4010v2_send_command(&motor2, cmd, 1000);
|
||||
|
||||
if (status != MF4010_OK) {
|
||||
log_len = snprintf(log_buf, sizeof(log_buf),
|
||||
"Error: Motor command failed with status %d\r\n"
|
||||
" Error count: %d\r\n"
|
||||
" Success count: %d\r\n"
|
||||
" Flags: 0x%02X\r\n",
|
||||
status,
|
||||
motor2.error_count,
|
||||
motor2.success_count,
|
||||
motor2.flags);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)log_buf, log_len, 100);
|
||||
|
||||
/* 打印 CAN 错误状态 */
|
||||
const uint8_t can_err_msg[] = "\r\nCAN error status:\r\n";
|
||||
HAL_UART_Transmit(&huart1, can_err_msg, sizeof(can_err_msg)-1, 100);
|
||||
CAN_PrintDebugInfo(&hcan2, &huart1);
|
||||
} else {
|
||||
const uint8_t success_msg[] = "Motor command sent successfully!\r\n";
|
||||
HAL_UART_Transmit(&huart1, success_msg, sizeof(success_msg)-1, 100);
|
||||
|
||||
log_len = snprintf(log_buf, sizeof(log_buf),
|
||||
" Response[0]: 0x%02X\r\n"
|
||||
" Error count: %d\r\n"
|
||||
" Success count: %d\r\n",
|
||||
motor2.last_response[0],
|
||||
motor2.error_count,
|
||||
motor2.success_count);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)log_buf, log_len, 100);
|
||||
}
|
||||
|
||||
/* ==========================================================================
|
||||
* 主循环
|
||||
* ========================================================================== */
|
||||
const uint8_t main_loop_msg[] = "\r\nEntering main loop...\r\n";
|
||||
HAL_UART_Transmit(&huart1, main_loop_msg, sizeof(main_loop_msg)-1, 100);
|
||||
|
||||
for (;;) {
|
||||
osDelay(1000); // 1 秒延时
|
||||
|
||||
/* 可选:周期性打印状态 */
|
||||
#if 0
|
||||
log_len = snprintf(log_buf, sizeof(log_buf),
|
||||
"Motor status: err=%d, ok=%d, flags=0x%02X\r\n",
|
||||
motor2.error_count,
|
||||
motor2.success_count,
|
||||
motor2.flags);
|
||||
HAL_UART_Transmit(&huart1, (uint8_t*)log_buf, log_len, 100);
|
||||
#endif
|
||||
}
|
||||
|
||||
|
||||
/* USER CODE END StartControlTask */
|
||||
}
|
||||
|
||||
@@ -352,39 +177,7 @@ void StartControlTask(void *argument)
|
||||
void StartSensorTask(void *argument)
|
||||
{
|
||||
/* USER CODE BEGIN StartSensorTask */
|
||||
argument = argument;
|
||||
// 初始化传感器
|
||||
WitRegisterCallBack(CopeSensorData);
|
||||
WitDelayMsRegister(J901P_Delay);
|
||||
J901P_HAL_Init(0x50);
|
||||
|
||||
WitReadReg(AX, 12);
|
||||
osDelay(100);
|
||||
|
||||
for(;;)
|
||||
{
|
||||
if(s_cDataUpdate)
|
||||
{
|
||||
WitReadReg(AX, 12);
|
||||
osDelay(50);
|
||||
|
||||
// 复制数据到共享结构
|
||||
for(int i=0; i<3; i++) {
|
||||
sensorData.acc[i] = sReg[AX+i];
|
||||
sensorData.gyro[i] = sReg[GX+i];
|
||||
sensorData.angle[i] = sReg[Roll+i];
|
||||
}
|
||||
sensorData.valid = 1; // 标记数据有效
|
||||
|
||||
s_cDataUpdate = 0;
|
||||
osDelay(200);
|
||||
}
|
||||
else
|
||||
{
|
||||
WitReadReg(AX, 12);
|
||||
osDelay(100);
|
||||
}
|
||||
}
|
||||
|
||||
/* USER CODE END StartSensorTask */
|
||||
}
|
||||
|
||||
|
||||
@@ -26,8 +26,6 @@
|
||||
|
||||
/* Private includes ----------------------------------------------------------*/
|
||||
/* USER CODE BEGIN Includes */
|
||||
#include "j901p.h"
|
||||
#include "j901p_hal.h"
|
||||
/* USER CODE END Includes */
|
||||
|
||||
/* Private typedef -----------------------------------------------------------*/
|
||||
@@ -48,7 +46,6 @@
|
||||
/* Private variables ---------------------------------------------------------*/
|
||||
|
||||
/* USER CODE BEGIN PV */
|
||||
volatile uint8_t s_cDataUpdate = 0;
|
||||
/* USER CODE END PV */
|
||||
|
||||
/* Private function prototypes -----------------------------------------------*/
|
||||
@@ -65,21 +62,7 @@ int __io_putchar(int ch)
|
||||
/* Private user code ---------------------------------------------------------*/
|
||||
/* USER CODE BEGIN 0 */
|
||||
|
||||
void CopeSensorData(uint32_t uiReg, uint32_t uiRegNum);
|
||||
|
||||
void CopeSensorData(uint32_t uiReg, uint32_t uiRegNum)
|
||||
{
|
||||
for(uint32_t i = 0; i < uiRegNum; i++)
|
||||
{
|
||||
switch(uiReg + i)
|
||||
{
|
||||
case AZ: s_cDataUpdate |= 0x01; break;
|
||||
case GZ: s_cDataUpdate |= 0x02; break;
|
||||
case Yaw: s_cDataUpdate |= 0x04; break;
|
||||
default: break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* USER CODE END 0 */
|
||||
|
||||
@@ -117,8 +100,6 @@ int main(void)
|
||||
MX_CAN2_Init();
|
||||
/* USER CODE BEGIN 2 */
|
||||
|
||||
const uint8_t start_msg[] = "System starting...\r\n";
|
||||
HAL_UART_Transmit(&huart1, start_msg, sizeof(start_msg) - 1, 100);
|
||||
|
||||
/* USER CODE END 2 */
|
||||
|
||||
|
||||
@@ -0,0 +1,13 @@
|
||||
#include "led.h"
|
||||
|
||||
static led_t led0;
|
||||
|
||||
void app_init(void)
|
||||
{
|
||||
led_init(&led0, 0);
|
||||
}
|
||||
|
||||
void task_1_app_run(void)
|
||||
{
|
||||
led_toggle(&led0);
|
||||
}
|
||||
@@ -1,8 +1,26 @@
|
||||
#include "bsp_can.h"
|
||||
#include "can.h"
|
||||
|
||||
void can_init(void) {
|
||||
|
||||
void bsp_can_init(void)
|
||||
{
|
||||
// CAN GPIO 和时钟已在 MX_CAN2_Init 中配置
|
||||
// 这里可以添加额外的初始化
|
||||
}
|
||||
int can_send(uint32_t id, uint8_t* data, uint8_t length) {
|
||||
|
||||
|
||||
int bsp_can_send(uint32_t id, uint8_t* data, uint8_t length)
|
||||
{
|
||||
if (!data || length > 8)
|
||||
return -1;
|
||||
|
||||
HAL_StatusTypeDef ret = CAN_SendFrame(&hcan2, id, data, length, 100);
|
||||
return (ret == HAL_OK) ? 0 : -1;
|
||||
}
|
||||
|
||||
int bsp_can_recv(uint32_t *id, uint8_t* data, uint8_t *length)
|
||||
{
|
||||
if (!id || !data || !length)
|
||||
return -1;
|
||||
|
||||
HAL_StatusTypeDef ret = CAN_ReceiveFrame(&hcan2, (uint16_t*)id, data, length, 0);
|
||||
return (ret == HAL_OK) ? 0 : -1;
|
||||
}
|
||||
@@ -2,22 +2,22 @@
|
||||
#define __BSP_CAN__H__
|
||||
|
||||
#include <stdint.h>
|
||||
#include "main.h"
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
typedef struct {
|
||||
uint32_t id; // CAN ID
|
||||
uint8_t data[8]; // CAN 数据
|
||||
uint8_t length; // 数据长度 (0-8)
|
||||
} can_message_t;
|
||||
|
||||
typedef struct {
|
||||
void bsp_can_init(void);
|
||||
int bsp_can_send(uint32_t id, uint8_t* data, uint8_t length);
|
||||
int bsp_can_recv(uint32_t *id, uint8_t* data, uint8_t *length);
|
||||
|
||||
} can_config_t;
|
||||
|
||||
void can_init(void);
|
||||
int can_send(uint32_t id, uint8_t* data, uint8_t length);
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
@@ -0,0 +1,13 @@
|
||||
#include "bsp_led.h"
|
||||
|
||||
static bsp_led_t leds[] = {
|
||||
{GPIOA, GPIO_PIN_5}, // LED0
|
||||
{GPIOB, GPIO_PIN_0}, // LED1
|
||||
};
|
||||
|
||||
bsp_led_t* bsp_led_get(int id)
|
||||
{
|
||||
if (id < 0 || id >= sizeof(leds)/sizeof(leds[0]))
|
||||
return 0;
|
||||
return &leds[id];
|
||||
}
|
||||
@@ -0,0 +1,13 @@
|
||||
#ifndef BSP_LED_H
|
||||
#define BSP_LED_H
|
||||
|
||||
#include "stm32f4xx_hal.h"
|
||||
|
||||
typedef struct {
|
||||
GPIO_TypeDef *port;
|
||||
uint16_t pin;
|
||||
} bsp_led_t;
|
||||
|
||||
bsp_led_t* bsp_led_get(int id);
|
||||
|
||||
#endif
|
||||
@@ -0,0 +1,60 @@
|
||||
#include "can_if.h"
|
||||
#include "bsp_can.h"
|
||||
#include "can.h"
|
||||
|
||||
static int hal_can_init(void)
|
||||
{
|
||||
// 配置滤波器:接收所有帧
|
||||
CAN_ConfigFilterAll(&hcan2, 0);
|
||||
|
||||
// 启动 CAN
|
||||
if (CAN_Start(&hcan2) != HAL_OK)
|
||||
return -1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int hal_can_send(const can_message_t *msg)
|
||||
{
|
||||
if (!msg || msg->length > 8)
|
||||
return -1;
|
||||
|
||||
HAL_StatusTypeDef ret = CAN_SendFrame(&hcan2, msg->id, msg->data, msg->length, 100);
|
||||
return (ret == HAL_OK) ? 0 : -1;
|
||||
}
|
||||
|
||||
static int hal_can_recv(can_message_t *msg)
|
||||
{
|
||||
if (!msg)
|
||||
return -1;
|
||||
|
||||
uint16_t id;
|
||||
uint8_t len;
|
||||
|
||||
HAL_StatusTypeDef ret = CAN_ReceiveFrame(&hcan2, &id, msg->data, &len, 0);
|
||||
if (ret != HAL_OK)
|
||||
return -1;
|
||||
|
||||
msg->id = id;
|
||||
msg->length = len;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int hal_can_filter_config(uint8_t filter_id, uint32_t id, uint32_t mask)
|
||||
{
|
||||
CAN_ConfigFilter(&hcan2, filter_id, id, mask);
|
||||
return 0;
|
||||
}
|
||||
|
||||
// 注册接口
|
||||
static const can_ops_t ops = {
|
||||
.init = hal_can_init,
|
||||
.send = hal_can_send,
|
||||
.recv = hal_can_recv,
|
||||
.filter_config = hal_can_filter_config
|
||||
};
|
||||
|
||||
void hal_can_init_all(void)
|
||||
{
|
||||
can_register_ops(&ops);
|
||||
}
|
||||
@@ -0,0 +1,14 @@
|
||||
#ifndef HAL_CAN_STM32F4_H
|
||||
#define HAL_CAN_STM32F4_H
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
void hal_can_init_all(void);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif
|
||||
@@ -0,0 +1,73 @@
|
||||
#include "led_if.h"
|
||||
#include "bsp_led.h"
|
||||
|
||||
static void hal_led_enable_gpio_clock(GPIO_TypeDef *port)
|
||||
{
|
||||
if (port == GPIOA) __HAL_RCC_GPIOA_CLK_ENABLE();
|
||||
else if (port == GPIOB) __HAL_RCC_GPIOB_CLK_ENABLE();
|
||||
else if (port == GPIOC) __HAL_RCC_GPIOC_CLK_ENABLE();
|
||||
else if (port == GPIOD) __HAL_RCC_GPIOD_CLK_ENABLE();
|
||||
else if (port == GPIOE) __HAL_RCC_GPIOE_CLK_ENABLE();
|
||||
else if (port == GPIOF) __HAL_RCC_GPIOF_CLK_ENABLE();
|
||||
else if (port == GPIOG) __HAL_RCC_GPIOG_CLK_ENABLE();
|
||||
}
|
||||
|
||||
static int hal_led_init(int id)
|
||||
{
|
||||
bsp_led_t *led = bsp_led_get(id);
|
||||
if (!led) return -1;
|
||||
|
||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
||||
|
||||
hal_led_enable_gpio_clock(led->port);
|
||||
|
||||
GPIO_InitStruct.Pin = led->pin;
|
||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
||||
|
||||
HAL_GPIO_Init(led->port, &GPIO_InitStruct);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int hal_led_write(int id, int state)
|
||||
{
|
||||
bsp_led_t *led = bsp_led_get(id);
|
||||
if (!led) return -1;
|
||||
|
||||
HAL_GPIO_WritePin(led->port, led->pin,
|
||||
state ? GPIO_PIN_SET : GPIO_PIN_RESET);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int hal_led_read(int id)
|
||||
{
|
||||
bsp_led_t *led = bsp_led_get(id);
|
||||
if (!led) return -1;
|
||||
|
||||
return HAL_GPIO_ReadPin(led->port, led->pin);
|
||||
}
|
||||
|
||||
static int hal_led_toggle(int id)
|
||||
{
|
||||
bsp_led_t *led = bsp_led_get(id);
|
||||
if (!led) return -1;
|
||||
|
||||
HAL_GPIO_TogglePin(led->port, led->pin);
|
||||
return 0;
|
||||
}
|
||||
|
||||
// 注册接口
|
||||
static const led_ops_t ops = {
|
||||
.init = hal_led_init,
|
||||
.write = hal_led_write,
|
||||
.read = hal_led_read,
|
||||
.toggle = hal_led_toggle
|
||||
};
|
||||
|
||||
void hal_led_init_all(void)
|
||||
{
|
||||
led_register_ops(&ops);
|
||||
}
|
||||
@@ -0,0 +1,36 @@
|
||||
#include "can_if.h"
|
||||
|
||||
static const can_ops_t *g_can_ops = 0;
|
||||
|
||||
void can_register_ops(const can_ops_t *ops)
|
||||
{
|
||||
g_can_ops = ops;
|
||||
}
|
||||
|
||||
int can_if_init(void)
|
||||
{
|
||||
if (!g_can_ops || !g_can_ops->init)
|
||||
return -1;
|
||||
return g_can_ops->init();
|
||||
}
|
||||
|
||||
int can_if_send(const can_message_t *msg)
|
||||
{
|
||||
if (!g_can_ops || !g_can_ops->send)
|
||||
return -1;
|
||||
return g_can_ops->send(msg);
|
||||
}
|
||||
|
||||
int can_if_recv(can_message_t *msg)
|
||||
{
|
||||
if (!g_can_ops || !g_can_ops->recv)
|
||||
return -1;
|
||||
return g_can_ops->recv(msg);
|
||||
}
|
||||
|
||||
int can_if_filter_config(uint8_t filter_id, uint32_t id, uint32_t mask)
|
||||
{
|
||||
if (!g_can_ops || !g_can_ops->filter_config)
|
||||
return -1;
|
||||
return g_can_ops->filter_config(filter_id, id, mask);
|
||||
}
|
||||
@@ -0,0 +1,28 @@
|
||||
#ifndef CAN_IF_H
|
||||
#define CAN_IF_H
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
typedef struct {
|
||||
uint32_t id; // CAN ID
|
||||
uint8_t data[8]; // CAN 数据
|
||||
uint8_t length; // 数据长度 (0-8)
|
||||
} can_message_t;
|
||||
|
||||
typedef struct {
|
||||
int (*init)(void);
|
||||
int (*send)(const can_message_t *msg);
|
||||
int (*recv)(can_message_t *msg);
|
||||
int (*filter_config)(uint8_t filter_id, uint32_t id, uint32_t mask);
|
||||
} can_ops_t;
|
||||
|
||||
// 注册接口(由 HAL 调用)
|
||||
void can_register_ops(const can_ops_t *ops);
|
||||
|
||||
// 对上层暴露统一 API
|
||||
int can_if_init(void);
|
||||
int can_if_send(const can_message_t *msg);
|
||||
int can_if_recv(can_message_t *msg);
|
||||
int can_if_filter_config(uint8_t filter_id, uint32_t id, uint32_t mask);
|
||||
|
||||
#endif
|
||||
@@ -0,0 +1,36 @@
|
||||
#include "led_if.h"
|
||||
|
||||
static const led_ops_t *g_led_ops = 0;
|
||||
|
||||
void led_register_ops(const led_ops_t *ops)
|
||||
{
|
||||
g_led_ops = ops;
|
||||
}
|
||||
|
||||
int led_if_init(int id)
|
||||
{
|
||||
if (!g_led_ops || !g_led_ops->init)
|
||||
return -1;
|
||||
return g_led_ops->init(id);
|
||||
}
|
||||
|
||||
int led_if_write(int id, int state)
|
||||
{
|
||||
if (!g_led_ops || !g_led_ops->write)
|
||||
return -1;
|
||||
return g_led_ops->write(id, state);
|
||||
}
|
||||
|
||||
int led_if_read(int id)
|
||||
{
|
||||
if (!g_led_ops || !g_led_ops->read)
|
||||
return -1;
|
||||
return g_led_ops->read(id);
|
||||
}
|
||||
|
||||
int led_if_toggle(int id)
|
||||
{
|
||||
if (!g_led_ops || !g_led_ops->toggle)
|
||||
return -1;
|
||||
return g_led_ops->toggle(id);
|
||||
}
|
||||
@@ -0,0 +1,20 @@
|
||||
#ifndef LED_IF_H
|
||||
#define LED_IF_H
|
||||
|
||||
typedef struct {
|
||||
int (*init)(int id);
|
||||
int (*write)(int id, int state);
|
||||
int (*read)(int id);
|
||||
int (*toggle)(int id);
|
||||
} led_ops_t;
|
||||
|
||||
// 注册接口(由HAL调用)
|
||||
void led_register_ops(const led_ops_t *ops);
|
||||
|
||||
// 对上层暴露统一API
|
||||
int led_if_init(int id);
|
||||
int led_if_write(int id, int state);
|
||||
int led_if_read(int id);
|
||||
int led_if_toggle(int id);
|
||||
|
||||
#endif
|
||||
@@ -0,0 +1,49 @@
|
||||
#include "led.h"
|
||||
#include "led_if.h"
|
||||
|
||||
int led_init(led_t *led, int id)
|
||||
{
|
||||
if (!led) return -1;
|
||||
|
||||
led->id = id;
|
||||
led->state = 0;
|
||||
|
||||
int ret = led_if_init(id);
|
||||
if (ret == 0) {
|
||||
// 同步硬件状态
|
||||
int hw_state = led_if_read(id);
|
||||
led->state = (hw_state > 0) ? 1 : 0;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int led_on(led_t *led)
|
||||
{
|
||||
if (!led) return -1;
|
||||
|
||||
int ret = led_if_write(led->id, 1);
|
||||
if (ret == 0) led->state = 1;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int led_off(led_t *led)
|
||||
{
|
||||
if (!led) return -1;
|
||||
|
||||
int ret = led_if_write(led->id, 0);
|
||||
if (ret == 0) led->state = 0;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int led_toggle(led_t *led)
|
||||
{
|
||||
if (!led) return -1;
|
||||
|
||||
int ret = led_if_toggle(led->id);
|
||||
if (ret == 0) led->state ^= 1;
|
||||
|
||||
return ret;
|
||||
}
|
||||
@@ -0,0 +1,14 @@
|
||||
#ifndef LED_H
|
||||
#define LED_H
|
||||
|
||||
typedef struct {
|
||||
int id;
|
||||
int state;
|
||||
} led_t;
|
||||
|
||||
int led_init(led_t *led, int id);
|
||||
int led_on(led_t *led);
|
||||
int led_off(led_t *led);
|
||||
int led_toggle(led_t *led);
|
||||
|
||||
#endif
|
||||
@@ -37,8 +37,6 @@ mf4010_status_t mf4010v2_init(mf4010v2_t* motor, uint16_t id)
|
||||
motor->error_count = 0;
|
||||
motor->success_count = 0;
|
||||
motor->flags = MF4010_FLAG_NONE;
|
||||
motor->ops.init = mf4010v2_init;
|
||||
motor->ops.send_command = mf4010v2_send_command;
|
||||
return MF4010_OK;
|
||||
}
|
||||
|
||||
@@ -47,55 +45,6 @@ mf4010_status_t mf4010v2_init(mf4010v2_t* motor, uint16_t id)
|
||||
*/
|
||||
mf4010_status_t mf4010v2_send_command(mf4010v2_t* motor, const uint8_t command[8], uint32_t timeout_ms)
|
||||
{
|
||||
// 参数验证
|
||||
if(motor == NULL || command == NULL) {
|
||||
return MF4010_ERR_INVALID_PARAM;
|
||||
}
|
||||
// 验证命令格式(首字节应该是命令字)
|
||||
if((command[0] & 0x80) == 0 && command[0] < 0x30) {
|
||||
printf("Warning: Invalid command format 0x%02X\r\n", command[0]);
|
||||
// 不返回错误,继续执行
|
||||
}
|
||||
|
||||
// 发送 CAN 消息
|
||||
if (can_send(motor->id, command, 8) != HAL_OK)
|
||||
{
|
||||
motor->error_count++;
|
||||
motor->flags &= ~MF4010_FLAG_CONNECTED;
|
||||
return MF4010_ERR_TIMEOUT;
|
||||
}
|
||||
|
||||
// 接收响应
|
||||
uint16_t rx_id;
|
||||
uint8_t len;
|
||||
if (MF4010V2_HAL_Receive(&rx_id, motor->last_response, &len, timeout_ms) != HAL_OK)
|
||||
{
|
||||
motor->error_count++;
|
||||
motor->flags &= ~MF4010_FLAG_CONNECTED;
|
||||
return MF4010_ERR_NO_RESPONSE;
|
||||
}
|
||||
|
||||
// 验证响应 ID
|
||||
if (rx_id != motor->id)
|
||||
{
|
||||
return MF4010_ERR_CRC;
|
||||
}
|
||||
|
||||
motor->last_comm_time = get_system_tick();
|
||||
motor->success_count++;
|
||||
motor->flags |= MF4010_FLAG_CONNECTED;
|
||||
|
||||
// 解析错误状态
|
||||
if (motor->last_response[0] & 0x80)
|
||||
{
|
||||
uint8_t error_code = motor->last_response[0] & 0x7F;
|
||||
printf("Motor error from 0x%03X: 0x%02X\r\n", motor->id, error_code);
|
||||
motor->error_count++;
|
||||
motor->flags |= MF4010_FLAG_FAULT;
|
||||
return MF4010_ERR_CRC;
|
||||
}
|
||||
|
||||
motor->flags &= ~MF4010_FLAG_FAULT;
|
||||
return MF4010_OK;
|
||||
|
||||
}
|
||||
|
||||
@@ -60,23 +60,25 @@ typedef enum {
|
||||
/**
|
||||
* @brief 电机结构体(优化版)
|
||||
*/
|
||||
struct __mf4010v2_ops_t;
|
||||
typedef struct {
|
||||
struct __mf4010v2_ops_t ops; /**< 操作函数指针 */
|
||||
struct __mf4010v2_t;
|
||||
typedef struct __mf4010v2_t mf4010v2_t; // 前向声明
|
||||
typedef struct {
|
||||
mf4010_status_t (*init)();
|
||||
mf4010_status_t (*send_command)();
|
||||
}mf4010v2_ops_t;
|
||||
|
||||
struct __mf4010v2_t {
|
||||
mf4010v2_ops_t ops; /**< 操作函数指针 */
|
||||
uint16_t id; /**< CAN ID (0x000-0x7FF) */
|
||||
uint8_t last_response[8]; /**< 最后一次响应数据 */
|
||||
uint32_t last_comm_time; /**< 最后通信时间戳 (ms) */
|
||||
uint16_t error_count; /**< 通信错误计数 */
|
||||
uint16_t success_count; /**< 成功通信计数 */
|
||||
uint8_t flags; /**< 状态标志 (@ref mf4010_flag_t) */
|
||||
} mf4010v2_t;
|
||||
|
||||
struct __mf4010v2_ops_t {
|
||||
mf4010_status_t (*init)(mf4010v2_t* self, uint16_t id);
|
||||
mf4010_status_t (*send_command)(mf4010v2_t* self, const uint8_t command[8], uint32_t timeout_ms);
|
||||
};
|
||||
|
||||
typedef struct __mf4010v2_ops_t mf4010v2_ops_t;
|
||||
|
||||
|
||||
|
||||
|
||||
/* ============================================================================
|
||||
|
||||
@@ -393,7 +393,6 @@ int32_t WitStartAccCali(void)
|
||||
if(WitWriteReg(KEY, KEY_UNLOCK) != WIT_HAL_OK) return WIT_HAL_ERROR;// unlock reg
|
||||
if(s_uiProtoclo == WIT_PROTOCOL_MODBUS) p_WitDelaymsFunc(20);
|
||||
else if(s_uiProtoclo == WIT_PROTOCOL_NORMAL) p_WitDelaymsFunc(1);
|
||||
else ;
|
||||
if(WitWriteReg(CALSW, CALGYROACC) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
return WIT_HAL_OK;
|
||||
}
|
||||
@@ -402,7 +401,6 @@ int32_t WitStopAccCali(void)
|
||||
if(WitWriteReg(CALSW, NORMAL) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
if(s_uiProtoclo == WIT_PROTOCOL_MODBUS) p_WitDelaymsFunc(20);
|
||||
else if(s_uiProtoclo == WIT_PROTOCOL_NORMAL) p_WitDelaymsFunc(1);
|
||||
else ;
|
||||
if(WitWriteReg(SAVE, SAVE_PARAM) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
return WIT_HAL_OK;
|
||||
}
|
||||
@@ -412,7 +410,6 @@ int32_t WitStartMagCali(void)
|
||||
if(WitWriteReg(KEY, KEY_UNLOCK) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
if(s_uiProtoclo == WIT_PROTOCOL_MODBUS) p_WitDelaymsFunc(20);
|
||||
else if(s_uiProtoclo == WIT_PROTOCOL_NORMAL) p_WitDelaymsFunc(1);
|
||||
else ;
|
||||
if(WitWriteReg(CALSW, CALMAGMM) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
return WIT_HAL_OK;
|
||||
}
|
||||
@@ -421,7 +418,6 @@ int32_t WitStopMagCali(void)
|
||||
if(WitWriteReg(KEY, KEY_UNLOCK) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
if(s_uiProtoclo == WIT_PROTOCOL_MODBUS) p_WitDelaymsFunc(20);
|
||||
else if(s_uiProtoclo == WIT_PROTOCOL_NORMAL) p_WitDelaymsFunc(1);
|
||||
else ;
|
||||
if(WitWriteReg(CALSW, NORMAL) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
return WIT_HAL_OK;
|
||||
}
|
||||
@@ -435,7 +431,6 @@ int32_t WitSetUartBaud(int32_t uiBaudIndex)
|
||||
if(WitWriteReg(KEY, KEY_UNLOCK) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
if(s_uiProtoclo == WIT_PROTOCOL_MODBUS) p_WitDelaymsFunc(20);
|
||||
else if(s_uiProtoclo == WIT_PROTOCOL_NORMAL) p_WitDelaymsFunc(1);
|
||||
else ;
|
||||
if(WitWriteReg(BAUD, uiBaudIndex) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
return WIT_HAL_OK;
|
||||
}
|
||||
@@ -449,7 +444,6 @@ int32_t WitSetCanBaud(int32_t uiBaudIndex)
|
||||
if(WitWriteReg(KEY, KEY_UNLOCK) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
if(s_uiProtoclo == WIT_PROTOCOL_MODBUS) p_WitDelaymsFunc(20);
|
||||
else if(s_uiProtoclo == WIT_PROTOCOL_NORMAL) p_WitDelaymsFunc(1);
|
||||
else ;
|
||||
if(WitWriteReg(BAUD, uiBaudIndex) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
return WIT_HAL_OK;
|
||||
}
|
||||
@@ -463,7 +457,6 @@ int32_t WitSetBandwidth(int32_t uiBaudWidth)
|
||||
if(WitWriteReg(KEY, KEY_UNLOCK) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
if(s_uiProtoclo == WIT_PROTOCOL_MODBUS) p_WitDelaymsFunc(20);
|
||||
else if(s_uiProtoclo == WIT_PROTOCOL_NORMAL) p_WitDelaymsFunc(1);
|
||||
else ;
|
||||
if(WitWriteReg(BANDWIDTH, uiBaudWidth) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
return WIT_HAL_OK;
|
||||
}
|
||||
@@ -478,7 +471,6 @@ int32_t WitSetOutputRate(int32_t uiRate)
|
||||
if(WitWriteReg(KEY, KEY_UNLOCK) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
if(s_uiProtoclo == WIT_PROTOCOL_MODBUS) p_WitDelaymsFunc(20);
|
||||
else if(s_uiProtoclo == WIT_PROTOCOL_NORMAL) p_WitDelaymsFunc(1);
|
||||
else ;
|
||||
if(WitWriteReg(RRATE, uiRate) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
return WIT_HAL_OK;
|
||||
}
|
||||
@@ -493,7 +485,6 @@ int32_t WitSetContent(int32_t uiRsw)
|
||||
if(WitWriteReg(KEY, KEY_UNLOCK) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
if(s_uiProtoclo == WIT_PROTOCOL_MODBUS) p_WitDelaymsFunc(20);
|
||||
else if(s_uiProtoclo == WIT_PROTOCOL_NORMAL) p_WitDelaymsFunc(1);
|
||||
else ;
|
||||
if(WitWriteReg(RSW, uiRsw) != WIT_HAL_OK) return WIT_HAL_ERROR;
|
||||
return WIT_HAL_OK;
|
||||
}
|
||||
|
||||
Reference in new issue
Block a user