]//////////////////////L298N驅(qū)動(dòng)////////////////////////////

#define motor1pin1 10                              //定義IN1引腳

#define motor1pin2 9                              //定義IN2引腳

#define motor1pwm 5                             //定義ENA引腳

#define motor2pin1 8                              //定義IN3引腳

#define motor2pin2 7                               //定義IN4引腳

#define motor2pwm 6                              //定義ENB引腳

void motospd( int sp1,int sp2,int de ) //電機(jī)速度控制函數(shù)。括號(hào)內(nèi)分別為左右電機(jī)速度值，

{                        //范圍-255～+255，正值為正轉(zhuǎn)，負(fù)值為反轉(zhuǎn)。

  if(sp1>0)

  {

    digitalWrite(motor1pin2,LOW);

    digitalWrite(motor1pin1,HIGH);   

  }

  else

  {

    digitalWrite(motor1pin1,LOW);   

    digitalWrite(motor1pin2,HIGH);

    }

  if(sp2>0)

  {

    digitalWrite(motor2pin2,LOW);

    digitalWrite(motor2pin1,HIGH);   

  }

  else

  {

    digitalWrite(motor2pin1,LOW);   

    digitalWrite(motor2pin2,HIGH);

    }

  analogWrite(motor1pwm,abs (sp1));

  analogWrite(motor2pwm,abs (sp2));

  delay(de);

}