设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › MSP430单片机 › 基于MSP430G2553的直流电机调速测速装置源程序
返回列表 发新帖
查看: 2990|回复: 1
打印 上一主题 下一主题
收起左侧

基于MSP430G2553的直流电机调速测速装置源程序

[复制链接]
跳转到指定楼层
楼主
ID:388979 发表于 2019-12-25 13:32 | 只看该作者 |只看大图 回帖奖励 |倒序浏览 |阅读模式
本设计基于MSP430G2553单片机，主要用了PWM输出和捕获功能，控制算法是PID.
设置二级菜单，功能一：调速功能；通过按键加减占空比调速，通过返回按键退出此功能。
                       功能二：定速功能：通过按键设置目标转速，确认按键按下后，启动电机，自动调整到目标转速，通过返回按键退出此功能。
（附件限制了大小，能上传的也就只有程序了，有相关视频去B站搜索：飞檐走壁王不羁，即可观看相关视频）


单片机源程序如下:
  1. #include <msp430G2553.h>
  2. #include "Lcd1602.h"

  4. unsigned int DUTY=1000;   //PWM占空比           (DUTY/10000)%

  6. #define uchar unsigned char
  7. #define uint  unsigned int

  9. uchar flag=0,disp_table[6],cap_table[10],n=0;
  10. volatile uint fre_num=0;
  11. long sum=0;
  12. uint  Redge,frequence,key=4,count=0,speed=0,yes=0,fanhui=0;
  13. uint Period[10];
  14. volatile long AvgPeriod;
  15. unsigned char distr[3];

  17. //uint Real,Target;
  18. /*------------------PID参数初始化----------------------*/
  19. float kp=0.0457,ki=0.005,kd=0.1;  //PI控制参数设置
  20. float error=0,Last_error=0,Prev_error=0;
  21. float IncremDuty;

  23. /****************************增量式PI控制函数******************************/
  24. float Incremental_PID(float Real,float Target)
  25. {
  26.     error = Target - Real;
  27.     IncremDuty = kp*(2.45*error - 3.5*Last_error + 1.25*Prev_error) ;
  28.     Prev_error = Last_error;
  29.     Last_error = error;

  31.     return IncremDuty;
  32. }

  34. /****************************************字符类型转换函数***********************************************/
  35. char int_to_char(char x)
  36. {
  37.     distr[0] = (x/10) + 0x30;
  38.     distr[1] = x%10 + 0x30;
  39.     distr[2] = '\0';
  40. }

  42. /*---------------------数字转换成字符------------------------------------------------*/
  43. void num_to_char(uint k)
  44. {
  45.     uchar i=0;

  47. //    disp_table[0] = k/10000 + 0x30;      //'0'的ASCII码0x30
  48.     disp_table[0] = k%10000/1000 + 0x30;
  49.     disp_table[1] = k%1000/100 + 0x30;
  50.     disp_table[2] = k%100/10 + 0x30;
  51.     disp_table[3] = k%10 + 0x30;
  52.     disp_table[4] = 0x20;
  53.     disp_table[5] = '\0';

  55.     for(i=0;i<4;i++)  //去掉无效的前导'0'字符
  56.     {
  57.         if(disp_table[i]==0x30)
  58.             disp_table[i] = 0x20; //0x20是空格的ASCII码
  59.         else
  60.             break;
  61.     }
  62. }

  64. void long_to_char(long k)
  65. {
  66.     uchar j=0;

  68.     cap_table[0] = k/100000000 + 0x30;      //'0'的ASCII码0x30
  69.     cap_table[1] = k%100000000/10000000 + 0x30;
  70.     cap_table[2] = k%10000000/1000000 + 0x30;
  71.     cap_table[3] = k%1000000/100000 + 0x30;
  72.     cap_table[4] = k%100000/10000 + 0x30;
  73.     cap_table[5] = k%10000/1000 + 0x30;
  74.     cap_table[6] = k%1000/100 + 0x30;
  75.     cap_table[7] = k%100/10 + 0x30;
  76.     cap_table[8] = k%10 + 0x30;
  77.     cap_table[9] = '\0';

  79.     for(j=0;j<8;j++)  //去掉无效的前导'0'字符
  80.     {
  81.         if(cap_table[j]==0x30)
  82.             cap_table[j] = 0x20; //0x20是空格的ASCII码
  83.         else
  84.             break;
  85.     }
  86. }

  88. /*****************************************系统时钟源设置******************************************************/

  90. void OSC_CLK_Init(void)
  91. {
  92.    if (CALBC1_8MHZ == 0xFF || CALDCO_8MHZ == 0xFF)
  93.    {while(1);}                      // If calibration constants erased, trap CPU!!
  94.     BCSCTL1 = CALBC1_8MHZ;          // Set range
  95.     DCOCTL = CALDCO_8MHZ;           // Set DCO step + modulation

  97.     IFG1 &= ~OFIFG;                 // Clear OSCFault flag
  98.     BCSCTL2 |= SELM_1 + DIVS_3 ;    // Set MCLK=8MHz, SMCLK/
  99. }

  101. /****************************************PWM设置函数(比较模块)**************************************************/

  103. void PWM()
  104. {
  105.     TA1CTL=TASSEL_2+MC_1+TACLR;     //（定时器A1控制寄存器 ）SMCLK 1MHZ+不分频+增计数+清零
  106.     TA1CCTL2=OUTMOD_7;              //(定时器A1捕获控制寄存器2)高电平 PWM
  107.     TA1CCR0=10000-1;                //周期10000us==10ms    100HZ
  108.     TA1CCR2=DUTY;                   //高电平时间
  109. }

  111. /********************************************捕获模块寄存器设置*******************************************************/
  112. //P1.2端口设置为捕获功能，用于测量信号频率 ,当捕获频率f=1MHz时
  113. //能捕获到最大信号周期为65.536ms,频率为15.26Hz（最低信号频率）
  114. void Timer_A0_1_CAP()
  115. {
  116.      TACTL   = TASSEL_2 + MC_2 + ID_3 + TACLR;  //SMCLK=1MHz/8=0.125MHz,连续计数模式,清TAR
  117.      TACCTL1 = CAP + CCIS_0 + SCS + CM_1 + CCIE;//CCISxA,开捕获，上升沿捕获，使能,同步捕获
  118. }

  120. /*******************************************GPIO设置*****************************************************/

  122. void IO_RE()
  123. {
  124.     P2DIR |=BIT4;    //pwm输出   P2.4
  125.     P2SEL |=BIT4;    //

  127.     P1DIR&=~BIT2;    //转速捕获    P1.2
  128.     P1SEL|=BIT2;     //

  130.     //查询方式
  131.     P1DIR&=~(BIT0+BIT1+BIT3+BIT4);   //四个用户按键    0加速   1减速   3加50   4减50
  132.     P1OUT|=BIT0+BIT1+BIT3+BIT4;      //输出高电平
  133.     P1REN|=BIT0+BIT1+BIT3+BIT4;      //上拉(硬件有上拉)

  135.     P1DIR|=BIT7;                     //P1.7   LED指示灯   用于调试
  136. }

  138. /**************************************按键消抖延时函数*******************************************************/

  140. void delay_Nms(unsigned int n)
  141. {
  142.     unsigned int i;
  143.     unsigned int j;
  144.     for(i = n;i > 0;i--)
  145.         for(j = 100;j > 0;j--)
  146.             _NOP();
  147. }

  149. /****************************************主函数***************************************************/
  150. void main(void)
  151. {
  152.     WDTCTL = WDTPW | WDTHOLD;  //
  153.     OSC_CLK_Init();            //SMCLK  1M
  154.     Timer_A0_1_CAP();          //定时器A
  155.     lcdinit();
  156.     IO_RE();
  157.     _EINT();                   //开总中断

  159. while(1)
  160. {
  161. /**************************************一级菜单************************************************/

  163.     if(key==4)                        //主界面
  164.     {
  165.       disp_str(1,0,"   A: MODE 1   ");
  166.       disp_str(2,0,"   B: MODE 2   ");
  167.       DUTY=1000;
  168.       PWM();
  169.     }
  170.          //功能选项一
  171.           if(!(P1IN&BIT0))
  172.                  {
  173.                    delay_Nms(10);
  174.                      if(!(P1IN&BIT0))
  175.                        {
  176.                           while(!(P1IN&BIT0));
  177.                              {
  178.                               key=1;
  179.                              }
  180.                        }
  181.                  }
  182.          //功能选项二
  183.           if(!(P1IN&BIT1))
  184.                   {
  185.                     delay_Nms(10);
  186.                       if(!(P1IN&BIT1))
  187.                         {
  188.                           while(!(P1IN&BIT1));
  189.                              {
  190.                               key=2;
  191.                              }
  192.                         }
  193.                   }
  194. /*******************************************对应功能***************************************************/
  195. switch(key)
  196. {
  197. /********************************************功能一***************************************************/
  198.     case 1:
  199.         while(1)
  200.         {
  201.         if(count==0)                    //清除主界面
  202.         {
  203.             count=1;
  204.             lcd_clr();
  205.         }


  208.                             /********************功能一主页面***********************/
  209.                                   disp_str(1,0,"DUTY=");
  210.                                   int_to_char(DUTY/100);   //占空比数值显示
  211.                                   disp_str(1,6,"   ");
  212.                                   disp_str(1,9,distr);
  213.                                   disp_str(1,11,"%   ");
  214.                                   disp_str(2,0,"n=");      //转速
  215.                                   disp_str(2,6,"r/min ");

  217.                             /*****************计算显示频率(转速)*********************/
  218.                                       if(flag==1)
  219.                                       {
  220.                                           frequence = (uint)(125000/AvgPeriod)*30;     //计算信号转速
  221.                                           num_to_char(frequence);
  222.                                           disp_str(2,2,disp_table);
  223.                                           flag = 0;
  224.                                       }

  226. /*********************************************加速按键1************************************************/
  227.         if(!(P1IN&BIT0)&&key==1)
  228.            {
  229.              delay_Nms(10);
  230.                if(!(P1IN&BIT0)&&key==1)
  231.                  {
  232.                     disp_str(1,5,"+1%");
  233.                     while(!(P1IN&BIT0)&&key==1);
  234.                        {
  235.                             P1OUT^=BIT7;
  236.                             DUTY+=100;
  237.                                if(DUTY>9000)
  238.                                   {
  239.                                       DUTY=9000;
  240.                                   }
  241.                             PWM();
  242.                             disp_str(1,5,"   ");

  244.                        }
  245.                   }
  246.             }
  247. /*********************************************减速按键2**************************************************/
  248.         if(!(P1IN&BIT1)&&key==1)
  249.            {
  250.              delay_Nms(10);
  251.                if(!(P1IN&BIT1)&&key==1)
  252.                  {
  253.                     disp_str(1,5,"-1%");
  254.                     while(!(P1IN&BIT1)&&key==1);
  255.                        {
  256.                             P1OUT^=BIT7;
  257.                             DUTY-=100;
  258.                                if(DUTY<1000)
  259.                                   {
  260.                                       DUTY=1000;
  261.                                   }
  262.                             PWM();
  263.                             disp_str(1,5,"   ");
  264.                        }
  265.                   }
  266.             }

  268. /*********************************************返回按键4*********************************************/
  269.         if(!(P1IN&BIT4))
  270.                     {
  271.                       delay_Nms(10);
  272.                         if(!(P1IN&BIT4))
  273.                           {
  274.                              while(!(P1IN&BIT4));
  275.                                 {
  276.                                   key=4;
  277.                                   break;
  278.                                 }
  279.                           }
  280.                     }
  281.         }
  282.         ;
  283.      break;


  286. /********************************************功能二******************************************/
  287.     case 2:
  288.         while(1)
  289.         {
  290.         if(count==0)                    //清除主界面
  291.         {
  292.             count=1;
  293.             lcd_clr();
  294.         }
  295.         DUTY=0;
  296.         PWM();
  297.         disp_str(1,1,"Input:");
  298.         disp_str(2,1,"speed:");
  299.         /*****************计算显示频率(转速)*********************/
  300.           if(flag==1)
  301.           {
  302.               frequence = (uint)(125000/AvgPeriod)*30;     //计算信号转速
  303.               num_to_char(frequence);
  304.               disp_str(2,7,disp_table);
  305.               flag = 0;
  306.           }

  308.           /*******************************************加按键1***********************************************/
  309.                   if(!(P1IN&BIT0)&&key==2)
  310.                      {
  311.                        delay_Nms(10);
  312.                          if(!(P1IN&BIT0)&&key==2)
  313.                            {
  314.                               while(!(P1IN&BIT0)&&key==2);
  315.                                  {
  316.                                       speed+=60;
  317.                                       if(speed>2400)  speed = 2400;
  318.                                  }
  319.                             }
  320.                       }
  321.           /*******************************************减按键2***********************************************/
  322.                           if(!(P1IN&BIT1)&&key==2)
  323.                              {
  324.                                delay_Nms(10);
  325.                                  if(!(P1IN&BIT1)&&key==2)
  326.                                    {
  327.                                       while(!(P1IN&BIT1)&&key==2);
  328.                                          {
  329.                                               speed-=60;
  330.                                               if(speed<900)   speed = 900;
  331.                                          }
  332.                                     }
  333.                               }

  335.                           num_to_char(speed);
  336.                           disp_str(1,7,disp_table);
  337.          /*********************************************确认按键3*********************************************/
  338.                           if(!(P1IN&BIT3)&&key==2)
  339.                              {
  340.                                delay_Nms(10);
  341.                                  if(!(P1IN&BIT3)&&key==2)
  342.                                    {
  343.                                       while(!(P1IN&BIT3)&&key==2);
  344.                                          {
  345.                                            yes=3;
  346.                                          }
  347.                                     }
  348.                               }
  349.                             if(yes==3)
  350.                             {
  351.                                 DUTY=900;
  352.                                 PWM();
  353.                                 while(fanhui==0) //如果没有按返回按键
  354.                                   {
  355.                                      delay_Nms(150);
  356.                                      if(flag==1) //检测当前风扇转速并显示
  357.                                        {
  358.                                          frequence = (uint)(125000/AvgPeriod)*30; //计算信号转速
  359.                                          num_to_char(frequence);
  360.                                          disp_str(2,7,disp_table);   //显示当前转速
  361.                                          flag = 0;
  362.                                        }
  363.                                        //根据设定转速进行PID调节
  364.                                      if(fabs(frequence-speed)>20)
  365.                                        {
  366.                                          DUTY = DUTY + (int)Incremental_PID(frequence,speed);
  367.                                          TA1CCR2 = DUTY;
  368.                                        }
  369.                                      if(!(P1IN&BIT4))
  370.                                        {
  371.                                         delay_Nms(10);
  372.                                           if(!(P1IN&BIT4))
  373.                                              {
  374.                                                while(!(P1IN&BIT4));
  375.                                                    {
  376.                                                      fanhui=1;
  377.                                                      break;
  378.                                                    }
  379.                                              }
  380.                                        }
  381.                                   }

  383.                                 if(!(P1IN&BIT4))
  384.                                    {
  385.                                      delay_Nms(10);
  386.                                        if(!(P1IN&BIT4))
  387.                                          {
  388.                                             while(!(P1IN&BIT4));
  389.                                                {
  390.                                                  fanhui=0;speed=0;DUTY=0;yes=0;
  391.                                                  key=4;
  392.                                                  break;
  393.                                                }
  394.                                           }
  395.                                    }


  398.                            }
  399.          /*********************************************返回按键4*********************************************/
  400.       }
  401.      break;

  403. }

  405. }
  406. }





  412. /******************************************************************
  413. * TA0.1  P1.2捕获中断
  414. * 捕获测频原理：分别记录第1次和第2次捕获到上升沿的时刻Redge1、Redge2，
  415. * 则信号周期为：Period = Redge2 - Redge1
  416. *******************************************************************/
  417. #pragma vector = TIMER0_A1_VECTOR
  418. __interrupt void TIMER0_A1_ISR(void)
  419. {
  420.        switch(TAIV)
  421.        {
  422.            case  0x02:                   //Vector 2:TACCR1 CCIFG
  423.                  if(fre_num == 0)        // 捕获上升沿信号
  424.                  {
  425.                      Redge = TACCR1;
  426.                      fre_num++;
  427.                  }
  428.                  else
  429.                  {
  430.                      _DINT();
  431.                      if(TACCR1 > Redge)  //第二次捕获上升沿
  432.                          Period[n] = TACCR1 - Redge;  //计算周期
  433.                      else
  434.                          Period[n] = 65536 + TACCR1 - Redge;

  436.                      Redge = TACCR1; //保存上次捕获值

  438.                      sum += (long)Period[n];
  439.                      n++;
  440.                      if(n==10)
  441.                      {flag=1;AvgPeriod = sum/10;n=0;sum=0;} //取10次捕获值的平均
  442.                      _EINT();
  443.                  }
  444.                  break;
  445.            case 0x0A:
  446.                     //溢出次数计数
  447.                break;

  449.            default: break;
  450.      }
  451. }
复制代码

所有资料51hei提供下载:
test speed 程序.rar (71.68 KB, 下载次数: 31)

评分

参与人数 1黑币 +50 收起 理由
admin + 50 共享资料的黑币奖励！

查看全部评分

分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏2 分享淘帖 顶顶 踩踩
回复

使用道具 举报

沙发
ID:625113 发表于 2019-12-26 08:39 来自手机 | 只看该作者
感谢分享
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表