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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

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

STM8單片機直流電機伺服控制設計程序

[復制鏈接]
跳轉到指定樓層
樓主
有需要的可以直接下載

單片機源程序如下:
  1. //#include "iostm8s103k3.h"
  2. #include "iostm8s207r8.h"



  6. //STM8S207單片機; 連上仿真器后，ST-LINK-->Option Bytes: AFR5，右鍵-->Alternate Active,使PB0/PB1/PB2為PWM輸出端口功能。
  7. //下載運行后，View-->Livewatch，觀察PID控制參數的變化，觀察LED1的亮度；
  8. //TIM2中斷作為計時時間；PE0作為外中斷輸入;把外部頻率信號與PE0連接，進行脈沖計數（頻率測量）

  10. //開發板上用杜邦線把PB0與PD5連接起來；
  11. //單片機PC1（PWM輸出）與焊的電路板PC1端子連接；電機編碼器轉速信號（黃線）與單片機PE0連接；
  12. //電機編碼器供電正極（藍線）接+5V；電機編碼器供電負極（黑線）接GND；
  13. //電機本身供電正極（紅線）接+12V，電機本身供電負極（白線）接焊的電路板的P1排針的第3腳（功率三極管集電極），
  14. //焊的電路板接線參考《直流電機PWM調速電路圖》

  16. unsigned long   pulsecount=0;
  17. unsigned long   frequency=0;   
  18. static const unsigned int ArrPwmVal = 16000; //PWM信號周期:1ms, 1KHz
  19. int    pwmvalue=8000;                          //pwm1value取值范圍0~16000；
  20. float  Kp=10,Ki=0.1,Kd=0;                      //PID參數
  21. float  set_velocity=1000.0, sample_velocity=0;
  22. float  PIDoutvalue=0;                          //PID運算輸出值
  23. int    duty=0;                                 //PWM波占空比

  25. void Delay1ms(unsigned int c )                //1ms延遲函數                  
  26. {
  27.     unsigned int i;
  28.    
  29.     while(c--!=0)                             //一個while循環占用3個機器周期
  30.         for(i=0;i<3000;i++);                   //一條for循環占用4個機器周期
  31. }

  33. void InitLED(void)
  34. {
  35.     PD_DDR|=0x60;  //設置PD5、PD6為輸出模式
  36.     PD_CR1|=0x60;  //設置PD5、PD6為推挽輸出
  37. }


  40. //1KHZ PWM頻率；//上橋臂PWM---PC1\PC2\PC3；下橋臂PWM---PB0\PB1\PB2
  41. void InitTIM1_PWM(void)  //16 位高級控制定時器(TIM1)；定時器16MHz基準; 只使用了CC1P通道
  42. {
  43.                    //分頻,1分頻; 計數器的時鐘頻率(fCK_CNT)等于fCK_PSC/( PSCR[15:0]+1)
  44.     TIM1_PSCRH=0;  //預分頻器高8位(TIM1_PSCRH)
  45.     TIM1_PSCRL=0;  //預分頻器低8位(TIM1_PSCRL)
  46.      
  47.     TIM1_ARRH=ArrPwmVal/256;
  48.     TIM1_ARRL=ArrPwmVal%256;
  49.    
  50.     TIM1_CR1 = 0x04;   //DIR0:向上計數；URS=1：寄存器被更新時，產生更新中斷
  51.     TIM1_CCMR1 = 0x60; //PWM1模式，禁止預裝載
  52.    
  53.     TIM1_CCER1=0x01;   //CH1通道輸出PWM使能，高電平有效

  55.     TIM1_BKR|=0x80;    //使能PWM輸出 //0x80;使能OC和OCN輸出;MOE: 主輸出使能
  56.    
  57.            
  58.     TIM1_CR1 |= 0x01;  //使能定時計數器
  59. }


  62. void TIM2_Init(unsigned int psc,unsigned int arr)  //psc  分頻系數  arr  計數值
  63. {
  64.     TIM2_CR1 = 0x00;       //向上計數   中斷繼續計數   關閉計數器
  65.     TIM2_IER = 0x01;       //UIE=1:允許更新中斷
  66.     TIM2_PSCR = psc;       //fMASTER/2^psc;
  67.     TIM2_ARRH = arr/256;
  68.     TIM2_ARRL = arr%256;
  69.     TIM2_CR1 |=0x01;       //開始計數
  70.   
  71. }

  73. void InitEXTI(void)  //PE0作為外中斷輸入
  74. {                     //PEx對應EXTI4_IRQHandler
  75.     EXTI_CR2=0x02;   //PE端口下降沿觸發中斷
  76.     PE_DDR&=0xFE;    //PE0為輸入模式
  77.     PE_CR1|=0x01;    //PE0上拉
  78.     PE_CR2|=0x01;    //PE0使能外部中斷
  79. }

  81. /**************************************************************************
  82. 函數功能：位置式PID控制器
  83. 入口參數：編碼器測量位置信息，目標位置
  84. 返回  值：sum
  85. 根據位置式離散PID公式
  86. pwm=Kp*e(k)+Ki*∑e(k)+Kd[e（k）-e(k-1)]
  87. e(k)代表本次偏差
  88. e(k-1)代表上一次的偏差  
  89. ∑e(k)代表e(k)以及之前的偏差的累積和;
  90. pwm代表輸出
  91. **************************************************************************/
  92. float Position_PID (float set_value,float feedback_value)
  93. {        
  94.      static float error,sum,Integral_part,pre_error;
  95.    
  96.      error=set_value-feedback_value;                       //計算偏差
  97.      Integral_part+=error;                                       //求出偏差的積分
  98.      if(Integral_part>15000) Integral_part=15000;
  99.      if(Integral_part<0) Integral_part=0;
  100.      sum=Kp*error+Ki*Integral_part+Kd*(error-pre_error);   //位置式PID控制器
  101.      pre_error=error;                                      //保存上一次偏差
  102.    
  103.      if(sum<0)
  104.        sum=0;
  105.      
  106.      PIDoutvalue=sum;
  107.       
  108.      return sum;                                           //增量輸出
  109. }



  113. void main( void )
  114. {
  115.     CLK_CKDIVR=0x00;      //HSI不分頻，主時鐘16M  
  116.    
  117.     InitLED();
  118.     InitTIM1_PWM();
  119.     InitEXTI();
  120.    
  121.     asm("sim");          //disable all interrupt  EA=0;
  122.     TIM2_Init(8,62499);  // 定時器2中斷周期: 2^8/16M *62500=1s;  
  123.     asm("rim");          //開中斷
  124.    
  125.     frequency=0;
  126.    
  127.     while(1)
  128.     {   
  129.         sample_velocity=frequency;
  130.       //  pwmvalue=(int)Position_PID(set_velocity,sample_velocity);
  131.         
  132.         if(pwmvalue<0)
  133.             pwmvalue=0;
  134.         if(pwmvalue>15900)
  135.             pwmvalue=15900;         //PWM限幅
  136.       
  137.            
  138.         TIM1_CCR1H = pwmvalue/256;  //PWM1通道占空比寄存器賦值
  139.         TIM1_CCR1L = pwmvalue%256;
  140.         
  141.         duty=pwmvalue/160;          //占空比duty=pwmvalue/16000 *100%;
  142.         
  143.         Delay1ms(10);               //轉速閉環控制周期：10ms;

  145.     }

  147. }



  151. #pragma vector=0x09   // 9:  EXTI4  端口E外部中斷
  152. __interrupt void EXTI4_IRQHandler(void) //PE
  153. {
  154.     pulsecount++;
  155. }

  157. #pragma vector=15
  158. __interrupt void TIM2_OVER_INT(void)
  159. {
  160.     TIM2_SR1 = 0x00;
  161.    
  162.     frequency=pulsecount;   //電機旋轉1周輸出6個脈沖
  163.     pulsecount=0;
  164.    
  165.     PD_ODR ^=0x60;            //PD5、PD6閃爍
  166.    
  167. }
