導航:首頁 > 操作系統 > 單片機求微分

單片機求微分

發布時間:2024-10-04 10:37:49

① 在單片機中關於積分微分的函數是怎麼弄的!!!

用查表法吧,相當於把積分離散化

② 只用單片機單獨一個晶元能進行積分,微分等復雜運算嗎不能的話怎麼辦

單片機當然可以進行積分/微分運算,關鍵還是看你的速度要求

③ stm32單片機能運算微積分嗎,運算微積分的能力怎麼樣,大概需要多長時間運算一次,在此謝過。。。

關鍵問題不是MCU而是你能不能用C語言編出合理相應函數的演算法,如果能 51單片機也能實現

④ 單片機pid演算法控制步進電機的電路圖和程序

//P1.1(T0):Count They Distance
//P0.4:Tx
//P0.5:Rx
#include <C8051F310.h> //SFR declarations
#include <stdio.h> //Standard I/O definition file
#include <math.h> //Math library file
#include <Intrins.h>
#include <absacc.h>

unsigned int j,i;
char a=0;
unsigned int t=0;

//sbit led=P0^2;
//P0.0(PWM0):給定左輪速度.
sbit vls=P0^4; //P0.4(GPIO):給定左輪方向.
sbit vlf=P0^6; //P0.6(T0) :反饋左輪速度.
sbit dlf=P1^0; //P1.0(GPIO):反饋左輪方向.

//P0.2(PWM0):給定右輪速度.
sbit vrs=P0^5; //P0.5(GPIO):給定右輪方向.
sbit vrf=P0^7; //P0.7(T0) :反饋右輪速度.
sbit drf=P1^1; //P1.1(GPIO):反饋右輪方向.

int ol; //左輪給定值
int len;
int len_1,len_2;
int lyn_1,lyn_2;
int vl1,vl2; //反饋左輪速度值(取樣周期內的方波數)
int lfz; //運算後賦給PWM的值

int lyn,lynn;
int lun=0,lun_1=0; //偏差校正值 即校正PWM輸出
int lunp,luni,lund; //PID 校正值

int or; //右輪給定值
int ren;
int ren_1,ren_2;
int ryn_1,ryn_2;
int vr1,vr2; //反饋右輪速度值(取樣周期內的方波數)
int rfz; //運算後賦給PWM的值

int ryn,rynn;
int run=0,run_1=0; //偏差校正值 即校正PWM輸出
int runp,runi,rund; //PID 校正值

float kp=2.0; //比例系數1.8
float kd=0.2; //微分系數0.4
float lki; //積分系數

void pio_init(void);
void sys_init(void);
void t01_init(void);
void TIME3_INT(void);
void PID(void);
void interrupt_init(void);
void delay(unsigned int x);
void pwm1_1(void);

void main(void)
{
PCA0MD &= ~0x40; //關閉
pio_init(); //P11為測距輸入端
sys_init();
t01_init();
pwm1_1();
TIME3_INT();
interrupt_init();

vls=1;vrs=0;
while(1)
{

ol=50;
or=50;
delay(1000);

ol=100;
or=100;
delay(1000);

ol=-50;
or=50;
delay(1000);

}

}

void PID(void)
{
/****************左輪PID調節******************/
if(dlf==1)
{
lyn=(vl2*256+vl1); //dlf是左輪反饋方向,0表示向前 vl=TL0
}
else
{
lyn=-(vl2*256+vl1); //dlf=1表示是向後退,速度應該為負值
}

len=ol-lyn; //誤差=給定速度-反饋速度(取樣周期內的方波數)

if(abs(len)<8)//30
{
lki=1.4; //ki值的確定1.4
}
else
{
lki=0.05; //積分系數:如果 | 給定值-反饋值 | 太大
} //則就可以不引入積分,或者引入的很小0.05

lunp=kp*(len-len_1); //比例校正
luni=lki*len; //積分校正
lund=kd*(len-2*len_1+len_2); //微分校正

lun=lunp+luni+lund+lun_1; //總校正

/*************新舊數據更新*************************/
len_2=len_1;
len_1=len; //len:當前取樣周期內出現的速度偏差;len_1:上次取樣周期內出現的速度偏差
lun_1=lun; //lun:當前取樣周期內得出的PWM校正值;lun_1:上次取樣周期內得出的PWM校正值
/*************新舊數據更新*************************/

if(lun>255)
{
lun=255; //正速度
}
if(lun<-255)
{
lun=-255; //負速度
}
if(lun<0)

{
vls=1;
PCA0CPH0=-lun;
}

if(lun>=0)
{
vls=0;
PCA0CPH0=lun;
}

/****************右輪PID調節******************/
if(drf==0)
{
ryn=(vr2*256+vr1); //drf是右輪反饋方向,0表示向前 vl=TL0
}
else
{
ryn=-(vr2*256+vr1); //dlf=1表示是向後退,速度應該為負值
}

ren=or-ryn; //誤差=給定速度-反饋速度(取樣周期內的方波數)

if(abs(ren)<8)//30
{
lki=1.4; //ki值的確定1.4
}
else
{
lki=0.05; //積分系數:如果 | 給定值-反饋值 | 太大
} //則就可以不引入積分,或者引入的很小0.05

runp=kp*(ren-ren_1); //比例校正
runi=lki*ren; //積分校正
rund=kd*(ren-2*ren_1+ren_2); //微分校正

run=runp+runi+rund+run_1; //總校正

/*************新舊數據更新*************************/
ren_2=ren_1;
ren_1=ren; //len:當前取樣周期內出現的速度偏差;len_1:上次取樣周期內出現的速度偏差
run_1=run; //lun:當前取樣周期內得出的PWM校正值;lun_1:上次取樣周期內得出的PWM校正值
/*************新舊數據更新*************************/

if(run>255)
{
run=255; //正速度
}
if(run<-255)
{
run=-255; //負速度
}
if(run<0)

{
vrs=1;
PCA0CPH1=-run;
}

if(run>=0)
{
vrs=0;
PCA0CPH1=run;
}
//因為這里的PCA0CPH0越大,對應的電機速度越小,所以要255來減一下
}

