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

 找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

搜索
查看: 3920|回復: 0
打印 上一主題 下一主題
收起左側

直流電機速度控制(PID)閉環

[復制鏈接]
跳轉到指定樓層
樓主
ID:109480 發表于 2016-3-18 11:44 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
#include "control.h"        
  /**************************************************************************
作者:平衡小車之家
我的淘寶小店:shop114407458。taobao。com
**************************************************************************/
int Target_velocity=50;  //設定速度控制的目標速度為50個脈沖每10ms
int TIM1_UP_IRQHandler(void)  
{   
        if(TIM1->SR&0X0001)//5ms定時中斷
        {   
                  TIM1->SR&=~(1<<0);                                       //===清除定時器1中斷標志位                 
                  Encoder=Read_Encoder(2);                                  //===讀取編碼器的值,M法測速,輸出為每10ms的脈沖數
                  Led_Flash(100);                                          //===LED閃爍;指示單片機正常運行        
                   Xianfu_Pwm();                                            //===PWM限幅
                  Moto1=Incremental_PI(Encoder,Target_velocity);           //===速度PI控制器
            Set_Pwm(Moto1);                                          //===賦值給PWM寄存器  
        }               
         return 0;         
}

/**************************************************************************
函數功能:賦值給PWM寄存器
入口參數:PWM
返回  值:無
**************************************************************************/
void Set_Pwm(int moto1)
{
                        if(moto1<0)                        AIN2=1,                        AIN1=0;
                        else                   AIN2=0,                        AIN1=1;
                        PWMA=myabs(moto1);
}

/**************************************************************************
函數功能:限制PWM賦值
入口參數:無
返回  值:無
**************************************************************************/
void Xianfu_Pwm(void)
{        
          int Amplitude=7100;    //===PWM滿幅是7200 限制在7100
    if(Moto1<-Amplitude) Moto1=-Amplitude;        
                if(Moto1>Amplitude)  Moto1=Amplitude;        
}

/**************************************************************************
函數功能:絕對值函數
入口參數:int
返回  值:unsigned int
**************************************************************************/
int myabs(int a)
{                    
          int temp;
                if(a<0)  temp=-a;  
          else temp=a;
          return temp;
}
/**************************************************************************
函數功能:增量PI控制器
入口參數:編碼器測量值,目標速度
返回  值:電機PWM
根據增量式離散]]PID公式
pwm+=Kp[e(k)-e(k-1)]+Ki*e(k)+Kd[e(k)-2e(k-1)+e(k-2)]
e(k)代表本次偏差
e(k-1)代表上一次的偏差  以此類推
pwm代表增量輸出
在我們的速度控制閉環系統里面,只使用PI控制
pwm+=Kp[e(k)-e(k-1)]+Ki*e(k)
**************************************************************************/
int Incremental_PI (int Encoder,int Target)
{         
   float Kp=100,Ki=100;        
         static int Bias,Pwm,Last_bias;
         Bias=Encoder-Target;                //計算偏差
         Pwm+=Kp*(Bias-Last_bias)+Ki*Bias;   //增量式PI控制器
         Last_bias=Bias;                           //保存上一次偏差
         return Pwm;                         //增量輸出
}


評分

參與人數 1黑幣 +60 收起 理由
admin + 60 共享資料的黑幣獎勵!

查看全部評分

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏1 分享淘帖 頂 踩
回復

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規則

小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術交流QQ群281945664

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板: 久久精品| 奇色影视 | 干干干操操操 | 中文字幕蜜臀 | 91视频.com | 精品在线一区二区 | 色男人天堂av | av片免费观看 | 欧美区在线 | 中文字幕国产 | 国产精品久久久久久久久 | 国产中文字幕在线观看 | 欧美亚洲激情 | 另类一区 | 国产探花在线精品一区二区 | 精品久久久久久久久久久 | 天天玩天天操天天干 | 一区二区三区高清在线观看 | 精品国产欧美一区二区 | 中文字幕在线视频观看 | 黄视频免费 | 国产99久久精品一区二区永久免费 | 久久夜夜 | 日韩国产在线 | 欧美综合久久久 | 亚洲欧美在线观看 | 日韩aⅴ片 | 国产欧美日韩视频 | 亚洲视频在线观看一区二区三区 | 91久久精品一区 | 欧美午夜一区 | 亚洲视频手机在线 | 91av在线免费观看 | 伊人久久精品 | 久久久精品网 | 色又黄又爽网站www久久 | 日韩欧美国产精品一区二区三区 | 亚洲毛片在线观看 | 欧美一区二区三区高清视频 | 国产成人在线视频播放 | 欧美亚洲高清 |