//----------------------------------------
const int ultra1_trig_PLUS_pin = 13;
const int ultra1_echo_PLUS_pin = 12;
const int ultra2_trig_SUB_pin = A0;
const int ultra2_echo_SUB_pin = A1;
int number = 0;
//----------------------------------------
void setup() {
  // put your setup code here, to run once:
  // $  ultra1_ $
  pinMode(ultra1_trig_PLUS_pin,  OUTPUT);  // pinNumber: 13
  pinMode(ultra1_echo_PLUS_pin,   INPUT); // pinNumber:  12

  // $ ultra2_ $
  pinMode(ultra2_trig_SUB_pin, OUTPUT); // pinNumber: A0
  pinMode(ultra2_echo_SUB_pin,   INPUT); // pinNumber: A1

  //
  Serial.begin(9600);
}

void loop() {
  // put your main code here, to run repeatedly:
  // $  ULTRA1 ----------------------------------------------------------------
  digitalWrite(ultra1_trig_PLUS_pin, LOW);
  delayMicroseconds(2);
  digitalWrite(ultra1_trig_PLUS_pin, HIGH);
  delayMicroseconds(10);
  digitalWrite(ultra1_trig_PLUS_pin, LOW);
  long distance_plus = pulseIn(ultra1_echo_PLUS_pin, HIGH)/58.2;
 
  //$ ULTRA2  ----------------------------------------------------------------
  digitalWrite(ultra2_trig_SUB_pin, LOW);
  delayMicroseconds(2);
  digitalWrite(ultra2_trig_SUB_pin, HIGH);
  delayMicroseconds(10);
  digitalWrite(ultra2_trig_SUB_pin, LOW);
  long distance_sub = pulseIn(ultra2_echo_SUB_pin, HIGH)/58.2;

 
  if (distance_plus < 10) {
    Serial.print("distance_plus -> ");
    Serial.print(distance_plus);
    Serial.println(" cm");
    number++;
    Serial.print("number is ");
    Serial.println(number);
  }  else  {  //distance_plus >= 10
    if (distance_sub < 10) {
      Serial.print("distance_sub -> ");
      Serial.print(distance_sub);
      Serial.println(" cm");
      number--;
      Serial.print("number is ");
      Serial.println(number);
    }
  }
}




'arduino_' 카테고리의 다른 글

10개만 출력  (0) 2016.03.26
illumination_sensor (조도센서)  (0) 2016.02.13
랜덤으로 30개의 숫자를 만들고 짝수일때 빨간 홀수일때 블루  (0) 2016.02.13
(smart toilet) 논문  (0) 2016.01.13
조도센서---> led_Green  (0) 2015.09.08