STM32二轴陀螺仪云台

基于stm32c8t6和mpu6050的三轴云台控制 材料清单: 降压模块 OLED 屏幕 按键 舵机 开发板 MPU-6050 实验概述: 将MPU-6050采集到的数据转换成欧拉角,并用OLED 屏幕显示;三轴云台与MPU-6050之间形成闭环控制系统,达成一个简单的平衡系统 舵机控制 舵机主要由可变宽度的脉冲来进行控制,控制线是用来传送脉冲的。脉冲的参数有最小值,最大值,和频率。一般而言,舵机的基准信号都是周期为20ms,宽度为1.5ms。这个基准信号定义的位置为中间位置(也就是90°)。舵机有最大转动角度,中间位置的定义就是从这个位置到最大角度与最小角 阅读详情

基于STM32F103C8T6最小核心板设计的二轴陀螺仪云台,基于江协科技的中断和OLED例程基础上改进而成的。

江协科技的个人空间-江协科技个人主页-哔哩哔哩视频

省流版:网盘分享的文件:定时器云台.rar
链接: https://pan.baidu.com/s/14EF_TK2dO8duZfw14ER-gg?pwd=s9cg 提取码: s9cg

可以直接去获取。

本项目设计的硬件部分有,MPU6050模块、两个SG90_180度舵机、OLED(IIC协议)屏幕

屏幕主要是输出MPU6050模块的X和Y的倾斜角度,用于观察和调试。

本程序获取MPU6050的以及舵机的驱动,都是在中断里面完成的,不会阻塞主程序,这也方便我们去拓展其他的功能,比如把舵机换成步进电机,添加新的传感器等,方便后续的拓展,当然,程序也采用模块化,方便我们去做移植。

舵机采用PWM驱动,另外说一下,舵机得靠5V驱动这一点注意一下,两个舵机的信号线分别连接了STM32的PA0和PA1引脚,连接舵机的为淘宝购买的舵机打印套件。

首先让我们来看一下时钟开启部分

void Timer_Init(void)
{
	//开启TIM2 时钟
	RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);
	//开启 GPIOA 时钟
	RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE);
	
	TIM_InternalClockConfig(TIM2);
	
	TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure;
	TIM_TimeBaseInitStructure.TIM_ClockDivision = TIM_CKD_DIV1;
	TIM_TimeBaseInitStructure.TIM_CounterMode = TIM_CounterMode_Up;
	TIM_TimeBaseInitStructure.TIM_Period = 100000 - 1;
	TIM_TimeBaseInitStructure.TIM_Prescaler = 72 - 1;
	TIM_TimeBaseInitStructure.TIM_RepetitionCounter = 0;
	TIM_TimeBaseInit(TIM2, &TIM_TimeBaseInitStructure);
	
	TIM_ClearFlag(TIM2, TIM_FLAG_Update);
	TIM_ITConfig(TIM2, TIM_IT_Update, ENABLE);
	
//nvic	
	NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
	
	NVIC_InitTypeDef NVIC_InitStructure;
	NVIC_InitStructure.NVIC_IRQChannel = TIM2_IRQn;
	NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
	NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 2;
	NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;
	NVIC_Init(&NVIC_InitStructure);
	
	TIM_Cmd(TIM2, ENABLE);
}

开启TIM2 时钟和开启 GPIOA 时钟,当然可以根据自己的需求去更改时钟和引脚,但要提前去查看STM32的引脚分布和复用功能。

void GPIO_Config_PWM(void)
{
	//引脚配置
    GPIO_InitTypeDef GPIO_InitStructure;

    // 配置 A0 引脚(TIM2_CH1)
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_Init(GPIOA, &GPIO_InitStructure);

    // 配置 A1 引脚(TIM2_CH2)
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1;
    GPIO_Init(GPIOA, &GPIO_InitStructure);	
}

