欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

 找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

搜索
查看: 3524|回復: 0
收起左側

電子設計競賽pid四軸(王者版)stm32源碼與資料下載

[復制鏈接]
ID:218295 發表于 2017-8-10 21:51 | 顯示全部樓層 |閱讀模式
0.png

轉速、電流雙閉環直流調速系統和調節器的工程設計方法2.1  
轉速、電流雙閉環直流調速系統及其靜特性
采用PI調節的單個轉速閉環直流調速系統可以在保證系統穩定的前提下實現轉速無靜差。但是,如果對系統的動態性能要求較高,單閉環系統就難以滿足需要,這主要是因為在單閉環系統中不能控制電流和轉矩的動態過程。電流截止負反饋環節是專門用來控制電流的,并不能很理想地控制電流的動態波形,圖2-1a)。
在起動過程中,始終保持電流(轉矩)為允許的最大值,使電力拖動系統以最大的加速度起動,到達穩態轉速時,立即讓電流降下來,使轉矩馬上與負載相平衡,從而轉入穩態運行。這樣的理想起動過程波形示于圖2-1b。
為了實現在允許條件下的最快起動,關鍵是要獲得一段使電流保持為最大值的恒流過程。按照反饋控制規律,采用某個物理量的負反饋就可以保持該量基本不變,那么,采用電流負反饋應該能夠得到近似的恒流過程。應該在起動過程中只有電流負反饋,沒有轉速負反饋,達到穩態轉速后,又希望只要轉速負反饋,不再讓電流負反饋發揮作用。
0.png

