51单片机产生不同频率信号，求助！！

小弟要用这个频率信号（根据偏差）去控制步进电机，用一个端口输出频率信号，可是做了下面的程序，就是不对，频率非常快，根本不是我预想到的！各位大虾给点帮忙！！！
void timer0(void) interrupt 1
{
TH0=0xfc;
TL0=0x66;
flag++;
sub=receivebuf[0]-receivebuf[2];//偏差信号，两个receivebuf为AD接受数组，0~255
if(sub<20)
counter=30;
if(sub<40&&sub>=20)
counter=25;
if(sub<60&&sub>=40)
counter=20;
if(sub<80&&sub>=60)
counter=15;
else if(sub>=80)
counter=10;
if(flag==counter)
{
flag=0;
port=~port;//信号输出端口
direct=1;//方向控制位
}
}