void TIM2_PWM_Config(void)
{
    TIM_OCInitTypeDef TIM_OCInitStructure;

    // 配置 TIM2_CH1 为 PWM 模式(对应舵机 1 的 A0 引脚)
    TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;
    TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;
    TIM_OCInitStructure.TIM_Pulse = 0;  // 初始占空比为 0
    TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;
    TIM_OC1Init(TIM2, &TIM_OCInitStructure);
    TIM_OC1PreloadConfig(TIM2, TIM_OCPreload_Enable);

    // 配置 TIM2_CH2 为 PWM 模式(对应舵机 2 的 A1 引脚)
    TIM_OCInitStructure.TIM_Pulse = 0;
    TIM_OC2Init(TIM2, &TIM_OCInitStructure);
    TIM_OC2PreloadConfig(TIM2, TIM_OCPreload_Enable);
}

这里设置对应的引脚模式以及开启PWM的模式,这样一来,时钟和PWM部分就完成了,接下来让我们来看一下舵机驱动部分

#include "stm32f10x.h"                  // Device header
#include "Timer.h"


void Servo_Init(void)
{
	Timer_Init();
	GPIO_Config_PWM();
	TIM2_PWM_Config();
}

void Set_Servo_Angles(float angleX, float angleY)
{
	uint16_t pulse_widthX,pulse_widthY;
	//X舵机计算(A0)
	pulse_widthX = (500 + ((2500 - 500) * angleX / 180));
	TIM_SetCompare1(TIM2,pulse_widthX);
	//Y舵机计算(A1)
	pulse_widthY = (500 + ((2500 - 500) * (angleY+90) / 180));
	TIM_SetCompare2(TIM2,pulse_widthY);
}

注意,这里要提前引用Timer定时中断的头文件,防止后续编译的报错,第一部分就是初始化,第二部分就是通过传入的float的值来让舵机做出对应的驱动,值得注意的是,我这里的Y舵机,初始让处于中间的位置,所以在angle Y中加入了90的相位,这样可以保证Y舵机的左右转向,然后舵机函数传入的数值,是去捕获陀螺仪获取的,这里因为我们侧重讲的舵机方面,所以陀螺仪部分就先不侧重讲述,后续再看(挖坑中。。。。),这里我们会引用会调用就行,也可去看看江协科技里面讲陀螺仪部分的视频[10-2] MPU6050简介_哔哩哔哩_bilibili,我这里,做了一部分的改进,因为我们是想通过中断的方式去捕获这个数值,所以我在这选择再封装一个函数,

void MPU6050_GetData(int16_t *AccX, int16_t *AccY, int16_t *AccZ, 
						int16_t *GyroX, int16_t *GyroY, int16_t *GyroZ)
{
	uint8_t DataH, DataL;								//定义数据高8位和低8位的变量
	
	DataH = MPU6050_ReadReg(MPU6050_ACCEL_XOUT_H);		//读取加速度计X轴的高8位数据
	DataL = MPU6050_ReadReg(MPU6050_ACCEL_XOUT_L);		//读取加速度计X轴的低8位数据
	*AccX = (DataH << 8) | DataL;						//数据拼接,通过输出参数返回
	
	DataH = MPU6050_ReadReg(MPU6050_ACCEL_YOUT_H);		//读取加速度计Y轴的高8位数据
	DataL = MPU6050_ReadReg(MPU6050_ACCEL_YOUT_L);		//读取加速度计Y轴的低8位数据
	*AccY = (DataH << 8) | DataL;						//数据拼接,通过输出参数返回
	
	DataH = MPU6050_ReadReg(MPU6050_ACCEL_ZOUT_H);		//读取加速度计Z轴的高8位数据
	DataL = MPU6050_ReadReg(MPU6050_ACCEL_ZOUT_L);		//读取加速度计Z轴的低8位数据
	*AccZ = (DataH << 8) | DataL;						//数据拼接,通过输出参数返回
	
	DataH = MPU6050_ReadReg(MPU6050_GYRO_XOUT_H);		//读取陀螺仪X轴的高8位数据
	DataL = MPU6050_ReadReg(MPU6050_GYRO_XOUT_L);		//读取陀螺仪X轴的低8位数据
	*GyroX = (DataH << 8) | DataL;						//数据拼接,通过输出参数返回
	
	DataH = MPU6050_ReadReg(MPU6050_GYRO_YOUT_H);		//读取陀螺仪Y轴的高8位数据
	DataL = MPU6050_ReadReg(MPU6050_GYRO_YOUT_L);		//读取陀螺仪Y轴的低8位数据
	*GyroY = (DataH << 8) | DataL;						//数据拼接,通过输出参数返回
	
	DataH = MPU6050_ReadReg(MPU6050_GYRO_ZOUT_H);		//读取陀螺仪Z轴的高8位数据
	DataL = MPU6050_ReadReg(MPU6050_GYRO_ZOUT_L);		//读取陀螺仪Z轴的低8位数据
	*GyroZ = (DataH << 8) | DataL;						//数据拼接,通过输出参数返回
}

