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

 找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

搜索
查看: 6433|回復: 1
收起左側

關于低功耗msp430PID控制電機轉速的C程序

[復制鏈接]
ID:234213 發表于 2017-12-21 15:34 | 顯示全部樓層 |閱讀模式
#include <msp430x14x.h>
#include <math.h>
#include <stdlib.h>
unsigned int cap_tar,cap_first,cap_last,time,pluse,flag=0,temp1;
float speed,Uk,vis=0,temp2=0;
/*******************************************
函數名稱:定時器中斷服務函數
功    能:用于捕捉傳感器的脈沖信號
參    數:無
返回值  :無
********************************************/
#pragma vector=TIMERA0_VECTOR
__interrupt void timerA0(void)
{
  if(cap_tar==0)
  {
    cap_first=TACCR0;
    cap_tar++;
  }
  else
  {
    cap_last=TACCR0;
    cap_tar++;
    flag=1;
  }
}
#pragma vector=TIMERA1_VECTOR
__interrupt void timerA1(void)
{  
  switch(TAIV)
  {
  case 2:break;
  case 4:break;
  case 10:
    {     
       if(cap_last>cap_first)
        {
         if(cap_tar==0)  
            pluse=0;
         else
          {
            pluse=cap_tar-1;
            time=cap_last-cap_first;
            cap_tar=0;
          }
        }
      }   
    break;
  }
}
/*******************************************
函數名稱:Count_speed
功    能:計算實際轉速
參    數:無
返回值  :實際轉速
********************************************/
float Count_speed(int pluse,int time)
{
    float ActualSpeed;
    ActualSpeed = 2682062.0*pluse/time;   //基礎脈沖一圈一個信號
    return ActualSpeed;
}  
/*******************************************
函數名稱:增量式PID控制程序
功    能:用PID反饋控制輸出一個反饋控制量
參    數:無
返回值  :UK控制量
********************************************/   
struct _pid{
float SetSpeed;//定義設定值
float ActualSpeed;//定義實際值
float err0,err1,err2; //定義偏差值
float Kp,Ki,Kd;//定義比例、積分、微分系數
float Uk0,Uk1;//控制執行器的變量
}pid;
void PID_init(){
pid.SetSpeed=0.0;
        pid.ActualSpeed=0.0;
pid.err0=0.0;
pid.err1=0.0;
        pid.err2=0.0;
pid.Uk0=0.0;
        pid.Uk1=0.0;
pid.Kp=8;
pid.Ki=3;
pid.Kd=1;      
}        
float PID_realize(float ActuaSpeed)
{
  pid.SetSpeed=3000;
  pid.ActualSpeed=ActuaSpeed;
  pid.err0 = pid.SetSpeed - pid.ActualSpeed;
  pid.Uk0 = pid.Uk1+pid.Kp*(pid.err0-pid.err1)+pid.Ki*pid.err0+pid.Kd*(pid.err0-pid.err1-pid.err1+pid.err2);
  if(pid.Uk0>1023)
  {
    pid.Uk0=1023;   
  }
  if(pid.Uk0<0)   
  {
    pid.Uk0=1;
  }
  pid.Uk1 = pid.Uk0;
  pid.err2 = pid.err1;
  pid.err1 = pid.err0;
  Uk = pid.Uk0;
  return Uk;  
}
int main(){  
             float ActualSpeed=0;
             volatile unsigned int i;
            
             P1DIR = 0XFF;P1OUT = 0XFF;
             P2DIR = 0XFF;P2OUT = 0XFF;
             P3DIR = 0XFF;P3OUT = 0XFF;
             P4DIR = 0XFF;P4OUT = 0XFF;
             P5DIR = 0XFF;P5OUT = 0XFF;
             P6DIR = 0XFF;P6OUT = 0XFF;
   
             WDTCTL = WDTPW + WDTHOLD;   //停止看門狗
             BCSCTL1 &= ~XT2OFF;
            
              do
                {
                  IFG1 &= ~OFIFG;                           // Clear OSCFault flag
                  for (i = 0xFF; i > 0; i--);               // Time for flag to set
                }
              while ((IFG1 & OFIFG));
              
              BCSCTL2 |=SELM_2+ SELS;
              TACTL=TASSEL_1+MC_2+TACLR+TAIE;
              TACCTL0=CM_1+SCS+CCIS_0+CAP+CCIE;
              P1DIR&=~BIT1;
              P1SEL|=BIT1;
              
              TBCCTL0 = CCIE;                   //使能CCR0中斷
              TBCCR0 = 4;
              TBCTL = TBSSEL_1 + ID_3 + MC_1; //定時器A的時鐘源選擇SMCLK,增計數模式
              _EINT();

              PID_init();
              
             ActualSpeed=Count_speed(pluse,time);
            
             while(ActualSpeed!=3000.0)
                  {
                    
                   float PID_realize(float ActuaSpeed);
                  
                   BCSCTL1 |= XTS;
                   BCSCTL2 |= SELM_3;                        // MCLK=LFXT1
                   P1DIR |= 0x0C;                            // P1.2 輸出
                   P1SEL |= 0x0C;
                   TACTL = TASSEL_1 + MC_1;                  // ACLK, 增計數模式
                   CCR0 = 512-1;                             // PWM 周期
                   CCTL1 = OUTMOD_7;         // CCR1 重置/設置
                   CCR1 = (int)Uk;                         // CCR1 PWM占空比
                   _BIS_SR(LPM0_bits);
                  
                   ActualSpeed=Count_speed(pluse,time);
                  
                  }
            
}

回復

使用道具 舉報

ID:410674 發表于 2019-7-30 17:52 | 顯示全部樓層
感謝,正需要
回復

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板: 天天看天天爽 | 亚洲精品成人av久久 | 日本精品视频一区二区三区四区 | 亚洲一区二区三区在线免费 | 亚洲综合在线视频 | 亚洲免费在线 | 久久久久久久久久久久久久国产 | 亚洲视频精品 | 精品videossex高潮汇编 | 国产四区 | 精品一区二区三区av | 国产精品久久毛片av大全日韩 | 欧美在线一区二区三区四区 | 午夜在线免费观看 | 99reav| 99久久电影| 国产精品视频一区二区三区 | 日韩亚洲视频在线 | 亚洲福利 | 欧美日韩综合 | 日韩国产一区二区三区 | 日韩av一二三区 | 黄网站免费在线看 | 欧美日本在线观看 | 国产精品久久久久久av公交车 | 亚洲午夜视频在线观看 | 国产真实精品久久二三区 | 91久久久久久久 | 久久av一区二区三区 | 亚洲精品二区 | 国产三级一区二区三区 | 日日操夜夜操天天操 | 欧美日韩免费在线 | 久久久久久久电影 | 黑人精品 | 久久亚洲一区二区 | 香蕉婷婷| 久久亚洲精品国产精品紫薇 | 免费在线观看黄色av | 日本三级日产三级国产三级 | 精品视频一区二区三区四区 |