当前位置：首页 > news >正文

用STM32F103C8T6和摇杆做个桌面小监控云台（SG90舵机+完整代码）

news 2026/6/11 3:00:58

用STM32F103C8T6打造智能桌面监控云台：从硬件搭建到控制逻辑优化

周末整理工作室时，发现抽屉里闲置的STM32开发板和几个SG90舵机，突然萌生一个想法——何不制作一个桌面监控云台？这个看似简单的小装置，不仅能观察盆栽生长状态，还能作为远程会议的第二视角，甚至监控宠物在家的活动情况。与市面上动辄上千元的专业云台相比，自制方案成本不到百元，却能获得完全定制化的控制体验。

1. 项目规划与硬件选型

1.1 核心组件功能解析

选择STM32F103C8T6作为主控并非偶然。这款被称为"蓝色药丸"的开发板，虽然只有64KB Flash和20KB RAM，但其72MHz的Cortex-M3内核完全能满足实时控制需求。更重要的是，它具备：

12位ADC：精确读取摇杆模拟量
4个通用定时器：其中TIM4可直接生成两路PWM信号
丰富的GPIO：方便扩展其他传感器

SG90舵机的选择也经过深思熟虑。对比常见舵机参数：

型号	扭矩(kg·cm)	工作电压(V)	重量(g)	价格(元)
SG90	1.5	4.8-6.0	9	15-20
MG90S	2.5	4.8-7.2	14	30-40
DS3218	20	6.0-7.4	55	80-100

对于桌面级应用，SG90在价格和性能间取得了完美平衡。虽然扭矩较小，但配合轻量化结构完全够用。

1.2 机械结构设计要点

云台的稳定性很大程度上取决于机械结构。经过多次迭代，我发现这些设计细节至关重要：

重心平衡：摄像头安装位置应尽量靠近旋转中心
减震处理：在舵机与支架间添加橡胶垫减少振动
走线管理：使用螺旋套管整理线材，避免缠绕

一个实用的支架方案是3D打印L型转接件，将两个舵机正交安装。具体尺寸建议：

水平旋转底座：80×80mm平台
垂直旋转支架：高度60mm
摄像头夹持部：适配常见网络摄像头

提示：没有3D打印机？可以用亚克力板激光切割，甚至改造旧玩具的齿轮结构。

2. 电路连接与信号处理

2.1 硬件接口定义

确保所有组件正确连接是项目成功的第一步。具体接线方式：

摇杆模块：
- VRx → PA2 (ADC1_IN2)
- VRy → PA3 (ADC1_IN3)
- +5V → 开发板5V输出
- GND → 共地
舵机控制：
- 舵机1信号线 → PB8 (TIM4_CH3)
- 舵机2信号线 → PB9 (TIM4_CH4)
- 电源建议外接5V/2A适配器

// 引脚功能宏定义 #define JOYSTICK_X_ADC_CHANNEL ADC_Channel_2 #define JOYSTICK_Y_ADC_CHANNEL ADC_Channel_3 #define SERVO_HORIZONTAL_PIN GPIO_Pin_8 #define SERVO_VERTICAL_PIN GPIO_Pin_9

2.2 ADC采样优化技巧

原始代码中ADC采样存在可改进空间。通过以下措施提升响应速度：

启用连续转换模式
增加软件滤波
动态调整采样时间

改进后的ADC初始化代码：