void MPU6050_Tick(void)
{
	MPU6050_GetData(&AX, &AY, &AZ, &GX, &GY, &GZ);
}

通过MPU6050_Tick函数,去获取这个数值,然后让变量的值通过extern的方式,可以让其他文件可以直接调用

void TIM2_IRQHandler(void)
{
	if (TIM_GetITStatus(TIM2, TIM_IT_Update) == SET)
	{
		MPU6050_Tick();
		Set_Servo_Angles(AngleX, AngleY);
		TIM_ClearITPendingBit(TIM2, TIM_IT_Update);
	}
}

主函数中,我们通过中断的方式去掉用陀螺仪的数值以及去驱动舵机,主函数需要去实现显示的功能,这样一来不会阻塞主程序,这里我们通过i++的形式,来观察,主函数的状态

#include "Delay.h"
#include "OLED.h"
#include "LED.h"
#include "Key.h"
#include "MPU6050.h"
#include "Servo.h"

uint8_t KeyNum;
uint16_t i;

float AngleX,AngleY;

int main(void)
{
	OLED_Init();
	Key_Init();
	MPU6050_Init();
	Servo_Init();

	OLED_ShowString(0,0,"i:",OLED_8X16);
	OLED_ShowString(0,15,"X:",OLED_8X16);
	OLED_ShowString(0,31,"Y:",OLED_8X16);	
	
	while (1)
	{
		OLED_ShowNum(15,0,i++,6,OLED_8X16);
		OLED_ShowSignedNum(16, 15,AngleX,5,OLED_8X16);
		OLED_ShowSignedNum(16, 31,AngleY,5,OLED_8X16);
		OLED_Update();
		if(AX<0)AX=0;
		if(AY>1800)AY=1800;
		if(AY<-900)AY=-900;
		AngleX = AX/10;
		AngleY = AY/10;//下舵机		
	}
}

在实际的运行时,我们发现并不会阻塞主函数,这样一来,我们这给例程就可以进行拓展了。

最后,感谢你能看到这里,因为这个项目也是突发奇想的,可能有很多不足的地方以及没完善的地方,希望能多多指正,下面是本套案例的全套代码

网盘分享的文件:定时器云台.rar
链接: https://pan.baidu.com/s/14EF_TK2dO8duZfw14ER-gg?pwd=s9cg 提取码: s9cg

三轴云台稳定控制算法实战解析 本文深入解析三轴云台稳定控制算法的核心原理与实战应用。通过剖析陀螺仪、编码器等关键传感器数据融合,详细讲解PID控制算法及其改进策略(如模糊PID)的实现细节,并结合STM32平台提供具体代码示例与调优方法,助力开发者提升云台在动态环境中的稳定性能。 阅读详情

相关推荐

STM32ZET6二轴云台精确控制实践

