낙성대 과학관

 

1. 아두이노 로봇개 기본 셋 코드

#include <Servo.h>
Servo s1;
Servo s2;
Servo s3;
Servo s4;

void setup() {
 s1.attach(2);
 s2.attach(3);
 s3.attach(4);
 s4.attach(5);

 s1.write(90);
 s2.write(90);
 s3.write(90);
 s4.write(90);
 delay(500);
}

void loop() {

}

 

 

2. 시리얼 통신 제어 코드

#include <Servo.h>
Servo s1;
Servo s2;
Servo s3;
Servo s4;

void setup() {
 Serial.begin(9600);
 s1.attach(2);
 s2.attach(3);
 s3.attach(4);
 s4.attach(5);

 s1.write(90);
 s2.write(90);
 s3.write(90);
 s4.write(90);
 delay(500);
}

void loop() {

     while (Serial.available() > 0) { 
         char data = Serial.read(); 

         if (data == 's') {
            s2.write(20);  
            s4.write(160);  
         }

         if (data == 'd') {
           s2.write(90);  
           s4.write(90);
         }
 }

}

 

 

3. 함수 만들기

#include <Servo.h>
Servo s1;
Servo s2;
Servo s3;
Servo s4;

void setup() {
 Serial.begin(9600);
 s1.attach(2);
 s2.attach(3);
 s3.attach(4);
 s4.attach(5);

 s1.write(90);
 s2.write(90);
 s3.write(90);
 s4.write(90);
 delay(500);
}


void sit(){
	s2.write(20);  
    s4.write(160);  
}

void up(){
	s2.write(90);  
    s4.write(90);
}


void loop() {
     while (Serial.available() > 0) { 
         char data = Serial.read(); 

         if (data == 's') {
            sit();
         }

         if (data == 'd') {
           up();
         }
 	}
}

 

 

 

 

4. 앞으로 걸어가는 함수 만들기.

 

#include <Servo.h>
Servo s1;
Servo s2;
Servo s3;
Servo s4;

void setup() {
 s1.attach(2);
 s2.attach(3);
 s3.attach(4);
 s4.attach(5);

 s1.write(90);
 s2.write(90);
 s3.write(90);
 s4.write(90);
 delay(500);
}


void go(){



}



void loop() {



}

 

 

 

 

5. 옆으로 도는 동작 함수 만들기.

 

 

 

 

6. for문 이해 

#include <Servo.h>
Servo s1;
Servo s2;
Servo s3;
Servo s4;

void setup() {
 Serial.begin(9600);
 s1.attach(2);
 s2.attach(3);
 s3.attach(4);
 s4.attach(5);

 s1.write(90);
 s2.write(90);
 s3.write(90);
 s4.write(90);
 delay(500);
}


void sit(){
   for(int i=0; i<=70; i++){
	s2.write(90-i);  
    s4.write(90+i);
    delay(10);
    }
}

void up(){
	for(int i=0; i<=70; i++){
	s2.write(20+i);  
    s4.write(120-i);  
    delay(10);
    }
}


void loop() {
     while (Serial.available() > 0) { 
         char data = Serial.read(); 

         if (data == 's') {
            sit();
         }

         if (data == 'd') {
           up();
         }
 	}
}