復制代碼
  1. //#include "iostm8s103k3.h"
  2. #include "iostm8s207r8.h"



  6. //207單片機; 連上仿真器后，ST-LINK-->Option Bytes: AFR5，右鍵-->Alternate Active,使PB0/PB1/PB2為PWM輸出端口功能。
  7. //16KHZ PWM頻率
  8. //上橋臂PWM---PC1\PC2\PC3
  9. //下橋臂PWM---PB0\PB1\PB2
  10. //用杜邦線把PB0與PD5連接起來；先下載程序，再連線;
  11. //下載運行后，View-->Livewatch，改變pwmvalue1的值，改變PWM1占空比，觀察LED1的亮度；

  13. static const unsigned int ArrPwmVal = 1000; //PWM信號周期; 1000
  14. unsigned int pwm1value=500;


  17. void InitTIM1_PWM(void)  //16 位高級控制定時器(TIM1)；1us定時器時鐘基準
  18. {
  19.                    //分頻,1分頻; 計數器的時鐘頻率(fCK_CNT)等于fCK_PSC/( PSCR[15:0]+1)
  20.     TIM1_PSCRH=0;  //預分頻器高8位(TIM1_PSCRH)
  21.     TIM1_PSCRL=15;  //預分頻器低8位(TIM1_PSCRL)
  22.      
  23.     TIM1_ARRH=ArrPwmVal/256;
  24.     TIM1_ARRL=ArrPwmVal%256;
  25.    
  26.     TIM1_CR1 = 0x04;   //DIR0:向上計數；URS=1：寄存器被更新時，產生更新中斷
  27.     TIM1_CCMR1 = 0x60; //PWM1模式，禁止預裝載
  28.    
  29.     TIM1_CCER1=0x05;   //CH1、CH2通道輸出PWM使能，高電平有效

  31.     TIM1_BKR|=0x80;    //使能PWM輸出 //0x80;使能OC和OCN輸出;MOE: 主輸出使能
  32.     TIM1_DTR=16;       //死區62.5ns*16=1us
  33.    
  34.            
  35.     TIM1_CR1 |= 0x01;  //使能定時計數器
  36. }




  41. void main( void )
  42. {
  43.   
  44.   CLK_CKDIVR=0x00;//HSI不分頻，主時鐘16M  
  45.   InitTIM1_PWM();
  46.   
  47.   while(1)
  48.   {
  49.       TIM1_CCR1H = pwm1value/256;  //PWM1通道占空比10%
  50.       TIM1_CCR1L = pwm1value%256;     
  51.       
  52.   }

  54. }
