#include "C:\\Users\\Takahito\\Documents\\WIZ-C Projects\\RadioFC02\\RadioFC03A_Auto.h"
#include <strings.h>
#include <Displays.h>

//
// This file includes all user definable routines. It may be changed at will as
// it will not be regenerated once the application has been generated for the
// first time.
//
unsigned long	FreqMeasurement(void);

//*******************************************************************************
//
// Insert your interrupt handling code if required here. 
// Note quick interrupts are used so code must be simple
// See the manual for details of quick interrupts.
//
static	unsigned	int	MeasurementCnt;
static	unsigned	short	freqOF;

void UserInterrupt()
{

	if(PIR1&(1<<TMR1IF)) {
			PIR1&=~(1<<TMR1IF);
			freqOF = freqOF + 1;
			}

	// Insert your code here
	if(PIR1&(1<<TMR2IF)){
	PIR1&=~(1<<TMR2IF);
	//
	MeasurementCnt--;
	if (MeasurementCnt == 0) {
		T1CON &= ~(1<<TMR1ON);	// ゲートを閉める。 
		T2CON &= ~(1<<TMR2ON);	// TIMER2を停止する。 
			}
	}

 #asmline SETPCLATH UserIntReturn,-1  ; SETPCLATH for interrupt routine
 #asmline goto UserIntReturn	      ; Assembler - go back to interrupt routine
}


//*******************************************************************************
//
// Insert your initialisation code if required here. 
// Note that when this routine is called Interrupts will not be enabled - the 
// Application Designer will enable them before the main loop
//

void UserInitialise()
{
	// 割り込みを許可する。 
	INTCON |= 1<<PEIE;
	INTCON |= 1<<GIE;	
	
	LCDClear();			//LCD初期化
	LCDPrintAt(0,0);
		LCD(0xD7);
		LCD(0xBC);
		LCD(0xDE);
		LCD(0xB5);
		LCD(0x20);
		LCD(0xBC);
		LCD(0xAD);
		LCD(0xB3);
		LCD(0xCA);
		LCD(0xBD);
		LCD(0xB3);
		LCD(0xB6);
		LCD(0xB3);
		LCD(0xDD);
		LCD(0xC0);
		LCD(0xB0);
		
	LCDPrintAt(0,1);
		LCD(0xCA);
		LCD(0xDE);
		LCD(0xB0);
		LCD(0xBC);
		LCD(0xDE);
		LCD(0xAE);
		LCD(0xDD);
		LCD(0x32);
		LCD(0x2E);
		LCD(0x30);		
		
	Wait(2000);
	LCDClear();
	
}

//*******************************************************************************
//
// Insert your main loop code if required here. This routine will be called
// as part of the main loop code
//

void UserLoop()
{
	static	unsigned	long	freq;	// 0...4294967295
	static	unsigned	char	buf[20];
	static	unsigned	long	ad4;
	static	unsigned	short	cnt;
	static 	unsigned	int	relay;
	
		//フォトMOSリレー動作
		
		if(TEMP){
			relay = 1;
			PC.B4 = relay;
		}
		else
		{
			relay = 0;
			PC.B4 = relay;
		}
		
		//  周波数の測定
		freq = FreqMeasurement();
		
		//換算 
		freq = freq / 100;
	

		if(freq < 455){
		LCDPrintAt(0,0);
		LCD(0xA0);
		LCD(0xA0);
		LCD(0xD5);
		LCD(0xAF);
		LCD(0xB8);
		LCD(0xD8);
		LCD(0xA0);
		LCD(0xBC);
		LCD(0xC3);
		LCD(0xB2);
		LCD(0xAF);
		LCD(0xC3);
		LCD(0xC8);
		LCD(0xA0);
		LCD(0xA0);
		LCD(0xA0);
		Wait(800);
		//LCDClear();
		//Wait(200);
			}
		else{		
		freq = freq - 455;
		
		// 周波数表示 
		sprintf(buf, "    %5dkHz" ,freq);
		LCDPrintAt(0,0);
		LCDString(buf);
		LCD(0xA0);
		LCD(0xA0);
		LCD(0xA0);
		LCD(0xA0);

  
      		//ADコンバーターチャネルを4に設定
 		ADCON0=0x01;
		ADCON0=ADCON0|=0<<CHS0;
		ADCON0=ADCON0|=0<<CHS1; 
		ADCON0=ADCON0|=1<<CHS2; 

  		//ADコンバーター動作
		ADCON0 |= (1<<GO);
		while(ADCON0&(1<<GO)){};

		//ADコンバーター読み出し				
		ad4 = (WORD)ADRESH << 8;
		ad4 = ad4 | ADRESL;
		ad4 = ad4 / 40;			
		
		if(ad4 > 16){
			ad4 =15;
			}				
		
		//Sメーター表示		
		LCDPrintAt(0,1);
			LCDc(0x53);
		for (cnt = 0; cnt < ad4; cnt++)
			LCDc(0xFF);
		for (; cnt < 15; cnt++)
			LCDc(0x20);		
		}
	
	Wait(10);
	

}
//
// User occurrence code
//
unsigned	long	FreqMeasurement(void) {
unsigned 	long	freq;
unsigned 	short	freqS;
		
	// TIMER1の設定
	PIR1&=~(1<<TMR1IF);
	TMR1L = 0;
	TMR1H = 0;
	// TIMER2の設定
	PIR1&=~(1<<TMR2IF);
	
		MeasurementCnt = 123;
		TMR2 = 0xEE;		// 31250=0.1/((1/20000000) * 4 * 16)
					// 0xEE=256-(31250-(256*122))
	//
	freq = 0;
	freqOF = 0;

	// 割り込みを許可する。
	PIE1|=1<<TMR2IE;
	PIE1|=1<<TMR1IE;

	// 開始 
	T2CON |= 1<<TMR2ON;	//タイマを開始する。 
	
	//	Delay
	#pragma asm
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	NOP
	#pragma asmend
	
	//
	T1CON |= 1<<TMR1ON;	//ゲートを開ける。
	// 測定 
	
	while (T2CON & (1<<TMR2ON)){}
	
	// 割り込みを禁止する。
	PIE1 &= ~(1<<TMR2IE);
	PIE1 &= ~(1<<TMR1IE);

	//換算 
	freq = freqOF; 
	freq = freq * 65536;
	freq = freq + (unsigned)TMR1H * 256 + (unsigned)TMR1L;
	// 
	return freq;
}