中文资源在线播放,视频在线观看99,久久精品亚洲

//************************項目信息**************************
//項目名稱:
//客戶名稱:
//************************文件信息**************************
//文件名稱:pi.c
//作者:Lebo
//文件版本:
//校驗和:
//************************硬件信息**************************
//目標器件:
//源時鐘:
//UCBA型號:
//************************平臺信息**************************
//開發環境:
//燒錄環境:
//配置內容:
//************************功能信息**************************
//程序功能:
//函數列表:
//************************修改記錄**************************
// <author> <time> <version> <desc>
//1.Lebo 15/01/11 V1.0 build this moudle
//2.
//**********************************************************
//**********************************************************
//程序名稱:頭文件
//程序說明:
//**********************************************************
#include "pid.h"
//**********************************************************
//程序名稱:增量式PID初始化函數
//入口參數:*ptrPID
//出口參數:e0, e1, e2, ka, kb, kc, kz, max_adjust, max_out, min_out
//返回參數:
//調用函數:
//程序說明:
//**********************************************************
void PID_IncInit(PID_TypeDef *ptrPID){
(* ptrPID).e0 = 0;
(* ptrPID).e1 = 0;
(* ptrPID).e2 = 0;
(* ptrPID).ka = 0;
(* ptrPID).kb = 0;
(* ptrPID).kc = 0;
(* ptrPID).kz = 0;
(* ptrPID).maxAdjust = 0;
(* ptrPID).maxOut = 0;
(* ptrPID).minOut = 0;
}
//**********************************************************
//程序名稱:增量式PID系數設置函數
//入口參數:kp, ki, kd, z, *pid_ptr
//出口參數:ka, kb, kc, kz
//返回參數:
//調用函數:
//程序說明:
/*
T--------采樣周期
Ti-------積分時間
Td-------微分時間
Kp = Kp
Ki = Kp*T/Ti
Kd = Kp*Td/T
A = Kp+Ki+Kd = Kp*(1 + T/Ti + Td/T)
B = Kp+2*Kd = Kp*(1 + 2Td/T)
C = Kd = Kp*Td/T
*///120,11,0,10
//**********************************************************
void PID_IncSetRatio(u8 kp, u8 ki, u8 kd, u8 kz, PID_TypeDef *ptrPID){
(* ptrPID).ka = kp + ki + kd;
(* ptrPID).kb = kp + (2 * kd);
(* ptrPID).kc = kd;
(* ptrPID).kz = kz;
}
//**********************************************************
//程序名稱:PID系數極限設置函數
//入口參數:max_ajst, max_outval, min_outval, *pid_ptr
//出口參數:max_adjust, max_out, min_out
//返回參數:
//調用函數:
//程序說明:
//**********************************************************
void PID_IncSetRatioLimit(s8 maxAdjust, u8 maxOut, u8 minOut, PID_TypeDef *ptrPID){
(* ptrPID).maxAdjust = maxAdjust;
(* ptrPID).maxOut = maxOut;
(* ptrPID).minOut = minOut;
}
//**********************************************************
//程序名稱:增量式PID 函數
//入口參數:nonce_error, pid_ptr, out_ptr
//出口參數:*out_ptr
//返回參數:
//調用函數:
//程序說明:
/*
////位置式PID控制算式
//// 離散的PID表達式:
//// U(n) = Kp*{e(n) + (T/Ti)*Sum[e(0)+e(1)...+e(n)] + (Td/T)*[e(n)-e(n-1)]}
//// U(n) = Kp*e(n) + Ki*Sum[e(0)~e(n)] + Kd*[e(n)-e(n-1)]
//// 說明:
//// n--------采樣序號，n＝0，1，2，…… 。
//// U(n)-----第n次采樣時刻的計算輸出量
//// e(n)-----第n次采樣時刻輸入的偏差值
//// e(n-1)---第n-1次采樣時刻輸入的偏差值
//// T--------采樣周期
//// Ti-------積分時間
//// Td-------微分時間
//// Kp-------比例系數
//// Ki-------積分系數，Ki = Kp*T/Ti
//// Kd-------微分系數，Kd = Kp*Td/T
增量式PID控制算式(廣泛應用)
增量式PID控制算法公式:
dU(n) = U(n)-U(n-1)
dU(n) = Kp*[e(n)-e(n-1)] + Ki*e(n) + Kd*[e(n)-2*e(n-1)+e(n-2)]
dU(n) = (Kp+Ki+Kd)*e(n) - (Kp+2*Kd)*e(n-1) + e(n-2)*Kd
dU(n) = A*e(n) - B*e(n-1) + C*e(n-2)
說明:
T--------采樣周期
Ti-------積分時間
Td-------微分時間
Kp = Kp
Ki = Kp*T/Ti
Kd = Kp*Td/T
A = Kp+Ki+Kd = Kp*(1 + T/Ti + Td/T)
B = Kp+2*Kd = Kp*(1 + 2Td/T)
C = Kd = Kp*Td/T
由于單片機的處理速度和ram 資源的限制，一般不采用浮點數運算，而將所有參數全部用整
數，運算到最后再除以一個2的N次方數據（相當于移位），作類似定點數運算，可大大提高
運算速度，根據控制精度的不同要求，當精度要求很高時，注意保留移位引起的“余數”，做
好余數補償。
*/
//**********************************************************
void PID_IncCompute(s16 offset, u8 *ptrOut, PID_TypeDef *ptrPID){
s16 outResult = (s16)(* ptrOut);
s32 median;
s8 adjust;
(* ptrPID).e2 = (* ptrPID).e1;
(* ptrPID).e1 = (* ptrPID).e0;
(* ptrPID).e0 = offset;
median = (s32)(* ptrPID).ka * (* ptrPID).e0 -\
(s32)(* ptrPID).kb * (* ptrPID).e1 +\
(s32)(* ptrPID).kc * (* ptrPID).e2;
median = median >> (* ptrPID).kz;
if(median < -(* ptrPID).maxAdjust)
adjust = -(* ptrPID).maxAdjust;
else if(median > (* ptrPID).maxAdjust)
adjust = (* ptrPID).maxAdjust;
else
adjust = (s8)median;
outResult += adjust;
if(outResult > (* ptrPID).maxOut)
outResult = (* ptrPID).maxOut;
else if(outResult < (* ptrPID).minOut)
outResult = (* ptrPID).minOut;
*ptrOut = (u8)outResult;
}

復制代碼

<li id="2gmcs"></li>

wwwxxx国产_337p日本欧洲亚洲大胆张筱雨_免费在线看成人av_日本黄色不卡视频_国产精品成熟老女人_99视频一区_亚洲精品97久久中文字幕_免费精品视频在线_亚洲色图欧美视频_欧美一区二三区