Arduino用PID控制直流电机定位旋转 - 【单片机教程-Arduino-PID】

在这篇文章中,我们将看到如何实现直流电机的非常精确的位置控制。我们使用Arduino和PID计算来实现简单直流电机的精确位置控制。

这样的小项目非常有趣,您可以通过构建该项目来学习许多概念,例如PID,闭环系统和编码器基础。
https://mp.weixin.qq.com/s/YahJFSzbMptOQ398SBlvAg

  • 0
    点赞
  • 42
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
#include #define uchar unsigned char #define uint unsigned int #define ulong unsigned long #define LED_DAT P0 sbit LED_SEG0 = P2^7; sbit LED_SEG1 = P2^6; sbit LED_SEG2 = P2^5; sbit LED_SEG3 = P2^4; #define TIME_CYLC 100 //12M晶振,定时器10ms 中断一次 我们1秒计算一次转速 // 1000ms/10ms = 100 #define PLUS_PER 10 //码盘的齿数 ,这里假定码盘上有10个齿,即传感器检测到10个脉冲,认为1圈 #define K 1.65 //校准系数 unsigned char code table[]={0x3f,0x06,0x5b,0x4f,0x66,0x6d,0x7d,0x07,0x7f,0x6f}; uchar data Disbuf[4];// 显示缓冲区 uint Tcounter = 0; //时间计数器 bit Flag_Fresh = 0; // 刷新标志 bit Flag_clac = 0; //计算转速标志 bit Flag_Err = 0; //超量程标志 void DisplayFresh();//在数码管上显示一个四位数 void ClacSpeed();//计算转速,并把结果放入数码管缓冲区 void init_timer();//初始化定时器T0\T1 void Delay(uint ms);//延时函数 void it_timer0() interrupt 1 /* interrupt address is 0x000b */ { TF0 = 0; //定时器 T0用于数码管的动态刷新 TH0 = 0xC0; TL0 = 0x00; Flag_Fresh = 1; Tcounter++; if(Tcounter>TIME_CYLC) { Flag_clac = 1;//周期到,该重新计算转速了 } } void it_timer1() interrupt 3 /* interrupt address is 0x001b */ { TF1 = 0; //定时器T1用于单位时间内收到的脉冲数 //要速度不是很快,T1永远不会益处 Flag_Err = 1; //如果速度很高,我们应考虑另外一种测速方法:T测速法 } void main(void) { Disbuf[0] = 0; //开机时,初始化为0000 Disbuf[1] = 0; Disbuf[2] = 0; Disbuf[3] = 0; init_timer(); while(1) { if(Flag_Fresh) { Flag_Fresh = 0; DisplayFresh(); // 定时刷新数码管显示 } if(Flag_clac) { Flag_clac = 0; ClacSpeed(); //计算转速,并把结果放入数码管缓冲区 Tcounter = 0;//周期定时 清零 TH1=TL1 = 0x00;//脉冲计数清零 } if(Flag_Err) //超量程处理 { Disbuf[0] = 0x9e; //开机时,初始化为0000 Disbuf[1] = 0x9e; Disbuf[2] = 0x9e; Disbuf[3] = 0x9e; while(1) { DisplayFresh();//不再测速 等待复位i } } } } //在数码管上显示一个四位数 void DisplayFresh() { P2 |= 0xF0; LED_SEG0 = 0; LED_DAT = table[Disbuf[0]]; Delay(1); P2 |= 0xF0; LED_SEG1 = 0; LED_DAT = table[Disbuf[1]]; Delay(1); P2 |= 0xF0; LED_SEG2 = 0; LED_DAT = table[Disbuf[2]]; Delay(1); P2 |= 0xF0; LED_SEG3 = 0; LED_DAT = table[Disbuf[3]]; Delay(1); P2 |= 0xF0; } //计算转速,并把结果放入数码管缓冲区 void ClacSpeed() { uint speed ; uint PlusCounter; PlusCounter = TH1*256 + TL1; speed =6*PlusCounter/K; //K是校准系数,如速度不准,调节K的大小 Disbuf[3] = (speed/1000)%10; Disbuf[2] = (speed/100)%10; Disbuf[1] = (speed/10)%10; Disbuf[0] = speed%10; } void init_timer()//初始化定时器T0\T1 { TMOD=0x51; //定时器0工作于定时方式1,定时器1工作于计数方式 TH0=(65536-10000)/256; TL0=(65536-10000)%256; //TO定时时间为10000个周期即10毫秒 TH1=0x00; TL1=0x00; ET0=1; /* enable timer0 interrupt */ EA=1; /* enable interrupts */ TR0=1; /* timer0 run */ ET1=1; /* enable timer1 interrupt */ EA=1; /* enable interrupts */ TR1=1; } //延时函数 void Delay(uint ms) { uchar i; while(ms--) for(i=0;i<100;i++); }
JGB37-520直流减速电机是一种常见的电机型号,它具有自带编码器。编码器是用于读取和计算电机转速和转动方向的传感器。在自动驾驶小车系统中,除了使用电机自带的编码器来获取电机的转速和转动方向外,还需要实时读取小车转过的角度,以实现完整的转弯和辅助前进等功能。为了实现这一功能,可以选择使用陀螺仪作为传感器。陀螺仪是根据陀螺在转动过程中受到外力矩作用后的特殊运动原理设计的。它可以快速旋转并测量轴所指示的方向,并将数据传输给控制系统。在无人驾驶小车系统中,通常只需要知道系统的Yaw轴(即陀螺仪的Z轴)的实时转动角度即可实现功能。因此,选择一个二轴陀螺仪就足够了。然而,为了以后进行其他实验的需要,可以选择一个六轴姿态角度传感器,如JY61。JY61模块包含了陀螺仪加速度计MPU6050、稳压电路和STM8单片机。MPU6050是模块的核心,它可以测量三轴的加速度、角速度和角度,并通过串口输出。因此,通过使用JGB37-520直流减速电机自带的编码器和JY61六轴姿态角度传感器,可以实现对电机转速和转动角度的准确测量和控制。\[1\]\[2\] #### 引用[.reference_title] - *1* [基于STM32F4系列 之 霍尔编码器减速直流电机](https://blog.csdn.net/m0_63741844/article/details/121446062)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_chatgpt_common_search_pc_result","utm_medium":"distribute.pc_search_result.none-task-cask-2~all~insert_cask~default-1-null.142^v91^control_2,239^v3^insert_chatgpt"}} ] [.reference_item] - *2* *3* [Arduino毕业设计——基于Arduino+PID+AI的自动驾驶小车控制系统设计与实现(毕业论文+程序源码)——自动...](https://blog.csdn.net/m0_66238867/article/details/131063729)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_chatgpt_common_search_pc_result","utm_medium":"distribute.pc_search_result.none-task-cask-2~all~insert_cask~default-1-null.142^v91^control_2,239^v3^insert_chatgpt"}} ] [.reference_item] [ .reference_list ]
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值