/*********************************************
File name           :基于ATmega16的TC1功能的高精度周期測量
Chip type           : ATmega16
Program type        : Application
Clock frequency     : 4.000000 MHz
Memory model        : Small
External SRAM size  : 0
Data Stack size     : 256
*********************************************/

#include <mega16.h>

sfrw ICR1=0x26;        // 補充定義16位寄存器ICR1地址為0x26(mega16.h中未定義)

flash unsigned char led_7[11]={0x3F,0x06,0x5B,0x4F,0x66,0x6D,0x7D,0x07,0x7F,0x6F,0x00}; 
flash unsigned char position[6]={0xfe,0xfd,0xfb,0xf7,0xef,0xdf};

unsigned char dis_buff[6];					// 顯示緩沖區，存放要顯示的6個字符的段碼值
unsigned int icp_v1,icp_v2;
unsigned char icp_n,max_icp;
bit icp_ok,time_4ms_ok,f_2_d,begin_m,full_ok;

void display(void)					// 6位LED數管動態掃描函數
{
    static unsigned char posit;
	PORTC = 0xff;
	PORTA = led_7[dis_buff[posit]];
	PORTC = position[posit]; 
	if (++posit == 6) posit = 0;
}

// Timer 2 比較匹配中斷服務，4ms定時 
interrupt [TIM2_COMP] void timer2_comp_isr(void)
{
 	#asm("sei")			// 開放全局中斷,允許中斷嵌套   
    display();
    time_4ms_ok = 1;
}

// Timer 1 溢出中斷服務
interrupt [TIM1_OVF] void timer1_ovf_isr(void)
{
    full_ok = 1;
}

// Timer 1 輸入捕捉中斷服務
interrupt [TIM1_CAPT] void timer1_capt_isr(void)
{
    if (icp_n >= max_icp)   // 第N個上升沿到
    {
        icp_v2 = ICR1;      // 記錄第N個上升沿時間
        TIMSK = 0x80;       // 禁止T/CI輸入捕捉和溢出中斷
        icp_ok = 1;
    }
    else if (icp_n == 0)
    {
        icp_v1 = ICR1;      // 記錄第1個上升沿時間
    }    
    icp_n++;     
}

void f_to_disbuf(long v)	// 頻率值送顯示緩沖區函數
{
	unsigned char i;
	for (i=0;i<=4;i++)
	{
        dis_buff[i] = v%10;
        v /= 10; 
	}
	dis_buff[5] = v;
	for (i=5;i>0;i--)       // 高位零不顯示
	{
	    if (dis_buff[i] == 0)
	        dis_buff[i] = 10;
	    else
	        break;    
	}
}

void main(void)
{
    unsigned int icp_1,icp_2;
    long fv;
    
	DDRA=0xFF;          // LED段碼輸出
	PORTC=0xFF;
	DDRC=0x3F;          // LED位控輸出
	PORTD=0x40;         // PD6(icp)輸入方式，上拉有效

    // T/C2 初始化
    TCCR2=0x0C;         // 內部時鐘，64分頻（4M/64=62.5KHz），CTC模式
    OCR2=0xf9;//7c;          // OCR2 = 0xf9(249),(249+1)/62.5=4ms
 	// T/C1初始化
    TCCR1B = 0x41;      // T/C1正常計數方式，上升沿觸發輸入捕捉，4M/1計數時鐘
	TIMSK = 0xA4;		// 允許T/C2比較匹配中斷，允許T/C1輸入捕捉、溢出中斷

    icp_n = 0;
    max_icp =1;
  	#asm("sei")			// 開放全局中斷

	while (1)
	{
	    if (icp_ok == 1)    // 完成一次測量
	    {
	        if (icp_v2 >= icp_v1)          // 計算N個上升沿的時鐘脈沖個數，
	            icp_2 = icp_v2 - icp_v1;   
	        else
	            icp_2 = 65536 - icp_v1 + icp_v2;
	        
	        if (!(icp_v2 >= icp_v1 && full_ok)) // 有溢出，數據無效    
            {           
                if (icp_2 == icp_1)         // 兩次個數相等，測量有效 
	            {
                    fv = 4000000 * (long)max_icp / icp_2;     // 換算成頻率值
                    f_2_d = 1;              // 允許新頻率送顯示
                
                    if (fv > 4000)
                        max_icp = 64;       // 如果頻率大于4Khz，N=64
                    else
                        max_icp = 1;        // N=1
                 }
	        }
	        else
	            max_icp = 1;    // 有溢出，N=1
         
	        icp_1 = icp_2;          
	        icp_ok = 0;
            begin_m = 1;
  	    }
	    if (time_4ms_ok)            
	    {                           
	        if (f_2_d)
	        {
	            f_to_disbuf(fv);   // 新頻率送顯示
	            f_2_d = 0;
	        }
	        else if (begin_m)          
	        {
                icp_n = 0;      // 開始新的一次測量，
                full_ok = 0;    // 清除溢出標志
	            TIFR = 0x24;    // 清除可能存在的輸入捕捉、溢出中斷標志位
	            TIMSK = 0xa4;	// 開啟T/C1輸入捕捉、溢出中斷允許        
	            begin_m = 0;
	        }
            time_4ms_ok = 0;	    
	    }
    }
}