void ADC_Config(void) { ADC_InitTypeDef ADC_InitStructure; ADC_InitStructure.ADC_Mode = ADC_Mode_Independent; ADC_InitStructure.ADC_ScanConvMode = ENABLE; // 启用扫描模式 ADC_InitStructure.ADC_ContinuousConvMode = ENABLE; // 连续转换 ADC_InitStructure.ADC_ExternalTrigConv = ADC_ExternalTrigConv_None; ADC_InitStructure.ADC_DataAlign = ADC_DataAlign_Right; ADC_InitStructure.ADC_NbrOfChannel = 2; ADC_Init(ADC1, &ADC_InitStructure); // 配置采样时间 ADC_RegularChannelConfig(ADC1, JOYSTICK_X_ADC_CHANNEL, 1, ADC_SampleTime_28Cycles5); ADC_RegularChannelConfig(ADC1, JOYSTICK_Y_ADC_CHANNEL, 2, ADC_SampleTime_28Cycles5); ADC_DMACmd(ADC1, ENABLE); // 启用DMA可进一步提升效率 ADC_Cmd(ADC1, ENABLE); ADC_ResetCalibration(ADC1); while(ADC_GetResetCalibrationStatus(ADC1)); ADC_StartCalibration(ADC1); while(ADC_GetCalibrationStatus(ADC1)); ADC_SoftwareStartConvCmd(ADC1, ENABLE); // 启动连续转换 }

3. 控制算法进阶实现

3.1 摇杆死区处理

原始代码直接使用ADC原始值判断方向，实际操作中会发现舵机容易产生抖动。这是因为：

摇杆中立点存在物理偏差
ADC采样存在噪声
人手微小颤动会被放大

引入死区控制后，代码更健壮：

#define DEAD_ZONE 100 // 死区范围 void ProcessJoystick(int16_t x, int16_t y) { static uint8_t lastAngle1 = 90, lastAngle2 = 90; // X轴处理（水平方向） if(x < (2048 - DEAD_ZONE)) { if(lastAngle1 < 180) lastAngle1 += 2; } else if(x > (2048 + DEAD_ZONE)) { if(lastAngle1 > 0) lastAngle1 -= 2; } // Y轴处理（垂直方向） if(y < (2048 - DEAD_ZONE)) { if(lastAngle2 > 0) lastAngle2 -= 2; } else if(y > (2048 + DEAD_ZONE)) { if(lastAngle2 < 180) lastAngle2 += 2; } Set_Servo_Angle(lastAngle1, lastAngle2); }

3.2 运动平滑算法

直接设置舵机角度会导致运动生硬。加入加速度控制后，运动更自然：

typedef struct { uint8_t target; uint8_t current; float velocity; } ServoState; void UpdateServoPosition(ServoState *s) { float error = s->target - s->current; s->velocity += error * 0.01f; // P系数 s->velocity *= 0.9f; // 阻尼系数 // 限幅处理 if(s->velocity > 2.0f) s->velocity = 2.0f; if(s->velocity < -2.0f) s->velocity = -2.0f; s->current += (uint8_t)s->velocity; } // 在主循环中调用 ServoState servoX = {90, 90, 0}; ServoState servoY = {90, 90, 0}; void MainLoop() { // ...读取摇杆值 servoX.target = newXAngle; servoY.target = newYAngle; UpdateServoPosition(&servoX); UpdateServoPosition(&servoY); Set_Servo_Angle(servoX.current, servoY.current); delay_ms(20); }

4. 功能扩展与实用技巧

4.1 预设位功能实现

为方便快速定位，可添加三个预设位置：

归中位：(90°, 90°) 默认视角
左视位：(30°, 75°) 观察左侧
右视位：(150°, 75°) 观察右侧

通过按键切换预设位：

#define PRESET_COUNT 3 const uint8_t presets[PRESET_COUNT][2] = { {90, 90}, // 预设1 {30, 75}, // 预设2 {150, 75} // 预设3 }; uint8_t currentPreset = 0; void SwitchPreset() { currentPreset = (currentPreset + 1) % PRESET_COUNT; servoX.target = presets[currentPreset][0]; servoY.target = presets[currentPreset][1]; }

4.2 手机蓝牙控制方案

想摆脱线材束缚？添加HC-05蓝牙模块即可实现手机控制：

硬件连接：
- TXD → PA10 (USART1_RX)
- RXD → PA9 (USART1_TX)
- VCC → 3.3V
- GND → GND
协议设计示例：
- 'L'：向左转
- 'R'：向右转
- 'U'：向上转
- 'D'：向下转
- 'C'：归中

串口中断处理代码：

void USART1_IRQHandler(void) { if(USART_GetITStatus(USART1, USART_IT_RXNE)) { uint8_t cmd = USART_ReceiveData(USART1); switch(cmd) { case 'L': servoX.target -= 10; break; case 'R': servoX.target += 10; break; case 'U': servoY.target -= 10; break; case 'D': servoY.target += 10; break; case 'C': servoX.target = 90; servoY.target = 90; break; } // 限幅保护 if(servoX.target > 180) servoX.target = 180; if(servoX.target < 0) servoX.target = 0; if(servoY.target > 180) servoY.target = 180; if(servoY.target < 0) servoY.target = 0; } }