当前位置: 首页 > ai >正文

基于 STM32 的四路 PWM 控制智能小车运动的模块化控制程序

今天简单实现一下,智能小车的运动模块程序.

实现小车的前进,后退,转向,就是通过电机IO口输出PWM,控制电机转速,实现上述功能.

主函数

#include "stm32f10x.h"                  // Device header
#include "Delay.h"
#include "car.h"
#include "Key.h"uint8_t i;int main(void)
{
robot_Init();    // 机器人初始化
Key_Init();      // 按键初始化while (1){
if(Key_GetNum() == 1){makerobo_run(70,5000);//前进1Smakerobo_brake(500);//停止0.5Smakerobo_back(70,5000); //后退1s}}
}

key.c函数详解

#include "stm32f10x.h"                  // Device header
#include "Delay.h"void Key_Init(void)
{
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE);GPIO_InitTypeDef GPIO_InitStructure;GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;GPIO_InitStructure.GPIO_Pin = GPIO_Pin_15;GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_Init(GPIOA, &GPIO_InitStructure);
}uint8_t Key_GetNum(void)
{
uint8_t KeyNum = 0;
if (GPIO_ReadInputDataBit(GPIOA, GPIO_Pin_15) == 0){
Delay_ms(20);
while (GPIO_ReadInputDataBit(GPIOA, GPIO_Pin_15) == 0);
Delay_ms(20);KeyNum = 1;}
return KeyNum;
}

首先将PA15初始化为上拉输入模式

按键的逻辑:

  • 你只有在:“检测到按下 → 消抖 → 等待松开 → 再次消抖”完成之后,才会返回 1
  • 如果你一直按住按键,这个函数的 while 会阻塞,直到你松开才结束。

PWM.函数详解

#include "stm32f10x.h"                  // Device headervoid PWM_Init(void)
{GPIO_InitTypeDef GPIO_InitStructure;TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;TIM_OCInitTypeDef TIM_OCInitStructure;//使能定时器TIM4时钟,注意TIM4时钟为APB1RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE);//使能PWM输出GPIO时钟RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB , ENABLE); GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6;//定时器TIM4的PWM输出通道1,TIM4_CH1GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;//复用推挽输出GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;GPIO_Init(GPIOB, &GPIO_InitStructure);//初始化GPIOGPIO_InitStructure.GPIO_Pin = GPIO_Pin_7;//定时器TIM4的PWM输出通道2,TIM4_CH2GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;//复用推挽输出GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;GPIO_Init(GPIOB, &GPIO_InitStructure);//初始化GPIOGPIO_InitStructure.GPIO_Pin = GPIO_Pin_8;//定时器TIM4的PWM输出通道3,TIM4_CH3GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;//复用推挽输出GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;GPIO_Init(GPIOB, &GPIO_InitStructure);//初始化GPIOGPIO_InitStructure.GPIO_Pin = GPIO_Pin_9;//定时器TIM4的PWM输出通道4,TIM4_CH4GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;//复用推挽输出GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;GPIO_Init(GPIOB, &GPIO_InitStructure);//初始化GPIOTIM_TimeBaseStructure.TIM_Period = 100 - 1;//arr;//自动重装值TIM_TimeBaseStructure.TIM_Prescaler =36 - 1;//psc; //时钟预分频数TIM_TimeBaseStructure.TIM_ClockDivision = 0;TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;//TIM向上计数模式TIM_TimeBaseInit(TIM4, &TIM_TimeBaseStructure); //初始化TIM4//初始化TIM4_CH1的PWM模式TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;//??PWM??1TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;//??????TIM_OCInitStructure.TIM_Pulse = 0; //TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;//??????TIM_OC1Init(TIM4, &TIM_OCInitStructure);//???TIM4_CH1//初始化TIM4_CH2的PWM模式TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;TIM_OCInitStructure.TIM_Pulse = 0;TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;//TIM4_CH2初始化,OC2TIM_OC2Init(TIM4, &TIM_OCInitStructure);//初始化TIM4_CH3的PWM模式TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;TIM_OCInitStructure.TIM_Pulse = 0;TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;TIM_OC3Init(TIM4, &TIM_OCInitStructure);//初始化TIM4_CH4的PWM模式TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;TIM_OCInitStructure.TIM_Pulse = 0;TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;TIM_OC4Init(TIM4, &TIM_OCInitStructure);//使能4个通道的预装载寄存器TIM_OC1PreloadConfig(TIM4, TIM_OCPreload_Enable);//OC1TIM_OC2PreloadConfig(TIM4, TIM_OCPreload_Enable);//OC2TIM_OC3PreloadConfig(TIM4, TIM_OCPreload_Enable);//OC3TIM_OC4PreloadConfig(TIM4, TIM_OCPreload_Enable);//OC4TIM_ARRPreloadConfig(TIM4, ENABLE); //使能重装寄存器TIM_Cmd(TIM4, ENABLE);//使能定时器TIM4,准备工作 
}

这段代码是 STM32 上使用 定时器 TIM4 产生 四路 PWM 信号 的完整初始化过程。用于控制四个电机通道

