99这里只有精品,四虎影院最新网址,夜夜躁日日躁狠狠久久88av

/*====================================================================================================
增量式PID
The PID (比例、積分、微分) function is used in mainly
control applications. PIDCalc performs one iteration of the PID
algorithm.
While the PID function works, main is just a dummy program showing
a typical usage.
=====================================================================================================*/
#define Set_Point 1000 //100 10000
#define PWM_Max 1400
#define PWM_Min 50
typedef struct PID
{
int Target; //設定目標 Desired Value
int Uk; //Uk
int Udk; //Udk增量
int Uk_1; //Uk-1
double P; //比例常數 Proportional Const
double I; //積分常數 Integral Const
int b;
double D; //微分常數 Derivative Const
int ek_0; //ek
int ek_1; //ek-1
int ek_2; //ek-2
}PID;
static PID Speed_PID;
static PID *Speed_Point = &Speed_PID;
/*====================================================================================================
Initialize PID Structure PID參數初始化
=====================================================================================================*/
void Speed_PIDInit(void)
{
Speed_Point->Target = Set_Point;
Speed_Point->Uk = 0;
Speed_Point->Udk = 0;
Speed_Point->Uk_1 = PWM_Min;
Speed_Point->ek_0 = 0; //ek=0
Speed_Point->ek_1 = 0; //ek-1=0
Speed_Point->ek_2 = 0; //ek-2=0
Speed_Point->P = 4; //比例常數 Proportional Const
Speed_Point->I = 0.084; //積分常數Integral Const
Speed_Point->b = 1;
Speed_Point->D = 1.8; //微分常數 Derivative Const
}
/*====================================================================================================
增量式PID計算部分
=====================================================================================================*/
int Speed_PIDAdjust(int Next_Point)
{
Speed_Point->ek_0= Speed_Point->Target - Next_Point; //增量計算
/*遇限削弱積分即控制量Uk進入飽和區，便停止進行增大的積分項運算，而只進行使積分減少的運算*/
if(((Speed_Point->Uk_1>=PWM_Max)&&(Speed_Point->ek_0>=0))||((Speed_Point->Uk_1<=PWM_Min)&&(Speed_Point->ek_0<=0)))
{
Speed_Point->b=0;
}
else
{
Speed_Point->b=1;
}
Speed_Point->Udk=Speed_Point->P*(Speed_Point->ek_0-Speed_Point->ek_1) + Speed_Point->b*Speed_Point->I*Speed_Point->ek_0
+ Speed_Point->D*(Speed_Point->ek_0-2*Speed_Point->ek_1+Speed_Point->ek_2);
/* 存儲誤差，用于下次計算 */
Speed_Point->Uk = Speed_Point->Uk_1 + Speed_Point->Udk;
Speed_Point->ek_2 = Speed_Point->ek_1;
Speed_Point->ek_1 = Speed_Point->ek_0;
Speed_Point->Uk_1 = Speed_Point->Uk;
if(Speed_Point->Uk >= PWM_Max)
{
return PWM_Max;
}
else if(Speed_Point->Uk <= PWM_Min)
{
return PWM_Min;
}
return(Speed_Point->Uk);
}

復制代碼

#include "includes.h"
/********************CoOS變量**********************/
#define TASK_STK_SIZE 128
#define TASK0_PRIO 2
#define TASK1_PRIO 3
OS_STK STK_TASK0[TASK_STK_SIZE];
OS_STK STK_TASK1[TASK_STK_SIZE];
void TASK0(void *param);
void TASK1(void *param);
/*************************************************/
/*********************一般變量********************/
extern uint32_t Speed_count;
uint8_t USART_Flag = 0;
/*************************************************/
int main(void)
{
/* 片內外設初始化 */
Periph_Init();
/* 操作系統初始化 */
CoInitOS();
CoCreateTask( TASK0, (void*)0, TASK0_PRIO, &STK_TASK0[TASK_STK_SIZE - 1], TASK_STK_SIZE);
CoCreateTask( TASK1, (void*)0, TASK1_PRIO, &STK_TASK1[TASK_STK_SIZE - 1], TASK_STK_SIZE);
CoStartOS();
while(1);
}
void TASK0(void *param)
{
uint16_t data;
KEY_Init();
Speed_PIDInit();
for(;;)
{
if(KEY_Read(KEY1))
{
CoTickDelay(5);
if(KEY_Read(KEY1))
{
BLDC_Start();
}
}
if(KEY_Read(KEY2))
{
CoTickDelay(5);
if(KEY_Read(KEY2))
{
BLDC_Stop();
}
}
if(USART_Flag)
{
data = 1000000/(6*Speed_count);
USART_SendData( USART2, data);
USART_Flag = 0;
}
CoTickDelay(5);
}
}
void TASK1(void *param)
{
for(;;)
{
LED_On();
CoTickDelay(200);
LED_Off();
CoTickDelay(200);
}
}

復制代碼

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