#include <pic.h>


#include "fm.h"

#define	CPU_CLOCK	4000000L

#define	TEST_FREQ	761		// ch

volatile uchar	Timer;





//*******************************************************
//	メインルーチン
//*******************************************************
int main(void){
	

	PORTB = 0xFF;
	TRISB = 0;
	
	PORTC = (1<<PC7)|(1<<PC6)|(1<<PC5)|(1<<SCL)|(1<<SDA)|(1<<PC2)|(1<<PC1)|(1<<PC0);



	// １秒時間待ち(電源が安定するまで待つ)
	wait_1s();


	// AR1000 レジスタ初期値
	write_AR1000(R0, R0_DEFAULT | R0_XO_EN);	// 最初は必ず ENABLE=OFF
	write_AR1000(R1, R1_DEFAULT | R1_HMUTE);	// ミュート
	write_AR1000(R2, R2_DEFAULT);
	write_AR1000(R3, R3_DEFAULT);
	write_AR1000(R4, 0x0400);
	write_AR1000(R5, 0x28AA);
	write_AR1000(R6, 0x4400);
	write_AR1000(R7, 0x1EE7);
	write_AR1000(R8, 0x7141);
	write_AR1000(R9, 0x007D);
	write_AR1000(R10, 0x82CE);
	write_AR1000(R11, 0x4F55);
	write_AR1000(R12, 0x970C);
	write_AR1000(R13, 0xB845);
	write_AR1000(R14, 0xFC2D);
	write_AR1000(R15, 0x8097);
	write_AR1000(R16, 0x04A1);
	write_AR1000(R17, 0xDF6A);

	write_AR1000(R0, R0_DEFAULT | R0_XO_EN | R0_ENABLE);	// ここで ENABLE

	for (;;){
		wait_10ms(1);	// 10ms WAIT
		if (read_AR1000(STATUS) & 0x20)	break;	// STC=H 待ち
	}

	write_AR1000(R2, (R2_DEFAULT & ~(R2_TUNE | R2_CHAN))	// 周波数設定
				 | (TEST_FREQ - 690));
	write_AR1000(R2, (R2_DEFAULT & ~(R2_TUNE | R2_CHAN))
				 | (TEST_FREQ - 690) | R2_TUNE);			// TUNE=ON
	
	for (;;){
		wait_10ms(1);	// 10ms WAIT
		if (read_AR1000(STATUS) & STATUS_STC)	break;	// STC=H 待ち
	}

	write_AR1000(R1, R1_DEFAULT);	// ミュート解除



	for (;;){
		wait_1s();

	}
}


//*******************************************************
//	AR1000 レジスタ書き込み
//*******************************************************
void write_AR1000(uchar adrs, ushort data){

	TWI_start();
	TWI_send(0x20);			// スレーブアドレス + Write
	TWI_send(adrs);
	TWI_send(data >> 8);
	TWI_send(data & 0x00FF);
	TWI_stop();
}


//*******************************************************
//	AR1000 レジスタ読み込み
//*******************************************************
ushort read_AR1000(uchar adrs){
	ushort	data;

	TWI_start();
	TWI_send(0x20);			// スレーブアドレス + Write
	TWI_send(adrs);
	TWI_start();
	TWI_send(0x20 + 1);		// スレーブアドレス + Read
	data = TWI_recv(0);		// ACK
	data <<= 8;
	data |= TWI_recv(1);	// NACK
	TWI_stop();

	return data;
}


//*******************************************************
//	1秒時間待ち
//*******************************************************
void wait_1s(void){

	Timer = 100;
	while(Timer){
		asm("clrwdt");
		asm("sleep");
	}
}


//*******************************************************
//	10ms単位で時間待ち
//*******************************************************
void wait_10ms(uchar w){

	Timer = w;
	while(Timer){
		asm("clrwdt");
		asm("sleep");
	}
}


//************************************************************
//	TWI 開始条件
//************************************************************
void TWI_start(void){

	SDA_H;
	asm("nop");
	SCL_H;
	asm("nop");
	SDA_L;
}


//************************************************************
//	TWI 8bit 送信
//************************************************************
void TWI_send(uchar data){
	char	b;

	SCL_L;
	for (b = 0; b < 8; b++){
		if (data & 0x80){
			SDA_H;
		} else {
			SDA_L;
		}
		SCL_H;
		WAIT_SCL_H;		// SCL=Hになるまで待つ
		data <<= 1;
		SCL_L;
	}

	SDA_H;
	SCL_L;

	// ACK受信 内容は無視
	SCL_H;
	asm("nop");
	SCL_L;
}


//************************************************************
//	TWI 8bit 受信
//************************************************************
uchar TWI_recv(uchar nack){
	char	b;
	uchar	data;

	SDA_H;
	SCL_L;

	data = 0;
	for (b = 0; b < 8; b++){
		SCL_H;
		WAIT_SCL_H;		// SCL=Hになるまで待つ
		data <<= 1;
		if (INP_SDA){
			data |= 1;
		}
		SCL_L;
	}

	// ACK/NACK 送信
	if (nack){
		SCL_L;
		SCL_H;
		SDA_H;
	} else {
		SDA_L;
		SCL_L;
		SCL_H;
	}

	SCL_L;
	SDA_H;

	return data;
}


//************************************************************
//	TWI 停止条件
//************************************************************
void TWI_stop(void){

	SDA_L;
	asm("nop");
	SCL_H;
	asm("nop");
	SDA_H;
}