개요

시리얼 포트 데이터로 유니폴라 스텝모터를 제어해보자.

/*

  시리얼포트로 키 입력을 받아

  스텝모터 회전 속도/방향을 조절하는 예제

 

  예>

  '1' 입력시  delay(99) 로 시계방향 회전 - 느림

  '99' 입력시  delay(1) 로 시계방향 회전 - 빠름

 

  '-1' 입력시  delay(99)로 반시계방향 회전 - 느림

  '-99' 입력시  delay(1)로 반시계방향 회전 - 빠림

 

  출처: http://whiteat.com/Arduino  

 

  보드

  WAT-Arduino128  : https://kit128.com/goods/view?no=64

  WAT-STEP1 :  https://kit128.com/goods/view?no=41

*/ 

 

#include <WAT_Multi.h>

#include <WAT_STEP1.h>

 

// STEP1  : 유니폴라 1상 여자 방식

// STEP2  : 유니폴라 2상 여자 방식

// STEP12 : 유니폴라 1-2상 여자 방식

 

Step1 step(STEP2,PA0,PA1,PA2,PA3);

 

// 프로그램 시작 - 초기화 작업

void setup()

{

           Serial.begin(115200);    //시리얼 통신 초기화

}

 

void loop()

{

           step.Next();

}

 

String inString;

int m_speed = 4;

void serialEvent()

{

           while (Serial.available())

           {   

                     int inChar = Serial.read() ;

                     if (isDigit(inChar) || inChar=='-')

                     {

                                inString += (char)inChar;

                     }

                     else if (inChar == '\n')

                     {

                                if(inString.length()>0)

                                {

                                          m_speed = inString.toInt();

                                          step.SetInterval(m_speed);

                                          Serial.print("Turn Delay:");

                                          Serial.println(inString.toInt());

                                          Serial.println(step.GetInterval());                                   

                                }

                                inString = "";

                     }

           }

}