復制代碼

所有資料51hei提供下載:
直流電機伺服控制設計訓練.zip (1.29 MB, 下載次數: 23)

評分

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

查看全部評分

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

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 精品视频一区二区三区在线观看 | 国产99免费 | 欧美aaa| 国产成人免费视频网站高清观看视频 | 欧美视频在线观看 | 欧美日韩免费一区二区三区 | 亚洲精品视频一区 | 免费国产视频在线观看 | 视频一二区 | 成人av大全 | 三级在线视频 | 国产欧美性成人精品午夜 | 国产视频久久 | 久久国产精品一区二区三区 | 成人欧美一区二区三区在线观看 | 日本三级网站在线观看 | 九一在线| 日韩中文字幕一区 | 黄色av一区 | 日韩欧美在线一区 | 久草视频在线播放 | 亚洲精品国产精品国自产在线 | 精品综合久久久 | 欧美日韩一区二区电影 | 欧美激情国产精品 | 夜夜艹| 成人在线播放网址 | 亚洲成人一区二区三区 | 亚洲一区二区三区久久久 | av中文字幕网站 | 国产精品欧美一区二区三区 | 久久一日本道色综合久久 | 天天综合网天天综合色 | 久久之精品 | 国产精品一区三区 | 精品久久久久久久久久久久 | 国产成人99久久亚洲综合精品 | 免费一级欧美在线观看视频 | 国产精品亚洲一区 | 日韩成人一区 | 成人综合一区二区 |