2023年全國碩士研究生考試考研英語一試題真題(含答案詳解+作文范文)_第1頁
已閱讀1頁,還剩7頁未讀, 繼續(xù)免費閱讀

下載本文檔

版權(quán)說明:本文檔由用戶提供并上傳,收益歸屬內(nèi)容提供方,若內(nèi)容存在侵權(quán),請進行舉報或認(rèn)領(lǐng)

文檔簡介

1、/**********************舵機增量式 PID 算法*********************** double ref = 0;//設(shè)置參數(shù) 設(shè)定值 double feb = 0;//采樣反饋 過程值int pwm_var = 0; //PID 調(diào)整量 int PWM_out = 0; //PWM 輸出量double Uo = 0;double Ek = 0; double Ei = 0; do

2、uble Ed = 0; #define Kp 8 //PID 調(diào)節(jié)的比例常數(shù) #define Ti 0.05 //PID 調(diào)節(jié)的積分常數(shù) #define Td 0.02 //PID 調(diào)節(jié)的微分時間常數(shù) #define T 0.02 //采樣周期#define Kpp Kp * ( 1 + (T / Ti) + (Td / T) )#define Ki (-Kp) * (

3、1 + (2 * Td / T ) )#define Kd Kp * Td / T//#define Kpp 4//#define Ki 0.8//#define Kd 20//誤差的閥值,小于這個數(shù)值的時候,不做 PID 調(diào)整,避免誤差較小時頻繁調(diào)節(jié) 引起震蕩 #define Emin 3//調(diào)整值限幅,防止積分飽和 #define Umax 100 #define Umin -100//輸出值限幅 #define Pmax

4、 15500#define Pmin 200 /////////////////////////////////////////////////////////////////// ////// PID 運算 ///////1#define G_Kp 8 //P 8 #define G_Ki 15 //I #define G_Kd 0 //D int error;i

5、nt pre_error; int last_error;int U_error;uint U_Pre1=9000; //擺頭舵機中心位置 uint U_Pre2=8600; //方向舵機中心位置 uchar sum;uchar temp,tt,ss;/**************************************************函數(shù):delay_ms()描述:延遲 x*10 微秒

6、**************************************************/ void delay(uint time) {while(time--){_asm(nop);_asm(nop);_asm(nop);_asm(nop);_asm(nop);_asm(nop);_asm(nop);_asm(nop);_asm(nop);_asm(nop);} }void display(){sum = 0;error

溫馨提示

  • 1. 本站所有資源如無特殊說明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請下載最新的WinRAR軟件解壓。
  • 2. 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
  • 3. 本站RAR壓縮包中若帶圖紙,網(wǎng)頁內(nèi)容里面會有圖紙預(yù)覽,若沒有圖紙預(yù)覽就沒有圖紙。
  • 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
  • 5. 眾賞文庫僅提供信息存儲空間,僅對用戶上傳內(nèi)容的表現(xiàn)方式做保護處理,對用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對任何下載內(nèi)容負(fù)責(zé)。
  • 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請與我們聯(lián)系,我們立即糾正。
  • 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時也不承擔(dān)用戶因使用這些下載資源對自己和他人造成任何形式的傷害或損失。

評論

0/150

提交評論