分段详解

① 开启时钟


RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE);       // 开启 TIM4 时钟RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);      // 开启 GPIOB 时钟
  • TIM4 属于 APB1 总线外设,需要使能其时钟。
  • GPIOB 属于 APB2 总线外设,也要开启时钟。

② 初始化 GPIO:PB6~PB9 为复用推挽输出


GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;  // 复用功能推挽输出(用于 PWM)GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; // I/O 速度选择为 50MHz

然后四次初始化:

  • GPIO_Pin_6:对应 TIM4_CH1
  • GPIO_Pin_7:对应 TIM4_CH2
  • GPIO_Pin_8:对应 TIM4_CH3
  • GPIO_Pin_9:对应 TIM4_CH4

🧠 PWM 信号必须由“复用功能引脚”输出。


③ 配置定时器基本参数(频率、模式)

TIM_TimeBaseStructure.TIM_Period = 100 - 1;//arr;//自动重装值
TIM_TimeBaseStructure.TIM_Prescaler =36 - 1;//psc; //时钟预分频数
TIM_TimeBaseStructure.TIM_ClockDivision = 0;
TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;//TIM向上计数模式
TIM_TimeBaseInit(TIM4, &TIM_TimeBaseStructure); //初始化TIM4

计数频率计算公式:

PWM计数频率 = 主频 / (PSC + 1) = 72MHz / 36 = 2MHz
PWM输出频率 = 计数频率 / (ARR + 1) = 2MHz / 100 = 20KHz

即:输出一个周期为 20KHz 的 PWM 波形,占空比由后面设置的 CCR 值决定。


④ 配置每个通道的 PWM 模式(4次)


TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;       // PWM 模式1TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; // 输出使能TIM_OCInitStructure.TIM_Pulse = 0;                       // 初始脉宽占空比 = 0%TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;   // 高电平有效

然后依次配置:

  • TIM_OC1Init(TIM4, &TIM_OCInitStructure);:CH1(PB6)
  • TIM_OC2Init(...):CH2(PB7)
  • TIM_OC3Init(...):CH3(PB8)
  • TIM_OC4Init(...):CH4(PB9)

⑤ 使能预装载寄存器(可动态更新 PWM)


TIM_OC1PreloadConfig(TIM4, TIM_OCPreload_Enable);TIM_OC2PreloadConfig(TIM4, TIM_OCPreload_Enable);TIM_OC3PreloadConfig(TIM4, TIM_OCPreload_Enable);TIM_OC4PreloadConfig(TIM4, TIM_OCPreload_Enable);TIM_ARRPreloadConfig(TIM4, ENABLE);  // 使能自动重装载寄存器

预装载作用:

  • 修改 PWM 占空比不会立刻生效,而是到下一个计数周期才会更新,防止中间跳变问题

⑥ 启动定时器


TIM_Cmd(TIM4, ENABLE);

TIM4 开始工作,四路 PWM 信号就开始输出了!

智能小车的运动控制函数

就是控制智能小车的四个电机通道的PWM,控制小车的前进,转向,后退

