mstimer2를 사용해서 전구 3개를 불들어오는것을 하고 있습니다.

void flash(){
  timer++;
  if(0<timer && timer<20 ){ 
    
    digitalWrite(6,HIGH);
    digitalWrite(8,LOW);
    digitalWrite(12,LOW);
    xbee.print('b');
 
  }
  else if(timer>20 && timer<40){
    digitalWrite(6,LOW);
    digitalWrite(8,HIGH);
    digitalWrite(12,LOW);
    xbee.print('s');
  }
  else if(timer>40 && timer<60){
    digitalWrite(6,LOW);
    digitalWrite(8,LOW);
    digitalWrite(12,HIGH);
    xbee.print('g');
  }
  else if(timer>60){
    timer=1;
  }
}

void setup() {
  Serial.begin(9600);
  xbee.begin(9600);
  
  pinMode(6,OUTPUT); 
  pinMode(8,OUTPUT);   

pinMode(12,OUTPUT); 

  MsTimer2::set(300,flash);
  MsTimer2::start();
}

여기서 물어보고 싶은건, 제가 초음파센서를 사용해서 일정 거리내에 물체가 접근해야 저 전구3개가 불이 들어오게 하고 싶은데요.

어떻게 소스를 짜야 할까요?

지금 현재 

 duration=pulseIn(echo,HIGH);
  distance = ((float)(340 * duration) / 10000) / 2;

이렇게 초음파센서로 거리를 계산하고 있습니다. 소스 좀 해결해주세요