求大神指点下，通过相邻上升沿之间时间的倒数算频率的程序

本人用arduino uno编一个计算相邻上升沿之间时间，然后求倒数的程序，用来读取频率。我提供的频率信号是一个200Hz的规则方波。但是我编的程序读完以后显示的是125Hz和111Hz这两个数交替出现。请大神帮忙看下，哪里出错了。非常感谢！
int Fval;
unsigned long startTime1=0,startTime2=0;
int val,state;
unsigned long T,t1,t2,t;
float F1;
int flag;
boolean _up;
int F_count() {
val=map(analogRead(A0),0,1023,0,255); //系统自动把电压分成1024份，后面我们把它们对应分成256份
// if(val>=204){state=1;}
// else if(val<=51){state=0;}
if(val<=51) flag=1;
if((val>=204)&&(flag=1))
{
_up=true;
flag=0;
}
if(millis()-startTime1<10000)
{
if(_up)
{
t1=millis(); //到这里为止应该没问题，因为在单独显示t1时间的时候的确是以5ms（1/200HZ）的差额递增
t=t1-t2;
t2=t1;
_up=false;
}
return t;
}
else
{
startTime1=millis();
}
}
void setup(){
Serial.begin(9600);
}
void loop(){
T=F_count();
if(T!=0){
F1=1000/T;
Serial.println(F1);
}
}