code bộ PID số cho anh em tự động!!

Go down

code bộ PID số cho anh em tự động!!

Bài gửi by nguyenmung on Thu Nov 05, 2009 9:56 am

code PID cho anh em cần cho đề đề tài ghép nối đây!!!
thank cái nhé anh em!!heeee Rolling Eyes
//----------
void Init_PID(void) {

Kp=3;

Ki=0.1;

Kd=1;

T=1;

heso0=(float)Kp+(float)Kd/(float)T+(float)Ki*(float)T/2; //heso0=Kp+Kd/T+Ki*T/2;

heso1=(float)Ki*(float)T/2-(float)Kp-2*(float)Kd/(float)T; //heso1=-Kp -2*Kd/T+Ki*T/2;

heso2=(float)Kd/(float)T; //heso3=Kd/T;

//SIMPLE CYCLE T=1
u0=0;
u1=0;
e0=0;
e1=0;
e2=0;
}
// Chuong trinh dieu khien vi tich phan ti le //
//----------------------------------------------------------------------------//
void PID_light(void){
float tam;
char tam1;
e0=Udat-Uphoi;
if (e0>-5 && e0<5){
u0=u1+heso0*e0+heso1*e1+heso2*e2;
}
if (u0>Umax){
u0=Umax;
}
if (u0<=0){
u0=0;
}
else if (e0>=5)
{ u0=Umax;
}
else if (e0<=-5)
{ u0=0; }
//????????????????????
tam=u0;
tam=tam*1023/Umax;
value_pwm=(char)tam;
set_pwm1_duty(1023-value_pwm);
u1=u0;
e2=e1;
e1=e0;
}
}
//tao xung pwm

bounce bounce bounce bounce
avatar
nguyenmung
2 sao
2 sao

Tổng số bài gửi : 22
Join date : 26/09/2009
Age : 31

Xem lý lịch thành viên

Về Đầu Trang Go down

Re: code bộ PID số cho anh em tự động!!

Bài gửi by HA_05D4 on Thu Nov 05, 2009 11:48 pm

Laughing thanks pac' Mung nhiu`lem'.Pac' co the viet lun cho tao xung pwm cho no ro hon dc ko???
avatar
HA_05D4

Tổng số bài gửi : 8
Join date : 17/09/2009

Xem lý lịch thành viên

Về Đầu Trang Go down

Về Đầu Trang

- Similar topics

 
Permissions in this forum:
Bạn không có quyền trả lời bài viết