#include "stm32f10x.h"                  // Device header
#include "PWM.h"
#include "Delay.h"
// 机器人初始化
void robot_Init(void)
{PWM_Init(); 
}//四路PWM控制速度调节
void robot_speed(uint8_t left1_speed,uint8_t left2_speed,uint8_t right1_speed,uint8_t right2_speed)
{	TIM_SetCompare1(TIM4,left1_speed);TIM_SetCompare2(TIM4,left2_speed);TIM_SetCompare3(TIM4,right1_speed);TIM_SetCompare4(TIM4,right2_speed);
}// 基本的运动函数
// 机器人前进
void makerobo_run(int8_t speed,uint16_t time)  //前进函数
{if(speed > 100){speed = 100;}if(speed < 0){speed = 0;}robot_speed(speed,0,speed,0);Delay_ms(time);                 // 时间为毫秒robot_speed(0,0,0,0);           // 机器人停止}void makerobo_brake(uint16_t time) //刹车函数
{
robot_speed(0,0,0,0);     // 电机停止 
Delay_ms(time);          // 时间为毫秒   
}void makerobo_Left(int8_t speed,uint16_t time) //左转函数
{if(speed > 100){speed = 100;}
if(speed < 0){speed = 0;}robot_speed(0,0,speed,0);Delay_ms(time);                 //时间为毫秒  robot_speed(0,0,0,0);           // 机器人停止}void makerobo_Spin_Left(int8_t speed,uint16_t time) //左旋转函数
{if(speed > 100){speed = 100;}if(speed < 0){speed = 0;}  robot_speed(0,speed,speed,0);Delay_ms(time);                    //时间为毫秒 robot_speed(0,0,0,0);           // 机器人停止			
}void makerobo_Right(int8_t speed,uint16_t time) //右转函数
{if(speed > 100){speed = 100;}if(speed < 0){speed = 0;}robot_speed(speed,0,0,0);Delay_ms(time);                 //时间为毫秒  robot_speed(0,0,0,0);           // 机器人停止}void makerobo_Spin_Right(int8_t speed,uint16_t time) //右旋转函数
{if(speed > 100){speed = 100;}if(speed < 0){speed = 0;}  robot_speed(speed,0,0,speed);Delay_ms(time);                    //时间为毫秒 robot_speed(0,0,0,0);           // 机器人停止			
}void makerobo_back(int8_t speed,uint16_t time)  //后退函数
{if(speed > 100){speed = 100;}if(speed < 0){speed = 0;}robot_speed(0,speed,0,speed);Delay_ms(time);                 // 时间为毫秒robot_speed(0,0,0,0);           // 机器人停止}

分段详解

一、初始化函数

void robot_Init(void)

PWM_Init();   
// 调用 PWM 初始化函数(定义在 PWM.c 中)

作用:配置好 TIM4 输出四路 PWM,控制机器人四个电机的速度。


二、电机速度设置函数

robot_speed(uint8_t left1_speed,uint8_t left2_speed,uint8_t right1_speed,uint8_t right2_speed)TIM_SetCompare1(TIM4,left1_speed);   // 设置PWM通道1输出占空比TIM_SetCompare2(TIM4,left2_speed);   // 设置PWM通道2TIM_SetCompare3(TIM4,right1_speed);  // 设置PWM通道3TIM_SetCompare4(TIM4,right2_speed);  // 设置PWM通道4

控制四个电机的转动速度,分别为:

left1 左前

left2 左后

right1 右前

right2 右后


三、基本运动函数

makerobo_run(int8_t speed,uint16_t time)
—— 前进
robot_speed(speed,0, speed,0);// 左前电机和右前电机正转
Delay_ms(time);// 持续运动一段时间
robot_speed(0,0,0,0);// 停止运动


makerobo_back(int8_t speed,uint16_t time)
—— 后退
robot_speed(0, speed,0, speed);// 左后、右后电机正转,实现后退
Delay_ms(time);
robot_speed(0,0,0,0);


makerobo_Left(int8_t speed,uint16_t time)
—— 向左转弯
robot_speed(0,0, speed,0);// 仅右前电机动,车向左偏转
Delay_ms(time);
robot_speed(0,0,0,0);


makerobo_Right(int8_t speed,uint16_t time)
—— 向右转弯
robot_speed(speed,0,0,0);// 仅左前电机动,车向右偏转
Delay_ms(time);robot_speed(0,0,0,0);


四、原地旋转函数

makerobo_Spin_Left(int8_t speed,uint16_t time) —— 原地左旋转
robot_speed(0, speed, speed,0);// 左后电机反转(速度为正,装反电源),右前电机正转
// 实现两边相反转动,原地逆时针旋转
Delay_ms(time);
robot_speed(0,0,0,0);


makerobo_Spin_Right(int8_t speed, uint16_t time) —— 原地右旋转
robot_speed(speed,0,0, speed);// 左前、右后电机正转,原地顺时针旋转
Delay_ms(time);
robot_speed(0,0,0,0);


五、刹车函数

makerobo_brake(uint16_t time)
robot_speed(0, 0, 0, 0); 
// 所有电机停止
Delay_ms(time);          
// 刹车等待时间

http://www.xdnf.cn/news/12512.html

相关文章:

  • PDF图片和表格等信息提取开源项目
  • FastAPI安全机制:从OAuth2到JWT的魔法通关秘籍
  • Web前端基础:JavaScript
  • C++字符串解析2
  • yolov11与双目测距结合,实现目标的识别和定位测距(onnx版本)
  • Docker、Wsl 打包迁移环境
  • |从零开始的Pyside2界面编程| 用Pyside2打造一个AI助手界面
  • pycharm 中文字体报错
  • 从零开始搭建 Pytest 测试框架(Python 3.8 + PyCharm 版)
  • Android Studio 解决首次安装时下载 Gradle 慢问题
  • spring中的@RabbitListener注解详解
  • C++设计模式 - 单例模式
  • Python Copilot【代码辅助工具】 简介
  • AI数据分析在体育中的应用:技术与实践
  • 初识结构体,整型提升及操作符的属性
  • 12.6Swing控件4 JSplitPane JTabbedPane
  • 第六章 进阶18 小杨的困惑
  • 博弈论概述
  • 网络库libhv介绍
  • Selenium自动化测试之弹窗处理
  • [Python学习日记-91] 并发编程之多线程 —— threading 模块、开启线程的方式、线程相关的其他方法
  • 腾讯加持,销售易 CRM 优势几何?
  • 本机无法远程别的计算机的方法
  • 自制喜悦字贴
  • QILSTE 精巧电子元件H4-108FO/5M解析
  • 观测云OaC能力升级,通过Terraform实现配置闭环
  • MySQL基础(一)介绍、下载及安装
  • w384药品管理系统的设计与实现
  • MySQL基础(三)DQL(Data Query Language,数据查询语言)
  • 【第一章:人工智能基础】01.Python基础及常用工具包-(1)Python语法与基础数据类型