STM32ZET6开发板是基于STMicroelectronics的高性能STM32F103ZET6微控制器。其核心是一个ARM Cortex-M3内核,运行频率为72MHz,这使得它能快速响应各种复杂的应用需求。此开发板配备了丰富的外围设备,如USB接口、多种通信接口(包括CAN和UART)和足够的GPIO端口,使其可以方便地与其他硬件组件连接。二轴云台控制系统是一个典型的机电一体化系统,它由硬件和软件两个部分组成。

weixin_42511373的博客 1640

【毕业设计】基于STM32及OpenMV的云台追踪装置

【毕业设计】基于STM32及OpenMV的云台追踪装置摘 要摘 要二级目录三级目录 摘 要 本文通过OpenMV作为是识别模块去识别被测物体(以红色小球为例),当其识别到红色小球后,判断小球中心点所在的区域信息,并将其区域标志位通过串口发送给STM32,当STM32接收到位置信息后对x轴、y轴的两个舵机参数进行操作,最后通过定时器输出合适的PWM波,控制舵机旋转相应的角度,使OpenMV摄像头对准被测物体,以实现物体追踪功能。 实现效果 我会把我做该毕业设计的整体思路以及部分的主要代码在文章中详细介绍

JIE15164031299的博客 6万+

卡尔曼滤波在STM32与MPU6050姿态解算中的工程实战

在嵌入式系统中,从陀螺仪和加速度计获取原始数据到输出稳定姿态角,多传感器融合是关键一步。卡尔曼滤波通过预测与更新机制动态权衡惯性数据与观测数据,有效抑制噪声并实时估计零偏,是处理六轴传感器噪声问题的经典方法。在STM32这类资源受限的MCU上,通过I2C总线读取MPU6050原始数据并完成姿态解算,已成为平衡车、云台、机械臂等应用中的基础工程实践。文章围绕一套可直接烧录的STM32工程,解析卡尔曼滤波的数学模型、MPU6050驱动配置、采样时序与参数整定技巧,帮助开发者避开I2C锁死、零偏漂移和响应滞后等常

weixin_29189381的博客 59

基于STM32的自由度云台运动姿态控制系统

本文设计了一个基于STM32的二自由度云台姿态控制系统,包含硬件设计和软件实现。硬件部分采用STM32F103作为主控制器,MPU6050传感器测量姿态角,通过PWM控制舵机实现云台运动。软件部分实现了数据采集、PID控制算法和中断服务程序。系统分为程控姿态和恒值姿态两种控制模式,分别适用于飞行器控制和航拍云台稳定。调试结果表明系统响应迅速、抗干扰能力强,实现了预期的运动姿态控制功能。设计方案详细论证了电源系统、控制器选型和执行机构等关键部件的选择依据。

毕业作品网站 9873

SimpleBGC32云台算法解析

本文深入剖析SimpleBGC32开源三轴无刷云台的核心技术,涵盖IMU传感器融合、互补滤波器原理、三环PID控制架构及DShot数字驱动机制,揭示其在嵌入式实时系统中实现高精度稳定控制的工程设计逻辑。

desk3的博客 1143

基于stm32控制的二维电动云台,PWM控制180°

电赛专题,基于stm32控制的二维电动云台,PWM控制180°,

基于STM32和FreeRTOS的智能追光云台(代码开源)

上篇博客,我将FreeRTOS移植到STMF103C8T6上,实现了简单的两个LED灯以不同频率去闪烁的小任务,最近找了个项目练练手,用STM32F103C8T6作为主控,搭载FreeRTOS,制作了一个智能追光云台。

m0_60831979的博客 3142

开源云台--STM32代码

共有三个开源云台代码,有BruGi_050_r217,EvvGC_FW_0.3和SimpleBGC。有需要的可以下载看看,自己找的,我看好多收的积分太多,而且还是不注明哪个开源云台,特别容易造成重复下载,浪费时间,浪费资源。

摇杆+舵机+STM32F103=云台:构建一个简易的云台控制系统

