51單片機控制L298n電機PI閉環控制程序錯誤

ID:661195 · 發表于 2019-12-13 17:59

下面是我從網上找的程序，修改了下，想要達到通過更改期望速度來改變實際速度的目的。但經過測試發現不行，程序在下，希望大佬指出錯誤。

#include<reg51.h>

sbit pwm=P1^0;
sbit IN2=P1^1;
unsigned int value;

unsigned int Inlpuse=0;
unsigned int countl=0;
unsigned int time=0;
unsigned int Proportion=5;//比例常數 Proportional Const
unsigned int Integral=1.5;//積分常數 Integral Const
unsigned int LastError=0;//Error[-1]
unsigned int PrevError=0;//Error[-2]
unsigned int Error=0;//Error[0]
int       Out=0;//outcome
unsigned int expc_speed=600;
unsigned int real_speed=0;

void main()
{
TMOD = 0x21;

TH0= 0x3c;
TL0 = 0xb0;       //50ms
TH1 = 0x9c;
TL1 = 0x9c;
EA=1;
ET0 = 1;
ET1 = 1;
EX0 = 1;
IT0 = 1;
TR1=1;
IT0=1;

}

  int  PIDControl()
{
   Error=expc_speed-real_speed;//計算偏差
   //進行增量式PID計算
   Out=Out+
      Proportion*(Error-LastError)+
      Integral*Error;

   //進行誤差更新
   PrevError=LastError;
   LastError=Error;

   //上下限幅處理
   if(Out<0)
   Out=0;//驅動電機的電壓不可能小于零，故當輸出小于零時，輸出應該值為零
   if(Out>250)
   Out=100;//
         value=Out;
         return value;



}

void exter0() interrupt 0 //外部中斷脈沖計數
{ //M法測速度(外部中斷0和定時器0用在M法測速

Inlpuse++;
}

void timer0() interrupt 1
{
   TH0 = 0x3c;

   TL0 = 0xb0;

   time++;

  if(time>=10) //1s 鐘讀取次轉

{
   EX0 = 0;

   TR0 = 0;

   real_speed=Inlpuse;

   Inlpuse=0;

PIDControl();//100ms控制一次

   Inlpuse=0;
   EX0=1;
   TR0=1;
}
}

void  T1_time() interrupt 3
{
countl++;
if(countl>= 100)
      countl = 0;

if(countl <value)
      pwm = 1;
      else pwm=0;
}

帳號		自動登錄	找回密碼
密碼			立即注冊

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

51單片機控制L298n電機PI閉環控制程序錯誤