ステッピングモーターのプログラム(2)

モーターのスピードを簡単に変更できるバージョン
「dly」という変数で一括してスピードコントロールできます。
-----

//StepMotor sample

//Pin Assgin
int ST_X1=2;
int ST_X2=4;
int ST_Y1=3;
int ST_Y2=5;
int ledPin=13;

//DelayTime
int dly=2;


void setup(){
  pinMode(ST_X1, OUTPUT);
  pinMode(ST_X2, OUTPUT);
  pinMode(ST_Y1, OUTPUT);
  pinMode(ST_Y2, OUTPUT);
  pinMode(ledPin, OUTPUT);
  
}

void loop(){
  digitalWrite(ledPin,HIGH);
  
  digitalWrite(ST_X1, HIGH);
  digitalWrite(ST_X2, LOW);
  digitalWrite(ST_Y1, LOW);
  digitalWrite(ST_Y2, LOW);
  
  delay(dly);

  digitalWrite(ST_X1, HIGH);
  digitalWrite(ST_X2, HIGH);
  digitalWrite(ST_Y1, LOW);
  digitalWrite(ST_Y2, LOW);
  
  delay(dly);

  digitalWrite(ST_X1, LOW);
  digitalWrite(ST_X2, HIGH);
  digitalWrite(ST_Y1, LOW);
  digitalWrite(ST_Y2, LOW);
  
  delay(dly);

  digitalWrite(ledPin,LOW);
  
  digitalWrite(ST_X1, LOW);
  digitalWrite(ST_X2, HIGH);
  digitalWrite(ST_Y1, HIGH);
  digitalWrite(ST_Y2, LOW);
  
  delay(dly);

  digitalWrite(ST_X1, LOW);
  digitalWrite(ST_X2, LOW);
  digitalWrite(ST_Y1, HIGH);
  digitalWrite(ST_Y2, LOW);
  
  delay(dly);

  digitalWrite(ST_X1, LOW);
  digitalWrite(ST_X2, LOW);
  digitalWrite(ST_Y1, HIGH);
  digitalWrite(ST_Y2, HIGH);
  
  delay(dly);
  
  digitalWrite(ST_X1, LOW);
  digitalWrite(ST_X2, LOW);
  digitalWrite(ST_Y1, LOW);
  digitalWrite(ST_Y2, HIGH);
  
  delay(dly);

  digitalWrite(ST_X1, HIGH);
  digitalWrite(ST_X2, LOW);
  digitalWrite(ST_Y1, LOW);
  digitalWrite(ST_Y2, HIGH);
  
  delay(dly);
  
}


0 件のコメント:

コメントを投稿