Arduino UNO R3自学笔记21 之 Arduino电机的闭环控制

news2024/11/28 0:53:52

注意：学习和写作过程中，部分资料搜集于互联网，如有侵权请联系删除。

前言：上篇写了电机速度测定，这篇主要是讲测定出的速度用于反馈，使得实际速度快速响应到需要的速度。

1.控制系统介绍

分2大类：开环控制系统和闭环控制系统。

一般来说，开环控制构比较简单，成本较低。开环控制系统的缺点是控制精度不高，抑制干扰能力差，而且对系统参数变化比较敏感。

闭环控制系统是指：把控制系统输出量的一部分或全部，通过一定方法和装置反送回系统的输入端，然后将反馈信息与原输入信息进行比较，再将比较的结果施加于系统进行控制，避免系统偏离预定目标。闭环控制系统利用的是负反馈。

2.电机的闭环控制

闭环控制电机是通过在电机中加入传感器等反馈机制，实现精准控制的电机。在闭环控制电机中，电机控制器会根据反馈信号动态调整控制器的输出，从而使电机输出的运动轨迹精确达到预期目标。

通常情况下，闭环控制电机会通过传感器等设备来获取电机的位置、速度等参数信息，并将这些信息传回电机控制器进行处理。控制器根据反馈信息对电机进行控制，从而精确调节电机的转速、转角等参数，实现精准控制。

3.电机闭环控制的优点

相比于开环控制电机，闭环控制电机具有以下优点：

● 精准控制：闭环控制电机可以在不同负载、温度等环境下精确控制转速、转角等参数，从而实现精准的定位、速度调节等功能。

● 响应速度快：由于具备反馈机制，闭环控制电机能够快速检测电机的运动状态，从而能够更快速地调整电机控制器的输出，实现快速响应。

● 稳定性高：闭环控制电机能够根据反馈信息调整输出，提高电机的稳定性，确保输出质量。

4.搭建电路

5.测试代码

注：以下代码pid值只测试用了一下，没有做调参。

#include<MsTimer2.h>

#define moto_in1 7
#define moto_in2 8
#define moto_pwm 9

#define moto_num1 2
#define moto_num2 3
int interrupt_time = 40;

//计数
float num1=0;
float num2=0;
bool num_over_flag=0;
void speed_c1();
void speed_c2();
void int_time();

//pid
float sumerror;
float lasterror;
float nowerror;
void pid(float real_value);

float set_value=150;
float output_value = 0;
float speed_real=0;
double kp = 10, //0.7
             ki = 0.01,  //0.13
             kd = 0.1;  //0.01

void setup()
 { // put your setup code here, to run once:
    Serial.begin(9600);
	pinMode(moto_in1,OUTPUT);
	pinMode(moto_in2,OUTPUT);
	pinMode(moto_pwm,OUTPUT);
	pinMode(moto_num1,INPUT);
	pinMode(moto_num2,INPUT);
    noInterrupts();
    attachInterrupt( 0,speed_c1,CHANGE );
    attachInterrupt( 1,speed_c2,CHANGE);
    MsTimer2::set(interrupt_time,int_time);   
    MsTimer2::start(); 
    interrupts();//开所有中断，准备进入程序运行模式
 }

void loop()
 { // put your main code here, to run repeatedly:
 
   digitalWrite(moto_in1,HIGH);
   digitalWrite(moto_in2,LOW);

 }

void speed_c1()
{
  num1++;
}
void speed_c2()
{
  num2++;
}
void int_time()
{
  speed_real = (num1+num2)/(1200*0.04)*60;
  pid(speed_real);
  if(output_value>255)output_value=255;
  else if(output_value<-255)output_value=-255;
  analogWrite(moto_pwm,output_value);
 Serial.print(speed_real); Serial.print("       ");
 Serial.print(set_value); Serial.println("        ");
 //Serial.print(output_value); Serial.println("   ");

 num1=0;
 num2=0;
}

void pid(float real_value) 
{
  // put your main code here, to run repeatedly:
  float output_err;
  nowerror = set_value - real_value;
  sumerror += nowerror; 
  output_err = kp*nowerror + ki*sumerror + kd*(lasterror - nowerror);
  lasterror = nowerror;
  output_value= real_value+output_err;
}