[Help] Điều khiển động cơ DC bằng PWM[phần lập trình]

[tinhlagikdhd]

Tình hình là bọn em đang làm cái đồ án về cái này, em viết mãi mà mô phỏng nó không chạy và ko hiểu là nó sai ở chỗ nào, bro nào biết có thể chỉ cho em nó sai ở đâu và phải sửa như thế nào được không ạ? em sắp phải nộp rồi mà cứ thế này thì gay quá! Cảm ơn mọi sự giúp đỡ của các bác !


Code của em thế này :

#include <REGX51.H>
#define stop P1_0
#define thuan P1_1
#define nghich P1_2
#define tang P1_3
#define giam P1_4

bit PWM;
int k;

void bamxung(unsigned char duty)
{
PWM=1;
TR0=0;
TH0=-100*duty/256;
TL0=-100*duty%256;
TR0=1;
while(!TF0);
TF0=0;
PWM=0;
TR0=0;
TH0=-100*(100-duty)/256;
TL0=-100*(100-duty)%256;
TR0=1;
while(!TF0);
TF0=0;
}


unsigned char tangtoc(void)
{
if(tang==1)
{
while(tang);
}
else k++;
if(k==1)
bamxung(25);
if(k==2)
bamxung(50);
if(k==3)
bamxung(75);
if(k>3) k==0;

return(bamxung);

}

unsigned char giamtoc(void)
{
if(giam==1)
{
while(giam);
}
else k++;
if(k==1)
bamxung(75);
if(k==2)
bamxung(50);
if(k==3)
bamxung(25);
if(k>3) k==0;
return(bamxung);
}



void stopdc(void)
{
P2_0=0;
P2_1=0;
P2_2=0;
P2_3=1;
P2_4=1;
}


void quaythuan(void)
{
P2_1=0;
P2_0=PWM;
P2_3=0;
P2_2=1;
P2_4=1;

}



void quaynghich(void)
{
P2_0=0;
P2_1=PWM;
P2_4=0;
P2_3=1;
P2_2=1;

}





unsigned char n;
unsigned char chonchedo(void)
{
if(stop==0) n=1;
if(thuan==0) n=2;
if(nghich==0) n=3;
switch(n)
{
case 0: {break;}
case 1: {stopdc();break;}
case 2: {quaythuan();break;}
case 3: {quaynghich();break;}
}
return (n);
}





void main()
{
while(1)
{
TMOD=0x01;
tangtoc();
giamtoc();
chonchedo();

}
}

Mong sớm nhận đc hồi âm!
Em xin chân thành cảm ơn các pác!

Chương trình và mô phỏng : http://azsharing.com/c51f4a015yrt/DC..._PWM_.zip.html

p/s: mà cái chức năng gửi kèm file của 4rum hình như bị lỗi thì phải !

[tinhlagikdhd]

bác nào giúp em 2 cái hàm quay thuận và quay nghịch với ! ^^! ko ai giúp em vụ này ah ?

[dochetdam]

có thế thôi ah đây này đã chạy tốt và được kiểm chứng:
#include <REGX52.H>
#define ck 200 // 1 chu ky
#define t 150 // He so thoi gian chong dung phim an
#define pg 20 // Do phan giai cua moi lan tang giam toc do
// Khai bao dau vao cho cac phim an
sbit dc = P2^7; // Dau ra dieu khien dong co
sbit giam = P2^0; // giam toc do dong co
sbit start = P2^1; // Khoi dong dong co
sbit mode = P2^2; // Dung theo che do
sbit stop = P2^3; // Dung dong co
sbit tang = P2^4; // Tang toc do don co
// Khai bao bien toan cuc
unsigned char ton,toff,x;
bit run,i=1;
// Ham tre
void tre(unsigned int i){while(i--);}
// Chuong trinh chinh
void main(void)
{
// khoi tao Timer
EA = 1; // Cho phep ngat
ET0 = 1; // Cho phep ngat khi tran timer 0
TMOD = 0x82; // Timer 0 hoat dong o che do auto-reload
x = ck/2; // Lam cho do co chay o 50% toc do dinh muc khi an start
dc = 0;
while(1) // vong lap vo tan
{
if(i==1) // Neu i duoc set nen 1 thi moi tinh toan lai cac thong so
{
ton =0xff-x;
toff=0xff-ck+x;
i =0;
}
if(start==0)
{
tre(t); // sau mot khoang thoi gian kiem tra lai phim an
if(start==0)
{
while(start==0); // khi nha phim start moi thuc thi lenh cua phim
run=1; // Bit bao da an phim start
TR0=1; // Timer 0 bat dau chay
}
}
if(stop==0)
{
tre(t); // sau mot khoang thoi gian kiem tra lai phim an
if(stop==0)
{
while(stop==0); // khi nha phim stop moi thuc thi lenh cua phim
run=0;
TR0=0; // Dung Timer
dc = 0;
}
}
if(tang==0&run==1)
{
tre(t); // sau mot khoang thoi gian kiem tra lai phim an
if(tang==0&run==1)
{
while(tang==0&run==1); // khi nha phim tang moi thuc thi lenh cua phim
TR0 = 1;
x=x+pg;
i=1; // Tinh lai cac thong so
// khong che gia tri cua x
if(x>=ck)
x = ck;
}
}
if(giam==0&run==1)
{
tre(t); // sau mot khoang thoi gian kiem tra lai phim an
if(giam==0&run==1)
{
while(giam==0&run==1); // khi nha phim giam moi thuc thi lenh cua phim
if(x<pg)
{
x = 0;
TR0 = 0;
}
else
x = x-pg;
i = 1; // Tinh lai cac thong so
}
}
if(mode==0&run==1)
{
tre(t); // sau mot khoang thoi gian kiem tra lai phim an
if(mode==0&run==1)
{
while(mode==0&run==1); // khi nha phim mode moi thuc thi lenh cua phim
TR0 = 1;
for(;x>=pg;x=x-pg)
{
ton =0xff-x;
toff=0xff-ck+x;
tre(50000);
}
dc = 0;
TR0 = 0;
}
}
}
}
// Chuong trinh phuc vu ngat khi timer 0 tran
void ngat_timer_0(void) interrupt 1
{
TR0 = 0; // Dung timer
if(dc==0)
{
TH0 = toff; // nap lai gia tri ngat cho timer
dc = 1;
}
else
{
TH0 = ton; // nap lai gia tri ngat cho timer
dc = 0;
}
TR0 = 1; // Cho Timer hoat dong
}

[dochetdam]

cái này t đã chạy ngon lành khong những chạy thuận nghịc bằng nút bấm mà còn tăng giảm tốc độ nữa cơ

[tinhlagikdhd]

Cảm ơn bác nhé! Nhưng mà đây ko có đảo chiều mà!
Bác có thể cho em cái sơ đồ phần cứng của bác ko ? Em khó tưởng tượng quá!
Thanks so much!

[autokhin010]

cảm ơn Bác nha! mình cũng đang làm về cái này!