本文介绍如何使用STM32F103微控制器、摇杆和舵机构建简易云台控制系统。通过摇杆输入信号和STM32F103的处理能力,实现云台水平和垂直运动的精确控制。文章涵盖硬件组件、系统架构、软件实现(ADC和PWM初始化、主循环信号处理、舵机位置计算)及调试优化建议(死区处理、角度步长、PWM频率调整)。读者可轻松构建功能完善的云台控制系统,并根据需求进行优化和扩展。

2403_87412718的博客 5331

Simple Bgc 源码 基于STM32的三轴增稳云台开源代码

Simple Bgc 源码 基于STM32的三轴增稳云台开源代码 俄板的开源云台项目 俄板的云台控制板真的挺不错的,不过现在已经不开源了。其在控制器的选型上最近出的几版本都是选用的 STM32 ,不过其最初的 版本也是基于Arduino平台,其中 Arduino 平台的控制板 和 德国云台的硬件方案一样。其详细资料可以在这样看到:

基于stm32的3轴云台开源程序EvvGC

最完整的基于stm32的3轴云台开源程序EvvGC,包含MPU6050检测加速度和陀螺仪,病对3个电机进行控制

STM32传感器模块编程实践(四)舵机+MPU6050陀螺仪模块融合云台模型

就介绍了一个简单的云台模型,采用STM32F103C8T6单片机+舵机+陀螺仪模块,实现一个简易云台,随着陀螺仪模块倾斜多少度,舵机就转动到多少度。

光子物联科技主要介绍STM32单片机,GD32单片机以及各种传感器模块原理以及驱动,适合学生,工程师等学习单片机嵌入式开发、传感器驱动、通信协议等。 4978

一款开源的云台控制程序

基于stm32的云台控制程序,实现了云台的roll,pitch,yaw三方向的控制

基于串级pid控制系统的两轴无人机云台设计

1.云台串级pid思路介绍 2.硬件介绍 3.程序介绍

qq_45512097的博客 7746

数字频率计设计中的常见误区:从VHDL代码到硬件实现的避坑指南

本文深入探讨了数字频率计从VHDL代码到FPGA硬件实现过程中的关键误区与解决方案。重点分析了闸门时间生成的精度与资源平衡、控制时序设计中的竞争冒险规避,以及如何利用EDA工具进行综合、时序约束与调试,确保设计稳定可靠。文章为开发者提供了从仿真成功到硬件可用的实战避坑指南。

spark7igniter的博客 213

osgearth2.10 demo功能介绍

osgearth-2.10 demo: 说明: 1、运行环境win7 x64 旗舰版,CPU i5-6400 8核,8G内存; 2、括号内是对应demo的测试参数(.earth); 3、配置OSG_FILE_PATH; 4、参数命令行可以查看各个demo需要的输入参数; 5、前缀说明:gui界面程序、cmd控制台程序、non功能未知; 6、程序后括号里的non表示不需要通过命令行输入参数; 示例: 1、gui:osgearth_3pv(simple.earth):相机与地球的投影关系,Range表示相机

rach09的专栏 2425

【免费下载】 STorM32 BGC:开源三轴无刷云台控制器

STorM32 BGC 是一款基于 STM32 32 位微控制器的三轴无刷云台控制器板。该项目由 OlliW 设计,最新版本包括 v3.3 和 v4.1。STorM32 BGC 不仅支持多种硬件配置,还提供了丰富的软件资源,包括开源固件和图形用户界面(GUI)。所有硬件设计均遵循 TAPR 开源硬件许可证,确保用户可以自由使用、修改和分发。 ## 项目技术分析 STorM32 BGC 的核心技...

gitblog_01189的博客 2504

Spine动画在Unity里卡顿、闪烁、排序错乱?这些性能优化与渲染问题一次讲清

本文深入解析了Spine动画在Unity中常见的卡顿、闪烁和排序错乱问题,提供了全面的性能优化与渲染解决方案。从性能瓶颈诊断到材质合并、动态合批优化,再到层级错乱与Alpha闪烁的处理,帮助开发者提升动画表现和运行效率。特别针对Unity和Spine的协同工作进行了详细的技术探讨。

