chuơng trinh điều khiển động cơ cua mình nhưng chay duoc nhưng ko the chạy dược xin các bạn góp y cho
/*================================================= ===========================
* Ten chuong trinh: dieu khien dong co buoc dung pic
* Nguoi viet : nhom 16
* Hardware : PIC16F877A
* Compiler : CCS C
*================================================= ============================*/
#include<16F877A.h>
#include<def_16f877a.h>
#fuses NOWDT,PUT,HS,NOPROTECT,NOLVP
#use delay(clock=20000000)
int1 start,forward,back,nhanh;
int8 i,j,k,m,v,speed;
const unsigned char ma[]={0x01,0x02,0x04,0x08};
void quaynghich(void)
{
portd=ma[k];
delay_ms(speed);
k++;
if(k==4)
{
k=0;
}
}
void ktao(void)
{
trisd=0;
trisb=1;
}
void quaythuan()
{
portd=ma[m];
delay_ms(speed);
m--;
if(m==-1)
{
m=3;
}
}
void quetphim()
{ if (input(pin_b0))
{
start = !start;
}
if(input(pin_b1))
{
forward=!forward;
}
if (input(pin_b2))
{
back=!back;
}
if(input(pin_b3))
{
nhanh=!nhanh;
}
}
void main()
{
ktao();
V=4;
m=3;
k=0;
while(true)
{ quetphim();
while (start)
{
if(nhanh)
{ speed=90;
v=4;
if (forward)
{
quaythuan();
quetphim();
}
else if (back)
{
quaynghich();
quetphim();
}
}
else if (forward)
{
speed=200;
quaythuan();
quetphim();
}
else if (back)
{
speed=200;
quaynghich();
quetphim();
}
}
}
}
