//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 件のコメント:
コメントを投稿