메뉴 건너뛰기

XEDITION

project2018

모터 돌리는 소스

proin 2018.05.14 10:18 조회 수 : 2

int pinx=0;

 

int piny= 1;

//모터A 컨트롤

int IN1=7;  // 정

int IN2=6;

 

//모터B 컨트롤

int IN3=5;  //정

int IN4=4;

 

 

void bothMotorStart(int y);

void stopAllMotor(int y);

void setup() {

 

 // Start serial because we will observe values at serial monitor

 

 Serial.begin(9600);

 pinMode(IN1,OUTPUT);

  pinMode(IN2,OUTPUT);

  pinMode(IN3,OUTPUT);

  pinMode(IN4,OUTPUT);

   pinMode(pinx,OUTPUT);

  pinMode(piny,OUTPUT);

 

}

 

 

 

void loop() {

 

 // Print x axis values

 int x = analogRead(pinx)-338;

 int y =analogRead(piny)-338;

 

 Serial.print("x: ");

 Serial.print(x);

 Serial.print(",");

 Serial.print("y: ");

 Serial.println(y);

 

 // Some delay to clearly observe your values on serial monitor.

if(y<10 && y>-10)

{

  stopAllMotor(y);

}

if(y>=10)

{

  bothMotorStart(y);

}

 

 delay(500);

 

}

 

 

 void bothMotorStart(int y)

{

    digitalWrite(IN1,HIGH);

    digitalWrite(IN2,LOW);

    digitalWrite(IN3,HIGH);

    digitalWrite(IN4,LOW);

    analogWrite(0,y/2);

    analogWrite(1,y/2);

    

}

void stopAllMotor(int y)

{

    digitalWrite(IN1,LOW);

    digitalWrite(IN2,LOW);

    digitalWrite(IN3,LOW);

    digitalWrite(IN4,LOW);

     analogWrite(0,y);

    analogWrite(1,y);

}

위로