標(biāo)題: 霍爾測速PID算法,proteus仿真可以運行,但實物運行,小馬達轉(zhuǎn)速只有30,求教 [打印本頁]

作者: bbxyliyang    時間: 2021-4-3 15:11
標(biāo)題: 霍爾測速PID算法,proteus仿真可以運行,但實物運行,小馬達轉(zhuǎn)速只有30,求教


作者: bbxyliyang    時間: 2021-4-4 09:07
大家好,我仿真里面測速調(diào)速都是可以使用的,但實物里面小馬達速度只能達到40r/min,不知道為啥,求教?
作者: 深圳xyz1    時間: 2021-4-4 11:32
最好說一下是什么電機,看原理圖應(yīng)該一個是直流有刷電機。仿真與現(xiàn)實是兩碼事。他決定轉(zhuǎn)速
由一下公式?jīng)Q定。
   直流電機的電流、轉(zhuǎn)速、電壓的關(guān)系式為:
   U=CeΦn+IaRa+2ΔUs
   n=(U-2ΔUs-IaRa)/(CeΦ)
 其中n為轉(zhuǎn)速,U為電機端電壓, ΔUs為電刷壓降, Ia 為電樞電流, Ra 為電機電樞繞組電阻
 Ce 為電機常數(shù),Φ為電機氣隙磁通。
電壓由程序的占空比決定,看看你程序占空比設(shè)置是多少?還有就是電機本身的常數(shù)了。
作者: 深圳xyz1    時間: 2021-4-4 11:34
占空比設(shè)置高一點!

作者: bbxyliyang    時間: 2021-4-4 15:03
深圳屌絲 發(fā)表于 2021-4-4 11:32
最好說一下是什么電機,看原理圖應(yīng)該一個是直流有刷電機。仿真與現(xiàn)實是兩碼事。他決定轉(zhuǎn)速
由一下公式?jīng)Q定 ...

您好,我用的電機就是小馬達
作者: GlenXu    時間: 2021-4-4 16:49
請增加你的PID 中的比例項,例如增加到現(xiàn)在的2-3倍,只要不振動就可以!
作者: 深圳xyz1    時間: 2021-4-4 23:45
bbxyliyang 發(fā)表于 2021-4-4 15:03
您好,我用的電機就是小馬達

把主程序main函數(shù)復(fù)制出來,看看問題在哪?

作者: TTQ001    時間: 2021-4-5 03:35
檢查單片機的主頻率,以確保它與仿真設(shè)置相同。
作者: bbxyliyang    時間: 2021-4-5 11:16
深圳屌絲 發(fā)表于 2021-4-4 23:45
把主程序main函數(shù)復(fù)制出來,看看問題在哪?


unsigned char aa[]={'T','a','r','g','e','t',' ',' ',' ',' ',' ','r','/','m','i','n'};  //目標(biāo)轉(zhuǎn)速。Target            r/min
unsigned char cc[]={'A','c','t','u','a','l',' ',' ',' ',' ',' ','r','/','m','i','n'};           //實測轉(zhuǎn)速: Actual      r/min
uchar flag;                                                                                                                                                                                                                                 
uchar i=0;

sbit PWM_FC=P3^3;
sbit IN1=P3^6;
sbit IN2=P3^7;

int e ,e1 ,e2 ;//pid 偏差
float uk ,uk1 ,duk ;//pid輸出值
float Kp=0.36,Ki=0.05,Kd=0.016;//pid控制系數(shù)        0.1 0.05 0.016

/*
PID的參數(shù)設(shè)置可以參照以下來進行:  
     參數(shù)整定找最佳,從小到大順序查;  
         先是比例后積分,最后再把微分加;  
         曲線振蕩很頻繁,比例度盤要放大;  
         曲線漂浮繞大灣,比例度盤往小扳;  
         曲線偏離回復(fù)慢,積分時間往下降;  
         曲線波動周期長,積分時間再加長;  
         曲線振蕩頻率快,先把微分降下來;  
         動差大來波動慢。微分時間應(yīng)加長;  
         理想曲線兩個波,前高后低4比1 ; 
         一看二調(diào)多分析,調(diào)節(jié)質(zhì)量不會低;
*/

int out=0;
uint SpeedSet=300;
uint cnt=0;
uint Inpluse=0,num=0,zs;//脈沖計數(shù)
uint PWMTime=100;//脈沖寬度
void PIDControl();
void SystemInit();
void delay(uchar x);
void PWMOUT();
void SetSpeed();

