int a;int b;int d;int x=0;int y=0; 
void read1(){TMR1H = 0;TMR1L = 0; 
     PORTa.F6 = 1;Delay_us(10);PORTa.F6 = 0; 
     while(!PORTa.F7);T1CON.F0 = 1;while(PORTa.F7);T1CON.F0 = 0; 
     a = (TMR1L | (TMR1H<<8));a = a/34;a = a + (a/5); 
     if(a<11){a=a+1;}else a=a;} 
void read2(){TMR1H = 0;TMR1L = 0; 
     PORTa.F1 = 1;Delay_us(10);PORTa.F1 = 0; 
     while(!PORTa.F0);T1CON.F0 = 1;while(PORTa.F0);T1CON.F0 = 0; 
     b = (TMR1L | (TMR1H<<8));b = b/34;b = b + (b/5); 
     if(b<11){b=b+1;}else b=b;} 
void read3(){TMR1H = 0;TMR1L = 0; 
     PORTa.F2 = 1;Delay_us(10);PORTa.F2 = 0; 
     while(!PORTa.F3);T1CON.F0 = 1; while(PORTa.F3);T1CON.F0 = 0; 
     d = (TMR1L | (TMR1H<<8));d = d/34;d = d + (d/5); if(d<11){d=d+1;}else d=d;} 
void main() 
{ cmcon=7; T1CON = 0x10; TRISB = 0b00000000; TRISa = 0b10001001; porta=0; portb=0;delay_ms(100); 

loop: 
read2();x=b;delay_ms(200); read2();y=b; 
b=(x-y); 
     if( b>=14){portb.f0=1;read1();read3(); 
if(a>=d){portb.f7=1;portb.f4=1;delay_ms(200);portb.f7=0;portb.f4=0;}
if(d>=a){portb.f1=1;portb.f3=1;delay_ms(200);portb.f1=0;portb.f3=0;} 
                       } 
           if( b<=10){portb.f0=0;} 
     goto loop; 
}