直流电机是Arduino机器人制作中的主要动力来源,但是由于电机的参数一致性有所差别,即使是相同型号的电机在相同电压下的转速都不完全相同,而且在带负载或负载不同的情况下,更加会导致电机转速发生变化,这就会导致制作的Arduino轮式机器人不能实现直线行走,因为这是一个开环控制,没有任何反馈信号返回。如果给直流电机加上编码器作为反馈器件,也就可以测量得到电机的当前转速,如果将其与设定值计算差值,并通过PID算法计算得到新的控制信号,从而可以动态的测量和控制电机的转速,形成一个闭环控制系统。
下面我们利用带有编码器的直流电机、Arduino控制器、直流电机驱动板和LabVIEW上位机软件以实验探索的形式来设计一个直流电机转速比例控制实验。
1.TimerOne定时器库
1.1下载及使用方法
TimerOne定时器库使用AVR单片机内部的定时器1实现定时中断的功能,其下载地址为:https://code.google.com/p/arduino-timerone/,只需要更改几个参数即可使用定时器中断来实现周期性执行的任务。需要注意的是,如果使用了TimerOne定时器库,也就不能在相应的引脚输出PWM电压,Uno上的定时器与PWM引脚的关系如表1所示。
表1 定时器与PWM引脚的关系
定时器 |
OC0A |
OC0B |
OC1A |
OC1B |
OC2A |
OC2B |
PWM引脚 |
6 |
5 |
9 |
10 |
11 |
3 |
TimerOne定时器库函数库中自带的ISRBlink程序如程序代码1所示,可以实现13号管脚上LED的5Hz频率的闪烁。
程序代码1:ISRBlink示例程序
#include
void setup() {
}
void loop(){
//主函数,用于执行非周期性任务
}
void timerIsr(){
}
1.2评估定时时间的准确性
仅仅凭靠眼睛不能判断定时时间是否准确,下面我们设计一个实验来评估定时时间的准确性。我们需要将上面示例代码中的Timer1.initialize(100000)更改为Timer1.initialize(1000),digitalWrite( 13, digitalRead( 13 ) ^ 1 )更改为digitalWrite(2, digitalRead( 2) ^ 1 ),通过反转I/O的电平实现数字端口2输出500Hz的近似方波。
同时,我们使用NI USB-6009便携式数据采集卡和LabVIEW 2012软件实现一个简易的模拟量采集器,将Arduino 控制器上的数字端口2和GND分别与NI USB-6009便携式数据采集卡上的AI0/AI0+和AI4/AI0-相连接,NI USB-6009便携式数据采集卡接口示意图如图1所示,Arduino Uno控制器与USB-6009便携式数据采集卡的连接图如图2所示。然后使用10kps的采样率,5秒的采样时间的参数采集Arduino 控制器上的数字端口2输出的方波信号,取其前20ms的波形如图3所示,通过波形频率分析工具测量得到其频率为499.901Hz。
另外,我们又将定时时间设置为100微秒、50微秒和25微秒,并使用NI USB-6009便携式数据采集卡和LabVIEW 2012软件以45kps的采样率和2秒的采样时间分别采集了数字端口2输出的波形数据并进行频率分析,得到其频率分别为4999.01Hz,9998.03Hz,19996Hz。从以上数据对比分析可知,定时器的定时时间非常准确,频率测量误差主要来自于I/O反转操作延时导致的。
最后,我们还测试了OCROBOT MEGA 2560控制器、Arduino Uno控制器山寨版输出的500Hz的方波信号频率,分别为500.435Hz和499.764Hz。
图1 NI USB-6009接口示意图
图3定时器中断产生的500Hz方波信号
2.转速测量
2.1测量转速方法
测量转速方法有3种,分别为测频法(M法)、 测周法(T法)及混合法(M/T法)。
测频法是在一定时间内,通过测量旋转引起的单位时间内的脉冲数,实现对旋转轴转速测量的一种方法,适用于高、中转速的测量。该法本质上属于定时测角法,为提高测量的准确度,有时采用多标记或开齿的方法,其不确定度主要取决于时间测量和计数量化。
测周法是在转速脉冲的间隔内,用时钟脉冲来测量转速的一种方法,适合于低转速测量。该法实际上就是定角测量法,即用时标填充的方法来测量相当于某一旋转角度的时间间隔。在高、中转速时,可采用多周期平均来提高测量准确度,其不确定度主要取决于时间测量、计数量化及触发的不确定度。
混合法是在测频法的基础上,吸取测周法的优点汇集而成的一种转速测量方法。它是在转速传感器输出脉冲启动定时脉冲的同时,计取传感器输出脉冲个数和时钟脉冲个数,而当到达测量时间时,先停止对传感器输出脉冲的计数,在下一个定时脉冲启动之前再停止时钟脉冲的计数。因此,该种方法可在较宽的范围内使用。
此处,我们选择测频法来测量转速,其工作原理为:当被测信号在特定时间段T内的周期个数为N时,则被测信号的频率f=N/T。
2.2转速测量程序设计
利用TimerOne定时器库来实现定时,通过外部中断对电机编码器输出的脉冲进行计数,计数值除以定时时间即为一定时间内的转速。实现1秒内转速测量的程序如程序代码2所示。
程序代码2:转速测量程序
#include
long counter_val[2] = {0,0};
byte CurCnt = 0;
int j=0;
void setup() {
}
void loop()
{
}
//外部中断处理函数
void counter()
{
}
//定时器中断处理函数
void timerIsr()
{
}
2.3验证频率测量的准确性
前面提到了Arduino的模拟输出(PWM)的频率约为490Hz,且转速测量采用的是测频法,此时用来正好来验证一下程序设计的正确性。在上面的转速测量程序中的void setup()里面delay(2000)之前增加如下代码,以产生方波。串口输出的频率测量结果如图4所示。[page]
pinMode(3,OUTPUT);
analogWrite(3,127);
图4 PWM频率测量结果
在图4所示的PWM频率测量结果中,去除前两个,可以发现频率值稳定在490和491,且4个490之后出现一个491,基本可以认为是490Hz。
同时,为了进一步的确认PWM的频率为490Hz,已验证频率测量的准确性,利用NI USB-6009便携式数据采集卡和LabVIEW 2012软件实现一个简易的模拟量采集器,使用10kps的采样率,5秒的采样时间的参数分别采集了PWM的占空比为10/255、127/255和245/255时的波形图,取波形图的前0.01秒,如图5、图6和图7所示,在0.01秒内约有5个周期,同时使用频率分析工具对占空比为127/255的波形数据进行分许,得到其频率为490.099Hz。
通过对基于Arduino与TimerOne定时器库的频率测量与基于LabVIEW和数据采集卡的数据对比与分析,得出频率测量非常准确。
图7 占空比为245/255时的波形
2.4搭建测量转速的平台
在验证了基于Arduino与TimerOne定时器库的频率测量的准确性之后,我们就可以着手搭建一个直流电机转速测量系统。
2.4.1 硬件平台
直流电机转速测量系统的直流电机和编码器有两者分离式,使用联轴器将两者连接起来,也有带有编码器的直流电机,此处为了简化设计,直接选用带有编码器的直流电机。JGB37-371-12V-228RPM带有编码器的直流减速电机如图8所示,额定电压为12V,额定空载转速为228rpm,其编码器为334线增量式光电编码器,其接口有6根数据线,黄色和橙色是电机电源,绿色和白色是AB相脉冲输出,红色和黑色是编码器的电源端和接地端。
图9 OCROBOT Motor Shield
OCROBOT Motor Shield 是基于Arduino Motor Shield 设计的增强版本的电机驱动器,如图9所示,电机驱动器采用独立供电、GND分离技术,且与Arduino控制器之间采用光耦隔离,这充分保证了Arduino控制器在大负载、大功率、急刹车、瞬时正反转等恶劣电磁环境下的稳定性。需要注意的是:Arduino控制器与电机驱动器应使用两块电池或者两个独立的电源,保证电机驱动板与Arduino控制板电源完全独立,从而保证其电气隔离性。OCROBOT Motor Shield的I/O口的控制功能如表2所示,如果使用电机时还会接驳其他设备应避免占用这些I/O口。
表2 OCROBOT Motor Shield的控制引脚
功能 |
电机A |
电机B |
方向 |
D12 |
D13 |
速度(PWM) |
D3 |
D11 |
制动(刹车) |
D9 |
D8 |
搭建的直流电机转速测量系统如图10所示。OCROBOT Motor Shield 直接堆叠在Arduino Uno控制器上,OCROBOT Motor Shield采用7.4V的锂电池供电,Arduino Uno控制器使用方口USB线连接至计算机上,提供电源且可以方便的通过串口上传数据至计算机上。电机的黄色和橙色连接至OCROBOT Motor Shield电机接口A,绿色和白色分别连接至Arduino Uno控制器的数字端口2、3,红色和黑色连接至Arduino Uno控制器的电源端口5V、GND。
图10 直流电机转速测量系统
2.4.2 软件设计
由于JGB37-371-12V-228RPM直流减速电机的编码器输出AB相脉冲,为了充分利用两相脉冲以提高测量准确性,在程序代码2转速测量程序中的attachInterrupt(0, counter, RISING)之后增加如下代码,将B相脉冲输出也用来计数,以实现2倍频测量。JGB37-371-12V-228RPM直流减速电机的编码器为334线增量式光电编码器,也就说电机旋转一圈输出334个脉冲,2倍频之后即为668个脉冲。
attachInterrupt(1, counter, RISING);//设置编码器B相位上升沿中断
修改完编码器部分,需要增加电机驱动部分的代码,以实现驱动直流电机旋转。由于硬件上将直流电机的电源线接在L298P的A端口,其控制信号为3、9和12,分别为PWM信号、制动信号和方向信号。需要在void setup()中的delay(2000)之后增加如下代码。当PWM值为80时,串口输出的转速如图8所示,且当PWM低于80时,减速电机输出轴不转动;将PWM设置为255时,串口输出的转速如图9所示。
pinMode(12,OUTPUT);
analogWrite(3,80);
图8 PWM为80时转速数据
图9 PWM为255时转速数据
3.转速的比例控制
3.1PID控制方法
PID控制器(比例-积分-微分控制器),由比例单元P、积分单元I和微分单元D组成。通过Kp,Ki和Kd三个参数的设定来实现对某个变量的实时控制,主要适用于基本上线性,且动态特性不随时间变化的系统。
PID控制器是一个在工业控制应用中常见的反馈控制方法,其原理如图10所示,其将采集的数据和设定参考值进行比较,然后将这个差值通过PID三个模块计算出新的控制值用于执行,计算差值的目的是让系统的数据达到或者保持在设定的参考值。PID控制器可以根据历史数据和差别的出现率来调整输入值,使系统更加准确而稳定。[page]
图10
3.2 转速比例控制的程序设计
实现了电机转速的测量,下面就要对电机转速进行比例控制了。为了提高控制系统响应的速度,将程序代码2转速测量程序中的定时时间更改为10毫秒,也就是转速的采样频率为100Hz,且由图8和图9可知,电机减速前的1秒钟转速在4500和12650之间,即10毫秒的转速在45至127之间,此处将转速设置为100,比例系数设置为3。转速比例控制的程序设计如程序代码3所示。
程序代码3:转速比例控制的程序设计
#include
#define Kp 3
#define set_point 100
long counter_val[2] = {0,0};
byte CurCnt = 0;
int j=0;
int output_value=0;
void setup()
{
}
void loop()
{
if(output_value <0)
}
//外部中断处理函数
void counter()
{
}
//定时器中断处理函数
void timerIsr()
{
}
通过串口输出的电机实际转速与PWM值的数据如图11和图12所示。其中图11为系统刚启动的时候,此时可以看出电机逐渐上升,达到128之后逐渐降至100以下,这属于系统初期的振荡;图12是系统运行一段时间之后的转速和PWM数据,转速稳定在100±2,PWM稳定在145左右。
图11 PWM为80时转速数据
图12 PWM为255时转速数据
图11和图12中的串口输出数据看起来没有图形那么直观,为此我们使用LabVIEW2012和VISA 5.3编写一个转速显示程序。前面板如图13所示,程序框图如图14所示,其中的数据解析子VI的程序框图如图15所示,其功能是解析出串口数据中的转速值和PWM值。
除了上位机显示程序之外,我们还需要对转速的比例控制程序进行部分修改,具体如下:
将
Serial.print( lTemp);
修改为
if((lTemp/100) ==0)
Serial.print( lTemp);
将
Serial.println(output_value);
修改为
if((output_value /100) ==0)
Serial.print(output_value);
图13 LabVIEW上位机前面板
图15 数据解析程序框图
在LabVIEW上位机软件上选择Arduino Uno控制器对应的串口号,即可将电机的转速和PWM值实时的显示在LabVIEW前面板上,如图16所示。
图16 转速和PWM显示在LabVIEW上位机上
上一篇:labVIEW时域—频域分析
下一篇:LabVIEW中测试测量数据的存储(4)
推荐阅读最新更新时间:2024-03-30 23:04