Page 138 - 최강 아두이노 스마트 자동차 로봇 키트

서보모터 & 초음파 거리 측정 센서 코드 결합

현재까지 구현된 서보 모터 제어 코드와 초음파 거리 측정 센서 코드를 적용 합니다.
서보모터 회전 함수와 초음파 센서 작동 코드를 결합 합니다. C/C++ 구현 기술은 여
러 방법이 있지만 작동 함수 위주로 구현합니다.
위에서 기술된 초음파 센서 거리 측정 라이브러리 NewPing 을 사용하도록 합니다.
스케치 초음파 센서 라이브러리 NewPing 사용해봅니다.
예제 코드는 지정된 3 방향의 거리값을 구해 가장 먼 거리의 방향을 가리키는 메시지
를 시리얼 포트로 출력합니다.
최종 결과를 얻기 위해 여러 가지 함수가 추가됩니다.

아래의 코드는 지정된 방향으로 서보모터 회전 후 해당 방향에서의 거리 측정된 값을
구하여 적절한 진행 방향을 선정합니다

코드: 4wd_ex_8

#include <NewPing.h> // for Ultrasonic sensor.
#include <Servo.h> // for servo motor.

//
// for Ultrasonic module
//

#define TRIGGER_PIN 12 // Trigger Pin
#define ECHO_PIN 13 // Echo Pin
#define MAX_DISTANCE 250 // distance max value. 2.5m

//
// Direction for servo motor
//
#define SERVO_DIR_CENTER 1

#define SERVO_DIR_LEFT 2
#define SERVO_DIR_RIGHT 3

#define SERVO_DEGREE_LEFT
#define SERVO_DEGREE_CENTER

137