2021年4月10日土曜日

Arduino Challenges TamiyaTankDEMONano











//TamiyaTankDemoNano

//by Kim Grossa


#include <CytronMotorDriver.h>

#include <Servo.h>


//Maker Drive

CytronMD motor1(PWM_PWM, 3, 9);   // PWM 1A = Pin 3, PWM 1B = Pin 9.

CytronMD motor2(PWM_PWM, 10, 11); // PWM 2A = Pin 10, PWM 2B = Pin 11.


//servo

int ServoSpeed=480;

Servo myServo;


void setup()

{

  //DC motor

  motor1.setSpeed(0);  

  motor2.setSpeed(0);


  //servo 360degree

  myServo.attach(8,480,2500);

}


void loop() 

{

  motorForward();

  delay(3000); 

  motorStop();

  delay(500);

  motorBack();

  delay(3000);

  motorStop();

  delay(500);

  turnLeft();

  delay(1000);

  motorStop();

  delay(500);

  turnRight();

  delay(1000);

  motorStop();

  delay(500);

  turretRight();

  delay(500);

  turretStop();

  delay(500);

  turretLeft();

  delay(500);

  motorForward();

  turretLeft();

  delay(3000);

  turretStop();

  

    

}


    void motorStop()

  {

    motor1.setSpeed(0);

    motor2.setSpeed(0);  

  }


   void turretStop()

  { 

    myServo.write(90);     

  }

    

  void turnLeft()

  {    

    motor1.setSpeed(-255);  

    motor2.setSpeed(0);

  }


  void turretRight()

  {

    myServo.write(120);

  }


  void turnRight()

  {

    motor1.setSpeed(0);  

    motor2.setSpeed(255);

  }


   void turretLeft()

  {

    myServo.write(60); 

  }


   void motorForward()

  {

    motor1.setSpeed(-255);  

    motor2.setSpeed(255);

  }


  void motorBack()

  {

    motor1.setSpeed(255);  

    motor2.setSpeed(-255); 

  }

 

0 件のコメント:

コメントを投稿