/**************主函數(shù)************/
void main()
{
        SystemInit();
        init();
        LCD_Write_String(0,0,aa);
        zs=1;
        while(1)
        {
            if(flag==1)
                {
                 flag=0;
                  LCD_Write_String(0,0,aa);
                }
                if(zs==1)
                {
                    zs=0;
                        cc[7]=num/1000+'0';
                        cc[8]=num/100%10+'0';
                        cc[9]=num/10%10+'0';
                        cc[10]=num%10+'0';
                        LCD_Write_String(0,1,cc);
                }
        }
}

void PIDControl()        //pid偏差計算
{
        e=SpeedSet-num;
        duk=(Kp*(e-e1)+Ki*e+Kd*(e-2*e1+e2));  
        uk=uk1+duk;
        out=(int)uk;
        if(out>1000)
        {
                out=1000;
        }
        else if(out<0)
        {
                out=0;
        }
        uk1=uk;
        e2=e1;
        e1=e;
        PWMTime=out;
}

void delay(uchar x)
{
        uint i,j;
        for(i=x;i>0;i--)
                for(j=50;j>0;j--);
}

void PWMOUT()
{
        if(cnt<PWMTime)
        {
                PWM_FC=1;
        }
        else
        {
                PWM_FC=0;
        }
        if(cnt>1000) cnt=0;
}
void SystemInit()
{
        TMOD=0X21;    //t1用來串口t2定時
        TH0=THC0;
        TL0=TLC0;
        TH1=0xC0;
        TL1=0XC0;
        ET1=1;
        ET0=1;
        TR0=1;
        TR1=1;
        EX0=1;     //中斷0用來測量轉(zhuǎn)速
        IT0=1;
        EA=1;
        e =0;
        e1=0;
        e2=0;
        IN1=1;
        IN2=1;
}


uchar Key_Scan(void)

{

        static uchar State_Cnt=0;//靜態(tài)變量,用于改變狀態(tài)過程

       uchar Key_State = 0;//用于存儲鍵值碼

       switch(State_Cnt)

        {

                case 0x00:P1 = 0x1f;//先往P3(1到4獨立按鍵)口送0001 1111

               if(P1 != 0x1f)//有無按鍵被按下

                {

                       State_Cnt = 0x01;//改變狀態(tài)

                        break;                           

                }

               case 0x01:

                if(P1 != 0x1f)//經(jīng)過定時器延時后,再次判斷按鍵是否按下

                {

                        State_Cnt = 0x02;//改變狀態(tài)

                       Key_State = P1;//把鍵值保存下來

                        P1 = 0x1f;//恢復(fù)P3,以便下次按下重新保存鍵值

                        break;

                }

                else

                {

                        State_Cnt = 0x00;//改變狀態(tài)

                       break;

                }

                case 0x02:

               if(P1 == 0x1f)//判斷按鍵釋放

               {

                       State_Cnt = 0x00;//改變狀態(tài)

                       break;

                }

                default:break;

       }

       return Key_State;//返回鍵值

}

void Display_Key(uchar key_value)

{

       switch(key_value)

        {

               case 0x1e:
                           IN1=0;
                   IN2=1;break;//鍵值改變時,做出相應(yīng)的動作(用戶自定義動作)

               case 0x1d:
                           IN1=1;
                   IN2=1;break;

               case 0x1b:
                           IN1=~IN1;
                   IN2=~IN2;
                   break;

               case 0x17:
                                   SpeedSet+=10;
                        if(SpeedSet>3500)
                        {
                                SpeedSet=3500;
                        }
                          
                           break;
                           case 0x0f:
                          SpeedSet-=10;
                        if(SpeedSet<0) SpeedSet=0;
                          
                           break;
        }

}



void int0() interrupt 0
{
        Inpluse++;
}
void t0() interrupt 1
{
        static unsigned int time=0,time1=0;

        TH0=THC0;
        TL0=TLC0;
        time++;  //轉(zhuǎn)速測量周期
        time1++;
        if(time1>=5)
        {
                time1=0;
                flag=1;
                Display_Key(Key_Scan());//按鍵按下,鍵值碼送入函數(shù),以便做相應(yīng)動作
                   aa[7]=SpeedSet/1000+'0';
        aa[8]=SpeedSet/100%10+'0';
        aa[9]=SpeedSet/10%10+'0';
        aa[10]=SpeedSet%10+'0';
       
        }
        if(time>500)
        {
                zs=1;
                time=0;
                num=Inpluse;         //計算式中是仿真時,碼盤數(shù)60時的情況,如果碼盤數(shù)n=10時,num=Inpluse*60/n=Inpluse*6;
                Inpluse=0;
                PIDControl();
        }
        PWMOUT();
}
void timer_1()  interrupt 3
{
           cnt++;        //cnt越大占空比越高2.5Khz
}
  




歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1