使用电位器控制舵机

// UnityMbed — 使用电位器（ADC）实时控制舵机 @ N32G031
#include "n32g031.h"
#include "n32g031_gpio.h"
#include "n32g031_rcc.h"
#include "n32g031_adc.h"
#include "n32g031_usart.h"
#include <stdio.h>

/* ====================================================================
 * [硬件配置区]
 * ==================================================================== */
#define PULSE_MIN     2250
#define PULSE_MAX     5500
#define KNOB_MAX      4095

/* 简单的软件延时循环 */
void Delay_Loop(volatile uint32_t count) {
  while(count--) { __NOP(); }
}

/* 用于抑制传感器噪声的卡尔曼滤波函数（一维简化卡尔曼滤波） */
float kalman_update(float measurement, float* state, float* pc) {
  float k_gain = *pc / (*pc + 0.1f);     // 0.1 为 R（测量噪声）
  *pc = (1.0f - k_gain) * (*pc) + 0.01f; // 0.01 为 Q（过程噪声）
  *state = *state + k_gain * (measurement - *state);
  return *state;
}

/* 初始化 PA0 上的电位器 ADC（ADC 通道 0） */
void Setup_Knob(void) {
  RCC_EnableAPB2PeriphClk(RCC_APB2_PERIPH_GPIOA, ENABLE);
  RCC_EnableAHBPeriphClk(RCC_AHB_PERIPH_ADC, ENABLE);

  GPIO_InitType GPIO_InitStructure;
  GPIO_InitStruct(&GPIO_InitStructure);
  GPIO_InitStructure.Pin = GPIO_PIN_0;
  GPIO_InitStructure.GPIO_Mode = GPIO_MODE_ANALOG;
  GPIO_InitPeripheral(GPIOA, &GPIO_InitStructure);

  ADC_InitType ADC_InitStructure;
  ADC_InitStruct(&ADC_InitStructure);
  ADC_InitStructure.MultiChEn      = DISABLE;
  ADC_InitStructure.ContinueConvEn = DISABLE;
  ADC_InitStructure.ExtTrigSelect  = ADC_EXT_TRIGCONV_NONE;
  ADC_InitStructure.DatAlign       = ADC_DAT_ALIGN_R;
  ADC_InitStructure.ChsNumber      = 1;
  ADC_Init(ADC, &ADC_InitStructure);
  ADC_Enable(ADC, ENABLE);
}

/* 将 PA9 配置为 USART1 TX，用于向串口监视器发送数据 */
void Setup_UART(void) {
  RCC_EnableAPB2PeriphClk(RCC_APB2_PERIPH_GPIOA | RCC_APB2_PERIPH_USART1, ENABLE);

  GPIO_InitType GPIO_InitStructure;
  GPIO_InitStruct(&GPIO_InitStructure);
  GPIO_InitStructure.Pin            = GPIO_PIN_9;
  GPIO_InitStructure.GPIO_Mode      = GPIO_MODE_AF_PP;
  GPIO_InitStructure.GPIO_Alternate = GPIO_AF4_USART1;
  GPIO_InitPeripheral(GPIOA, &GPIO_InitStructure);

  USART_InitType USART_InitStructure;
  USART_InitStructure.BaudRate            = 115200;
  USART_InitStructure.WordLength          = USART_WL_8B;
  USART_InitStructure.StopBits            = USART_STPB_1;
  USART_InitStructure.Parity              = USART_PE_NO;
  USART_InitStructure.HardwareFlowControl = USART_HFCTRL_NONE;
  USART_InitStructure.Mode                = USART_MODE_TX;
  USART_Init(USART1, &USART_InitStructure);

  USART_Enable(USART1, ENABLE);
}

/* 读取电位器旋钮的模拟值（返回 0 至 4095） */
uint32_t Read_Knob(void) {
  ADC_ConfigRegularChannel(ADC, ADC_CH_0, 1, ADC_SAMP_TIME_56CYCLES5);
  ADC_EnableSoftwareStartConv(ADC, ENABLE);
  while(ADC_GetFlagStatus(ADC, ADC_FLAG_ENDC) == RESET);
  ADC_ClearFlag(ADC, ADC_FLAG_ENDC);
  return ADC_GetDat(ADC);
}

/* 通过 UART 逐字符发送字符串 */
void UART_SendString(const char* str) {
  while(*str) {
      USART_SendData(USART1, (uint8_t)*str++);
      while (USART_GetFlagStatus(USART1, USART_FLAG_TXDE) == RESET);
  }
}

/* 向舵机发送控制信号脉冲 */
void Servo_Step(uint32_t pulse_width) {
  GPIO_SetBits(GPIOA, GPIO_PIN_1);
  Delay_Loop(pulse_width);
  GPIO_ResetBits(GPIOA, GPIO_PIN_1);
  Delay_Loop(100000);
}

/* ====================================================================
 * 主应用循环
 * ==================================================================== */
int main(void) {
  /* --- 1. 系统初始化 --- */
  Setup_UART();
  UART_SendString("\r\n[DEBUG] UART 初始化完成，接线正确。\r\n");

  Setup_Knob();
  UART_SendString("[DEBUG] ADC 初始化完成，正在读取基准值……\r\n");

  // 将舵机控制引脚 PA1 初始化为推挽输出
  GPIO_InitType GPIO_InitStructure;
  GPIO_InitStruct(&GPIO_InitStructure);
  GPIO_InitStructure.Pin = GPIO_PIN_1;
  GPIO_InitStructure.GPIO_Mode = GPIO_MODE_OUTPUT_PP;
  GPIO_InitPeripheral(GPIOA, &GPIO_InitStructure);

  /* --- 2. 变量设置 --- */
  uint32_t raw_knob = 0;
  uint32_t target_pulse = PULSE_MIN;

  // 读取初始基准值，防止舵机启动时抖动
  float k_state = (float)Read_Knob();
  float k_pc = 0.0f;

  char msg_buffer[64];
  uint32_t print_counter = 0; // 用于限制 UART 输出频率

  UART_SendString("系统初始化完成，开始控制舵机……\r\n");

  /* --- 3. 主控制循环 --- */
  while(1) {
      // 步骤 A：读取电位器的原始模拟值
      raw_knob = Read_Knob();

      // 步骤 B：使用卡尔曼滤波器消除电气噪声和抖动
      kalman_update((float)raw_knob, &k_state, &k_pc);

      // 步骤 C：将滤波后的 ADC 值（0–4095）映射为舵机脉宽（2250–5500）
      // 注意：此处使用反向计算（PULSE_MAX - ...），以匹配旋钮的实际转动方向
      target_pulse = PULSE_MAX - (((uint32_t)k_state * (PULSE_MAX - PULSE_MIN)) / KNOB_MAX);

      // 步骤 D：发送计算出的脉冲以驱动舵机
      Servo_Step(target_pulse);

      // 步骤 E：向串口监视器输出遥测数据（每 50 次循环输出一次，避免信息过多）
      if (++print_counter >= 50) {
          sprintf(msg_buffer, "原始 ADC： %4lu | 滤波后： %4d | 脉冲： %4lu\r\n",
                  raw_knob, (int)k_state, target_pulse);
          UART_SendString(msg_buffer);
          print_counter = 0; // 重置计数器
      }
  }
}