2020年1月20日月曜日

Arduino Challenge01



DCMotor,Stepper And Servo Using WizL293D



// Adafruit Motor shield library
// copyright Adafruit Industries LLC, 2009
// this code is public domain, enjoy!

#include <AFMotor.h>
#include <Servo.h>

// DC motor on M1,M2
AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
// DC hobby servo
Servo servo1;
// Stepper motor on M3+M4 48 steps per revolution
AF_Stepper stepper(48, 2);

void setup() {
  //Serial.begin(9600);           // set up Serial library at 9600 bps
  //Serial.println("Motor party!");

  // turn on servo
  servo1.attach(9);
 
  // turn on motor #2
  motor1.setSpeed(200);
  motor1.run(RELEASE);
  motor2.setSpeed(200);
  motor2.run(RELEASE);
}

int i;

// Test the DC motor, stepper and servo ALL AT ONCE!
void loop() {
  motor1.run(FORWARD);
  motor2.run(FORWARD);
  for (i=0; i<255; i++) {
    servo1.write(i);
    motor1.setSpeed(i);
    motor2.setSpeed(i);
    stepper.step(1, FORWARD, INTERLEAVE);
    delay(3);
 }

  for (i=255; i!=0; i--) {
    servo1.write(i-255);
    motor1.setSpeed(i);
    motor2.setSpeed(i);
    stepper.step(1, BACKWARD, INTERLEAVE);
    delay(3);
 }

  motor1.run(BACKWARD);
  motor2.run(BACKWARD);
  for (i=0; i<255; i++) {
    servo1.write(i);
    motor1.setSpeed(i);
    motor2.setSpeed(i);
    delay(3);
    stepper.step(1, FORWARD, DOUBLE);
 }

  for (i=255; i!=0; i--) {
    servo1.write(i-255);
    motor1.setSpeed(i);
    motor2.setSpeed(i);
    stepper.step(1, BACKWARD, DOUBLE);
    delay(3);
 }
}



0 件のコメント:

コメントを投稿