stm32單片機源程序如下:
  1. #include"pid.h"
  2. #include"fuzzy.h"
  3. #include"pwm.h"
  4. #include"dac.h"


  5.   PIDtypedef PID1;         //PID結構體
  6. PIDtypedef PID2;
  7. PIDtypedef PID3;
  8. PIDtypedef PID4;

  9. extern u8 start_flag;
  10. extern u16 pwm1,pwm2,pwm3,pwm4;

  11. void PIDperiodinit(u16 arr,u16 psc)
  12. {
  13.     TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
  14.         NVIC_InitTypeDef NVIC_InitStructure;

  15.         RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM6, ENABLE); //時鐘使能
  16.         
  17.         //定時器TIM6初始化
  18.         TIM_TimeBaseStructure.TIM_Period = arr; //設置在下一個更新事件裝入活動的自動重裝載寄存器周期的值        
  19.         TIM_TimeBaseStructure.TIM_Prescaler =psc; //設置用來作為TIMx時鐘頻率除數的預分頻值
  20.         TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1; //設置時鐘分割:TDTS = Tck_tim
  21.         TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上計數模式
  22.         TIM_TimeBaseInit(TIM6, &TIM_TimeBaseStructure); //根據指定的參數初始化TIMx的時間基數單位

  23.         TIM_ITConfig(TIM6,TIM_IT_Update,ENABLE ); //使能指定的TIM3中斷,允許更新中斷

  24.         //中斷優先級NVIC設置
  25.         NVIC_InitStructure.NVIC_IRQChannel = TIM6_IRQn;  //TIM3中斷
  26.         NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1;  //先占優先級1級
  27.         NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;  //從優先級1級
  28.         NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ通道被使能
  29.         NVIC_Init(&NVIC_InitStructure);  //初始化NVIC寄存器


  30. //        TIM_Cmd(TIM6, ENABLE);  //放在主程序中使能

  31. }


  32. void TIM6_IRQHandler(void)        //        采樣時間到,中斷處理函數
  33. {         
  34.         
  35. if (TIM_GetITStatus(TIM6, TIM_IT_Update) != RESET)//更新中斷
  36.         {

  37.         frequency1=1000000/period_TIM4        ; //通過捕獲的波形的周期算出頻率
  38.         frequency2=1000000/period_TIM1        ;
  39.         frequency3=1000000/period_TIM2        ;
  40.         frequency4=1000000/period_TIM5        ;
  41. /********PID1處理**********/
  42.         PID1.sum_error+=(incPIDcalc(&PID1,frequency1));         //計算增量并累加
  43.        pwm1=PID1.sum_error*4.6875  ;   //pwm1 代表將要輸出PWM的占空比
  44.           frequency1=0; //清零
  45.      period_TIM4=0;
  46. /********PID2處理**********/
  47.          PID2.sum_error+=(incPIDcalc(&PID2,frequency2));         //計算增量并累加  Y=Y+Y'               
  48.          pwm2=PID2.sum_error*4.6875 ;   //將要輸出PWM的占空比
  49.         frequency2=0;
  50.         period_TIM1=0;
  51. /********PID3處理**********/
  52.          PID3.sum_error+=(incPIDcalc(&PID3,frequency3));          //常規PID控制
  53.         pwm3=PID3.sum_error*4.6875 ;   //將要輸出PWM的占空比
  54.         frequency3=0;
  55.         period_TIM2=0;

  56. /********PID4處理**********/
  57.             PID4.sum_error+=(incPIDcalc(&PID4,frequency4));         //計算增量并累加
  58.          pwm4=PID4.sum_error*4.6875 ;   //將要輸出PWM的占空比
  59.         frequency4=0;
  60.         period_TIM5=0;

  61.           }
  62.          TIM_SetCompare(pwm1,pwm2,pwm3,pwm4);             //重新設定PWM值
  63. TIM_ClearITPendingBit(TIM6, TIM_IT_Update); //清除中斷標志位               
  64. }
  65. void incPIDinit(void)
  66. {
  67. //PID1參數初始化
  68. PID1.sum_error=0;
  69. PID1.last_error=0;
  70. PID1.prev_error=0;
  71. PID1.proportion=0;
  72. PID1.integral=0;
  73. PID1.derivative=0;
  74. PID1.setpoint=0;

  75. //PID2參數初始化
  76. PID2.sum_error=0;
  77. PID2.last_error=0;
  78. PID2.prev_error=0;
  79. PID2.proportion=0;
  80. PID2.integral=0;
  81. PID2.derivative=0;
  82. PID2.setpoint=0;

  83. //PID3參數初始化
  84. PID3.sum_error=0;
  85. PID3.last_error=0;
  86. PID3.prev_error=0;
  87. PID3.proportion=0;
  88. PID3.integral=0;
  89. PID3.derivative=0;
  90. PID3.setpoint=0;

  91. //PID4參數初始化
  92. PID4.sum_error=0;
  93. PID4.last_error=0;
  94. PID4.prev_error=0;
  95. PID4.proportion=0;
  96. PID4.integral=0;
  97. PID4.derivative=0;
  98. PID4.setpoint=0;
  99. }
  100. void PID_setpoint(PIDtypedef*PIDx,u16 setvalue)
  101. {
  102.   PIDx->setpoint=setvalue;
  103. }
  104. int incPIDcalc(PIDtypedef *PIDx,u16 nextpoint)
  105. {
  106. int iError,iincpid;
  107. iError=PIDx->setpoint-nextpoint;  //當前誤差
  108. /*iincpid=                                               //增量計算
  109. PIDx->proportion*iError                //e[k]項
  110. -PIDx->integral*PIDx->last_error          //e[k-1]
  111. +PIDx->derivative*PIDx->prev_error;//e[k-2]
  112. */
  113. iincpid=                                                          //增量計算
  114. PIDx->proportion*(iError-PIDx->last_error)
  115. +PIDx->integral*iError
  116. +PIDx->derivative*(iError-2*PIDx->last_error+PIDx->prev_error);

  117. PIDx->prev_error=PIDx->last_error; //存儲誤差,便于下次計算
  118. PIDx->last_error=iError;
  119. return(iincpid) ;
  120. }
  121. void PID_set(float pp,float ii,float dd)
  122. {
  123.   PID1.proportion=pp;
  124. PID1.integral=ii;
  125. PID1.derivative=dd;
  126. PID2.proportion=pp;
  127. PID2.integral=ii;
  128. PID2.derivative=dd;
  129.   PID3.proportion=pp;
  130. PID3.integral=ii;
  131. PID3.derivative=dd;
  132.   PID4.proportion=pp;
  133. PID4.integral=ii;
  134. PID4.derivative=dd;
  135. }

  136. /*最后設定四個輪子的轉速,轉速 1rad/s等價于122.23個脈沖每秒的轉速*/
  137.   void set_speed(float W1,float W2,float W3,float W4)
  138.         {
  139.                         float temp;
  140.                            
  141. ……………………

  142. …………限于本文篇幅 余下代碼請從51黑下載附件…………
復制代碼

所有資料51hei提供下載:
pid.rar (249.46 KB, 下載次數: 45)



評分

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

查看全部評分

回復

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表