2차시

#include <stdio.h>
#include <WiringPi.h>
// wiringPi: GPIO 모듈
// **주의 wiringPi는 컴파일할 때 linking 해주어야 한다**

// pin 번호는 WiringPi 기준
#define Tracking_Left1 2
#define Tracking_Left2 3
#define Tracking_Right1 0
#define Tracking_Right2 7


int main() {
    // GPIO pin 초기화
    if (wiringPiSetupGpio() == -1) {
        return 1 // 초기화 실패시 1 반환
    }
    // pinMode set
    // 01. senser pin 설정
    pinMode(Tracking_Left1, INPUT);
    pinMode(Tracking_Left2, INPUT);
    pinMode(Tracking_Right1, INPUT);
    pinMode(Tracking_Right2, INPUT);
    // 02. motor pin 설정
    pinMode(Tracking_Right2, OUTPUT);
    // loop
    bool Driving = true;
    while (Driving) {
        // 센서 읽는 값은 bool
        // if (digitalRead(Tracking_Left1) == 1 &&  digitalRead(Tracking_Left2) == 1); 
        printf("%d", digitalRead(Tracking_Left1));
        printf("%d", digitalRead(Tracking_Left2));
        printf("%d", digitalRead(Tracking_Right1));
        printf("%d", digitalRead(Tracking_Right2));
        if ((Tracking_Left2 == 1) && (Tracking_Right1 == 1)) { // 직진

        }
        else if ((Tracking_Left2 == 0) && (Tracking_Right1 == 1)) { // 우회전
            
        }
        else if ((Tracking_Left2 == 1) && (Tracking_Right1 == 0)) { // 좌회전
            
        }
        else if ((Tracking_Left2 == 0) && (Tracking_Right1 == 0)) { // 정지
            Driving = false;
        }
    }
}