新人，求教寫的這個演示L298N的程序是否合理~

ID:59027 · 發表于 2014-2-10 21:56

#include<reg51.h> //頭文件
sbit ENA=P0^0; /* */
sbit IN1=P0^1; /* 定義針腳  */
sbit IN2=P0^2; /* */
sbit IN3=P0^3; /* */
sbit IN4=P0^4; /* */
sbit ENB=P0^5; /* */

void MotorMoshi(unsigned nNum) //電機轉向函數
{

/*此段為選擇電機轉向*/
switch(nNum)
  {
  case 1: //前進
IN1=1;
IN3=1;
break;
  case 2: //后退
IN1=0;
IN3=0;
break;
  case 3: //左前
IN1=1;
IN3=1;
break;
  case 4: //左后
IN1=0;
IN3=1;
break;
  case 5: //右前
IN1=0;
IN3=1;
break;
  case 6: //右后
IN1=0;
IN3=0;
break;
  case 7: //左旋轉
IN1=0;
IN3=1;
break;
  case 8: //右旋轉
IN1=1;
IN3=0;
break;
  }
  /*取IN1和IN3的反值*/
  if(IN1==0)
IN2=1;
  else
IN2=0;
  if(IN3==0)
IN4=1;
  else
IN4=0;

  /*使能ENA,ENB為1或0*/
  if((nNum==1)||(nNum==2)||(nNum==3)||(nNum==4)||(nNum==7)||(nNum==8))

ENA=1;
  else
ENA=0;
  if((nNum==1)||(nNum==2)||(nNum==5)||(nNum==6)||(nNum==7)||(nNum==8))
ENB=1;
  else
ENB=0;
}
void delay(void) //延時5S
{
unsigned char a,b;
for(b=19;b>0;b--)
      for(a=130;a>0;a--);
}
void main(void)
{
unsigned a;
a=0;
while(1)
{
  MotorMoshi(a);
  delay();
  a++;
  if(a==9)
  {
  break;
  }
}
}