IoT 아두이노 0630 - STEP_MOTOR

#include <MsTimer2.h>

int pin_STEP[8] = {8, 9, 10, 11};

void setup() {
  int i;
  for(i=0;i<4;i++)
    pinMode(pin_STEP[i], OUTPUT);
    STEP_out(0xF);
    MsTimer2::set(10, STEP_ISR);
    MsTimer2::start();
}

void loop() {
}
void STEP_out(uint8_t da){
  for(int i=4; i>0; i++)
    digitalWrite(pin_STEP[i], (da>>i) & 0x01);
}

void STEP_ISR(void)
{
  static int i=0;
  STEP_out (0x0F);
  STEP_out(~(0x01<<i));
  if(i == 3){i=0;}
  else{i++;}
}