weixin_29967445的博客 383

【亲测免费】 开源云台算法STM32程序

开源云台算法STM32程序 【下载地址】开源云台算法STM32程序 本仓库提供了用于STM32平台的开源云台控制代码,专为那些对电子制作、机器人技术或自动控制系统感兴趣的开发者、爱好者设计。该资源集成了MPU6050陀螺仪和加速度计的数据解算,结合PID控制算法,实现高精度的云台稳定控制。适合于无人机、安防摄像头、远程观...

gitblog_09734的博客 983

Eureka常见面试题总结

点击关注我的博客原文 Eureka是Netflix组件的一个子模块,也是核心模块之一。云端服务发现,一个基于 REST 的服务,用于定位服务,以实现云端中间层服务发现和故障转移(来源springcloud中文网的介绍:https://www.springcloud.cc/)。下图总结了Eureka服务端(以下简称服务端)与Eureka客户端(以下简称客户端)之间协同工作的流程: 流程说明:...

u012105931的博客 2万+

C2000ware介绍

C2000的下载安装指南C2000目录。

小柚子的博客 2800

三轴云台之稳定控制技术篇

除了PID控制算法及其改进算法外,三轴云台的控制还可以采用其他策略,如积分分离PID控制算法、遇限削弱积分PID控制算法、不完全微分PID控制算法、微分先行PID控制算法和带死区的PID控制算法等。通过调整比例、积分和微分三个参数,PID控制算法可以实现对云台电机的精确控制,从而消除相机的视轴偏差,使云台保持水平稳定。在三轴云台中,陀螺仪是一种重要的传感器组件,用于实时测量云台电机的速率,从而获取相机的视轴偏差。如摄像头,用于捕捉目标图像,并通过图像处理算法提取目标的特征信息,以实现目标的检测和跟踪。

SKYDROID666的博客 1896

我用C#实现上位机数据一键导出Excel:从乱码到百万行数据秒级导出的实战技巧

ExcelWorksheet worksheet = package.Workbook.Worksheets.Add("日报表");// 1. 标题(合并单元格)worksheet.Cells["A1"].Value = $"产线日报表 -DateTimeNowToString// 2. 表头和数据(同上)worksheet.Cells["A3"].Value = "时间";// ...省略表头和数据填充// 3. 合计行(公式计算)

这里只有干货:从 Modbus 通信到 MES 对接,从 YOLO 训练到工控机部署,带你搞定工业软件开发全流程。 714

基于WT931陀螺仪的云台PID调试

提示:文章写完后,目录可以自动生成,如何生成可参考右边的帮助文档 WT931陀螺仪调试前言一、读取方式二、使用步骤1.引入库2.读入数据总结 前言 这是本人首次使用维特智能WT931的反馈数据去调云台,发现跟使用电机编码器的过程和效果大大不同,特记录一下以供参考 一、读取方式 WT931有2种读取方式,分别是串口和I2C。在使用上位机读取时,使用串口的方式读取;使用STM32读取时,串口和I2C都可以。由于I2C的速度相对较快,所以使用的是I2C。 二、使用步骤 1.引入库 代码如下(示例):

BYS 2022

YOLO26优化:注意力魔改 | 用于微小目标检测的上下文增强和特征细化网络ContextAggregation,助力小目标检测,暴力涨点

用于微小目标检测的上下文增强和特征细化网络ContextAggregation,助力小目标检测

①答疑群聊服务;②YOLO大模型知识问答系统;③计算机视觉论文生成智能体; 492

CAPL未来发展方向展望

通过本文的学习,读者应该对CAPL的未来发展方向有了初步的了解。随着汽车电子系统的不断发展,CAPL也在不断演进,以支持更多的技术和应用场景。希望读者能够通过不断的学习和实践,掌握更多的CAPL技巧,提高自己的开发能力。

闲人编程的博客 1184
上一篇: 基于STM32倒车雷达系统
Eevolution
博客等级 码龄5年 38粉丝 4原创
评论
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付:10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值