void pio_init(void)
{
XBR0=0x00; //0000 0001
XBR1=0x72; //0111 0010 時能弱上拉 T0T1連接到腳口P06、P07 CEX0、CEX1連接到腳口P00、P01

P0MDIN=0xff; //模擬(0);數字(1) 1111 0011
P0MDOUT=0xc3;//開漏(0);推挽(1) 1111 1111
P0SKIP=0x3c; //0011 1100

P1MDIN=0xff; //1111 1111
P1MDOUT=0xfc;//
P1SKIP=0x00; //1111 1111

}

void sys_init(void) //12MHz
{
OSCICL=0x43;
OSCICN=0xc2;
CLKSEL=0x00;

}

void pwm1_1(void) //PWM的初始化
{
PCA0MD=0x08; //PCA時鍾為12分頻

PCA0CPL0=200; //左輪
PCA0CPM0=0x42; //設置左輪為8位PWM輸出
PCA0CPH0=200;

PCA0CPL1=200; //平衡校正
PCA0CPM1=0x42; //設置為8位PWM輸出
PCA0CPH1=200;

PCA0CN=0x40; //允許PCA工作
}

void t01_init(void)
{
TCON=0x50; //計數器1、2允許
TMOD=0x55; //定時器1、2採用16位計數功能
CKCON=0x00;

TH1=0x00; //用於採集左輪的速度
TL1=0x00;

TH0=0x00; //用於採集右輪的速度
TL0=0x00;
}

void TIME3_INT(void)
{
TMR3CN = 0x00; //定時器3為16位自動重載
CKCON &= ~0x40;

TMR3RLL = 0xff;
TMR3RLH = 0xd7;
TMR3L = 0xff;
TMR3H = 0xd7;

TMR3CN |= 0x04;
}

void T3_ISR() interrupt 14 //定時器3中斷服務程序
{
//led=~led;
EA=0;
TCON &=~0x50; //關閉計數器0、1

vl1=TL0; //取左輪速度值
vl2=TH0;

vr1=TL1; //取右輪速度值
vr2=TH1;

TH1=0x00;
TL1=0x00;

TH0=0x00;
TL0=0x00;

PID(); //PID處理

TMR3CN &=~0x80; //清中斷標志位
TCON |=0x50; //重新開計數器0、1
EA=1;
}
void interrupt_init(void)
{ IE=0x80;
IP=0x00;
EIE1|=0x80;
EIP1|=0x80;

}

void delay(unsigned int m) //延時程序
{
for(i=0;i<2000;i++)
{
for(j=0;j<m;j++){_nop_(); _nop_();}
}
}

⑤ pic單片機的pic是什麼意思。

單片機PIC,是MICROCHIP公司單片機的標志,差不多都是以PIC開頭的,在控制演算法中有PID控制演算法,Proportion Integration Differentiation,意為:比例積分微分

閱讀全文

與單片機求微分相關的資料

熱點內容
學習編程視頻剪輯的書 瀏覽:170
安卓什麼時候更新軟體格式 瀏覽:978
三星920sc加密碼 瀏覽:721
南航app在哪裡 瀏覽:743
我的世界伺服器菜單怎麼做出來 瀏覽:366
馬後炮編程視頻 瀏覽:649
程序員上海郊區 瀏覽:351
哪裡app可回收手機殼 瀏覽:680
隨機攀登演算法 瀏覽:783
世界怎麼玩命令方塊 瀏覽:299
貴高速科技源碼 瀏覽:532
按鍵精靈字元串加密 瀏覽:249
javaquartz時間設置時間 瀏覽:521
安卓怎麼弄香港id 瀏覽:408
福州非溯源碼燕窩零售 瀏覽:424
99乘017的簡便演算法 瀏覽:366
通達信福利指標源碼 瀏覽:308
java序列號生成 瀏覽:99
linux宕機日誌 瀏覽:148
app培訓怎麼快進 瀏覽:389